基于视觉辅助测量的机载分布式POS数据融合方法和装置与流程

文档序号:15266897发布日期:2018-08-28 21:55阅读:166来源:国知局

本发明涉及遥感测试技术领域,特别是涉及一种基于视觉辅助测量的机载分布式pos数据融合方法和装置。



背景技术:

机载多任务遥感载荷高精度对地观测已经成为空基对地观测的重要发展方向,如集成高分辨率测绘相机、成像光谱仪、大视场红外扫描仪、合成孔径雷达(syntheticapertureradar,sar)于同一载机的多任务载荷,机载分布式阵列天线sar和柔性多基线干涉sar等。机载多任务遥感载荷对地观测系统要实现高精度成像,需要获取各载荷的高精度运动参数。位置姿态测量系统(positionandorientationsystem,pos)由惯性测量单元(inertialmeasurementunit,imu)、全球定位系统(globalpositionsystem,gps)接收机、pos计算机(poscomputersystem,pcs)和后处理软件组成,可以为成像载荷提供位置姿态信息。对于机载多任务遥感载荷对地观测系统,传统的单一pos无法满足不同载荷安置点的高精度运动参数测量需求。因此,必须建立起高精度机载分布式pos系统,为高性能航空遥感系统中所有载荷提供高精度高可靠的运动参数。

传统机载分布式pos系统一般由一个高精度主pos和多个分布在机体(包括机翼)上的低精度子imu组成。主、子系统分别安装在机体或机翼两侧的不同载荷附近,用于测量载荷中心的运动参数。主pos通过传递对准将高精度位置、速度、姿态等运动参数传递给子imu,从而获得各子节点的高精度运动参数信息。由于受阵风、平台机动等多源扰动影响,柔性长机翼产生多模挠曲变形颤动耦合运动,部分节点的最大振幅可达米级、挠曲变形角高达10度左右,柔性基线效应显著,必然造成主子传递对准精度降低,影响子系统测量精度。

视觉测量是一种高精度测量方法,不需要通过机翼建立主子系统的传递关系,在子系统处设置相应靶标,将相机与主系统刚性固连于机舱,能够直接测出子系统相对主系统的位置姿态信息,测量精度高,可解决柔性基线效应影响主子传递对准精度的问题。但其受外界环境影响较大,在飞机飞行过程中,大气、温度、气候、外界亮度都会影响图像提取精度,相对传统pos系统不够稳定。所以为解决柔性基线效应造成的分布式pos多传感器数据融合难题,提高子系统测量精度,基于视觉测量的分布式pos数据融合方法具有重要意义。

现有机载分布式pos数据融合方法,主要针对主pos与子imu的传递对准,受柔性基线效应影响显著,难以满足分布式pos的高精度测量需求。为解决柔性基线效应导致机载分布式pos精度下降问题,首先,在现有主子传递对准的基础上利用视觉测量主pos与子imu的相对运动参数,作为量测信息辅助传统传递对准,提高传递对准精度;其次,为进一步提高分布式pos子imu测量精度,充分利用分布式pos柔性基线各子节点的相关性,将对准后子imu与主pos的相对运动信息作为数据处理对象,首先采用dbscan聚类法对其进行降噪处理,然后基于柔性基线模型,采用正交多项式拟合及傅里叶逼近分别进行空间维、时间维数据融合处理,得到拟合后的主pos与子imu的相对运动信息;最后,将上述处理结果经主pos运动信息补偿,获得分布式pos所有节点子imu的高精度运动参数。该方法解决柔性基线效应导致多传感器数据融合难题,提高机载分布式pos测量精度。



技术实现要素:

基于此,有必要针对传统技术,考虑到分布式pos受柔性基线效应影响,出现主子传递对准测量精度降低的问题,提出了一种基于视觉辅助测量的机载分布式pos数据融合方法和装置,能够提高分布式pos所有节点的测量精度。

第一方面,本发明实施例提供了一种基于视觉辅助测量的机载分布式pos数据融合方法,所述方法包括:通过视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;通过基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,通过dbscan聚类法对mr进行降噪处理得到m′r;基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,,以实现基于视觉辅助的机载分布式pos数据融合。

第二方面,本发明实施例提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面的基于视觉辅助测量的机载分布式pos数据融合方法。

第三方面,本发明实施例提供了一种包含指令的计算机程序产品,当该计算机程序产品在计算机上运行时,使得计算机执行上述第一方面所述的方法。

第四方面,本发明实施例还提供了一种基于视觉辅助测量的机载分布式pos数据融合装置,所述装置包括:获取模块,用于通过视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;模型建立模块,用于通过基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);降噪模块,用于将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,通过dbscan聚类法对mr进行降噪处理得到m′r;融合模块,用于基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,以实现基于视觉辅助的机载分布式pos数据融合。

本发明提供的一种基于视觉辅助测量的机载分布式pos数据融合方法和装置,首先利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;其次,基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);然后,将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,采用dbscan聚类法对mr进行降噪处理得到m′r;最后,基于所建柔性基线模型,采用正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,采用傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,再经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu高精度运动参数m1,提高机载分布式pos测量精度。

附图说明

图1为本发明一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法的步骤流程示意图;

图2为本发明另一个实施例中的一种基于视觉辅助测量的机载分布式poss数据融合方法的流程示意图;

图3为本发明一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法中的机载分布式pos主子系统空间分布关系示意图;

图4为本发明一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法中的视觉辅助测量单翼示意图;

图5为本发明一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法中的悬臂梁受均布载荷挠曲变形示意图;

图6为本发明一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合装置的结构示意图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白,以下通过实施例,并结合附图,对本发明基于视觉辅助测量的机载分布式pos数据融合方法和装置的具体实施方式进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。

本实施例所提供的基于视觉辅助测量的机载分布式pos数据融合方法的原理为:利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);为充分利用分布式pos各子节点相关性,进一步提高测量精度,将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,对mr进行数据融合处理;首先根据mr数据密度大、噪声不规律等特点采用dbscan聚类法对mr进行降噪处理得到m′r,其次基于所建柔性基线模型,采用正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,采用傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r;最后经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu的高精度运动参数m1。

本公开的基于视觉辅助测量的机载分布式pos数据融合方法的有益效果为:本发明采用的视觉测量辅助传统主子传递对准方法,可以直接获得主pos与子imu的相对位置姿态信息,避免主pos与子imu进行信息传递时柔性基线效应的影响,提高了分布式pos传递对准精度;本发明建立的柔性基线模型,综合考虑基线的空间维弯曲、时间维振颤,切实结合其对分布式pos的影响,简单有效;本发明在数据融合前采用的聚类降噪方法,针对mr时间维数据密度大、噪声不规律等特点,符合工程需要,有效提高了全局数据融合效率及精度;本发明采用的时空数据融合方法,在主pos与子imu传递对准的基础上,分别针对时间维、空间维进行数据拟合,充分利用分布式pos所有子节点的时空相关性,克服了柔性基线效应带来的多传感器数据融合难题,进一步提高了分布式pos系统测量精度。

如图1所示,为一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法的流程示意图。具体包括以下步骤:

步骤102,通过视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0。

本实施例中,通过视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0,包括:

视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,经视觉测量辅助后进行传递对准,其中,量测模型为:

z=[zazp]t=hx+v

其中,ψm,θm,γm分别为主pos测得的航向、俯仰、横滚,为主pos的载体坐标系与导航坐标系间的方向余弦矩阵,αc,βc,γc为相机测得的子imu相对主pos的姿态角变化在主pos载体坐标系下的表示,ψs,θs,γs为子imu捷联解算的航向、俯仰、横滚;xm,ym,zm分别为主pos测得沿x,y,z轴的位置,xc,yc,zc分别为相机测得的子imu相对主pos的位移(在主pos载体坐标系下的表示),xs,ys,zs为子imu捷联解算的沿x,y,z轴的位置(导航坐标系);x表示子imu的状态估计量;v表示主pos测量误差与相机测量误差的和序列;

其中,

其中,rm和rn分别为地球沿子午圈和卯酉圈的主曲率半径;l和h分别为子imu捷联解算的纬度和高度。

步骤104,通过基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t)。

本实施例中,通过基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t),包括:

机翼柔性基线挠曲、振颤模型θ(x,t)为:

飞机在巡航成像阶段机翼受到均布载荷,其中,q为机翼受到的均布载荷,ei为抗弯刚度,是广义外力,是模态阻尼系数,是模态频率。

步骤106,将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,通过dbscan聚类法对mr进行降噪处理得到m′r。

步骤108,基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,,以实现基于视觉辅助的机载分布式pos数据融合。需要说明的是,基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,再通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,再通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,,以实现基于视觉辅助的机载分布式pos数据融合。其中,通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,与通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,以实现基于视觉辅助的机载分布式pos数据融合上述步骤操作为顺序操作。

本实施例中,基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,且通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,包括:通过拟合函数q(x)对集合m′r内各时间段进行空间维拟合,得到空间拟合后的新集合m″r,其中,q(x)表示如下:

q(x)=a0q0(x)+a1q1(x)+…anqn(x)

其中,qk(x)是首项为1的k次多项式,根据qk(x)的正交性,得:

根据上式逐步求得qk(x),其相对应系数可表示如下:

逐步把ak·qk(x)累加到q(x)中,最后可求得拟合函数q(x);

通过利用拟合函数g(t)对集合m″r内各节点进行时间维拟合,最终得到经过时空拟合后的集合m″′r,其中,g(t)表示如下:

g(t)=c0+c1sinw1t+c2cosw2t+…+c2p-1sinw2p-1t+c2pcosw2pt

其中,p=1,2,…,n,g(t)是基于傅里叶逼近得到的周期拟合函数。

本发明提供的一种基于视觉辅助测量的机载分布式pos数据融合方法,首先利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;其次,基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);然后,将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,采用dbscan聚类法对mr进行降噪处理得到m′r;最后,基于所建柔性基线模型,采用正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,采用傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,再经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu高精度运动参数m1,提高机载分布式pos测量精度。

为了更清楚的理解与应用本发明提出的基于视觉辅助测量的机载分布式pos数据融合方法,进行以下示例。需要说明的是,本发明的保护范围不局限以下示例。

具体的,如图2所示,为本发明另一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合方法。

步骤201,利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统主子传递对准,获得所有子imu的运动参数m0。

步骤202,基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型。

步骤203,m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr。

步骤204,采用dbscan聚类法对mr进行降噪处理,得到集合m′r。

步骤205,采用正交多项式拟合对m′r空间维数据进行融合处理,得m″r。

步骤206,采用傅里叶逼近m″r时间维数据进行融合处理,得m″′r。

步骤207,经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu高精度运动参数m1。

具体说明为:结合图2-3所示,利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0。具体步骤为:首先分布式pos所有节点子imu进行主子传递对准,相机安装在机舱位置,与主pos刚性连接,单翼相机安装示意图如说明书附图4所示,测量主pos与子imu的相对运动信息,作为量测信息辅助传统传递对准,采用“位置+姿态”的匹配方式进行传递对准建模。滤波器的模型包括状态方程和量测方程,具体传递对准的步骤如下:

其中,系统状态方程为:

其中:

为状态变量。φ=[φxφyφz]t为子imu的三轴平台失准角,δv=[δvxδvyδvz]t为子imu的速度误差,δl、δλ、δh分别为子imu的纬度、经度和高度误差,ε=[εxεyεz]t为陀螺漂移,为加计零偏f为状态转移矩阵;g为系统噪声矩阵;为系统噪声,并假设其为零均值高斯白噪声;f和g的表达式:

其中:

其中,ωie为地球自转角速度;rm和rn分别为地球沿子午圈和卯酉圈的主曲率半径;l和h分别为子imu捷联解算的纬度和高度;t为滤波周期;vx、vy、vz分别为子imu捷联解算的东向、北向、天向速度;为子imu载体坐标系到导航坐标系的方向余弦矩阵。

此外,经视觉测量辅助后进行传递对准,其中,量测模型是:

z=[zazp]t=hx+v

其中,ψm,θm,γm分别为主pos测得的航向、俯仰、横滚,为主pos的载体坐标系与导航坐标系间的方向余弦矩阵,αc,βc,γc为相机测得的子imu相对主pos的姿态角变化在主pos载体坐标系下的表示,ψs,θs,γs为子imu捷联解算的航向、俯仰、横滚;xm,ym,zm分别为主pos测得沿x,y,z轴的位置,xc,yc,zc分别为相机测得的子imu相对主pos的位移(在主pos载体坐标系下的表示),xs,ys,zs为子imu捷联解算的沿x,y,z轴的位置(导航坐标系);x表示子imu的状态估计量;v表示主pos测量误差与相机测量误差的和序列;

其中,

再者,利用上述主子传递对准误差状态量计算修正子imu位置、速度和姿态。

其中,速度修正

其中,v′x,v′y,v′z分别为修正后子imu的东向、北向和天向速度;

其中,位置修正

其中,λ为捷联解算得到的子imu的经度;l′、λ′和h′分别为修正后子imu的纬度、经度和高度。

其中,姿态修正

利用中的失准角φx,φy,φz来计算子imu导航坐标系n与计算导航坐标系n′间的转换矩阵

修正后的转换矩阵为:

其中,为子imu进行捷联解算后得到的姿态矩阵。利用修正后的计算子imu的姿态角,包括航向角ψ′、俯仰角θ′和横滚角γ′。

经过误差修正后得到子imu经过主子传递对准后的导航信息记为m:

m=[ψ′θ′γ′v′xv′yv′zl′λ′h′]

m是t×9的矩阵,t为总的采样数,为采样时间t与采样频率f的乘积:t=t×f。

对分布式pos所有节点子imu重复上述步骤,得到分布式pos所有节点子imu的运动参数集合m0=[m1,m2,…,mn]。

需要说明的是,根据飞机的气动特性和结构参数,结合分布式pos布局,分析柔性基线的动力学频谱特性,揭示多源振动耦合下柔性基线非线性挠曲变形机理和颤动规律。基于气动弹性动力学理论,采用运动模态叠加方法,建立柔性基线多模态挠曲运动复合模型。具体实施方法为:由于机翼柔性特性,受阵风、湍流等外因和发动机振动内因影响,柔性机翼产生多阶模态运动叠加而成的非线性挠曲变形和颤动,其中高阶模态振幅较小,且随机性强,因此柔性基线挠曲运动建模时,主要考虑低阶模态的影响。

对于机体弹性变形角,以阵列天线sar为例,分布式pos中子imu安装在机翼两侧,机翼的振动及弹性变形主要是绕机体y轴,所以在传递对准误差建模中只考虑绕机体坐标系y轴的弹性变形角θy。

根据弹性力学理论中的模态叠加方法,杆臂绕oy轴的弯曲位移uy(x,t)可描述为:

式中:x是ox轴上的坐标;n代表杆臂的n阶模态;ψi(x)、qi(t)是第i阶模态的振型函数与模态坐标。由此可知,绕机体坐标系y轴的挠曲变形角可表示为:

其中可用模态坐标分析机翼颤振,描述为:

式中,是模态阻尼系数;是模态频率;是广义外力。可根据机翼的实际参数用有限元方法确定。而空气扰动产生的广义外力一般可以根据空气扰动信号的频率范围确定,大气扰动的频率一般在数十赫兹。机翼随时间的振动可以看作机翼受外力的颤振。由于飞机在正常飞行过程中,模态阻尼系数均为小阻尼震颤,即所以模态坐标函数可视为欠阻尼二阶系统。在飞机巡航飞行过程中将广义外力可近似看作阶跃激励,由此可解得模态坐标函数为:

由于在飞行中,飞机受到的大气湍流等外部扰动的频率一般小于飞机的颤振频率(飞机的颤振频率为数十赫兹),故仅取第一阶弯曲模态近似机翼的挠曲运动。考虑大飞机在巡航状态下,机翼受到均布载荷q,抗弯刚度为ei,可简化为悬臂梁模型,其一阶模态变形可简化如图5所示。振形函数方程可表示为:

则绕y轴变化取其微分形式为:

将式(4)、(7)代入(2)得机翼绕y轴挠曲角变形可近似为:

由此可建立机翼柔性基线挠曲、振颤模型θ(x,t):

飞机在巡航成像阶段机翼受到均布载荷,其中,q为机翼受到的均布载荷,ei为抗弯刚度,是广义外力,是模态阻尼系数,是模态频率。

可以理解的是,将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,针对实施步骤1得到的集合mr数据密度大、噪声不规律等特点,采用dbscan聚类法对mr中每个节点的数据分别进行降噪处理,得到集合m′r。具体实施步骤为:首先,将主子传递对准后的集合m0内所有数据,减去主pos的绝对运动参数,获得对准后相应各子imu相对主pos的运动信息mr=[mr1,mr2,…,mrn]。

其次,针对集合mr中mri(i=1,2,…,n)计算dbscan聚类法的扫描半径e和最小包含点数minpts。计算步骤说明为:解析样本数据文件mri;计算mri中每个数据点与其他所有数据点之间的欧几里得距离。计算公式如下:

其中,i,j代表不同时间点。

此外,计算每个点的k-距离值,并对所有点的k-距离集合进行升序排序,输出排序后的k-距离值。此处对dbscan算法中使用的k-距离的概念说明如下:

k-距离是指给定数据集p={p(i);i=0,1,...n},对于任意点p(i),计算点p(i)到整个数据集合d的子集s={p(1),p(2),...,p(i-1),p(i+1),...,p(n)}中所有点之间的距离,距离按照从小到大的顺序排序,假设排序后的距离集合为d={d(1),d(2),...,d(k-1),d(k),d(k+1),...,d(n)},则d(k)就被称为p(i)对应的k-距离。

进一步地,针对所有的k-距离值,计算k距离变化趋势,k距离突变处对应的k-距离值作为半径e,此处的k值作为minpts。

然后,根据上述计算得到的半径e和minpts,采用dbscan算法寻找孤立点(噪声点)从而实现降噪。dbscan算法的实现步骤说明为:从含有二维数据的mri中任选一个未被访问的点p0;检测mri中尚未被检查过的对象点pi,如果pi未被处理(即pi被归为某个簇或者标记为噪声),则按照扫描半径e检查其邻域,若邻域中包含的对象数不小于minpts,则建立新簇c,将其中的所有点加入候选集n;若邻域中包含的对象数小于minpts,则pi点暂时被标记作为噪声点;对候选集n中所有尚未被处理的对象q,查其邻域,若至少包含minpts个对象,则将这些对象加入n;如果q未归入任何一个簇,则将q加入c;重复上述步骤操作,继续检查n中未处理的对象,直至当前候选集n为空;重复除了从含有二维数据的mri中任选一个未被访问的点p0,步骤操作的所有步骤,直到所有对象都归入了某个簇或标记为噪声;最后,针对mr中所有mri重复上述步骤,完成各节点子imu信息的时间维降噪处理,获得降噪后的数据集合m′r。

更进一步地,基于所建柔性基线模型,采用正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,采用傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,再经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu高精度运动参数m1。具体实施步骤为:空间维拟合步骤,即利用拟合函数q(x)对集合m′r内各时间段进行空间维拟合,得到空间拟合后的新集合m″r。q(x)表示如下:

q(x)=a0q0(x)+a1q1(x)+…anqn(x)

其中,qk(x)是首项为1的k次多项式,根据qk(x)的正交性,得:

根据式上式逐步求得qk(x),其相对应系数可表示如下:

逐步把ak·qk(x)累加到q(x)中,最后可求得拟合函数q(x)。

此外,时间维拟合,即利用拟合函数g(t)对集合m″r内各节点进行时间维拟合,最终得到经过时空拟合后的集合m″′r。g(t)表示如下:

g(t)=c0+c1sinw1t+c2cosw2t+…+c2p-1sinw2p-1t+c2pcosw2pt

其中,p=1,2,…,n,g(t)是基于傅里叶逼近得到的周期拟合函数。

最后,m″′r经刚性杆臂补偿加上主pos运动信息,将主pos测量的绝对运动参数通过杆臂补偿,再加上数据融合处理后的相对运动参数m″′r,得到分布式pos所有节点子imu经过全局数据融合后的绝对运动参数m1。

基于同一发明构思,还提供了一种基于视觉辅助测量的机载分布式pos数据融合装置。由于此装置解决问题的原理与前述一种基于视觉辅助测量的机载分布式pos数据融合方法相似,因此,该装置的实施可以按照前述方法的具体步骤时限,重复之处不再赘述。

如图6所示,为一个实施例中的一种基于视觉辅助测量的机载分布式pos数据融合装置的结构示意图。该基于视觉辅助测量的机载分布式pos数据融合装置10包括:获取模块200、模型建立模块400、降噪模块600和融合模块800。

其中,获取模块200用于通过视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;模型建立模块400用于通过基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);降噪模块600用于将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,通过dbscan聚类法对mr进行降噪处理得到m′r;融合模块800用于基于所建柔性基线模型,通过正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,通过傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,通过刚性杆臂补偿与主pos运动信息的加和计算,获得分布式pos所有节点子imu高精度运动参数m1,,以实现基于视觉辅助的机载分布式pos数据融合。

本实施例中,获取模块200包括:量测模型传递单元(图中未示出)用于视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,经视觉测量辅助后进行传递对准,其中,量测模型为:

z=[zazp]t=hx+v

其中,ψm,θm,γm分别为主pos测得的航向、俯仰、横滚,为主pos的载体坐标系与导航坐标系间的方向余弦矩阵,αc,βc,γc为相机测得的子imu相对主pos的姿态角变化在主pos载体坐标系下的表示,ψs,θs,γs为子imu捷联解算的航向、俯仰、横滚;xm,ym,zm分别为主pos测得沿x,y,z轴的位置,xc,yc,zc分别为相机测得的子imu相对主pos的位移(在主pos载体坐标系下的表示),xs,ys,zs为子imu捷联解算的沿x,y,z轴的位置(导航坐标系);x表示子imu的状态估计量;v表示主pos测量误差与相机测量误差的和序列;

其中,

其中,rm和rn分别为地球沿子午圈和卯酉圈的主曲率半径;l和h分别为子imu捷联解算的纬度和高度。

进一步地,在一个实施例中,机翼柔性基线挠曲、振颤模型θ(x,t)为:

飞机在巡航成像阶段机翼受到均布载荷,其中,q为机翼受到的均布载荷,ei为抗弯刚度,是广义外力,是模态阻尼系数,是模态频率。

更进一步地,融合模块800包括:拟合单元(图中未示出)用于通过拟合函数q(x)对集合m′r内各时间段进行空间维拟合,得到空间拟合后的新集合m″r,其中,q(x)表示如下:

q(x)=a0q0(x)+a1q1(x)+…anqn(x)

其中,qk(x)是首项为1的k次多项式,根据qk(x)的正交性,得:

根据上式逐步求得qk(x),其相对应系数可表示如下:

逐步把ak·qk(x)累加到q(x)中,最后可求得拟合函数q(x);

通过利用拟合函数g(t)对集合m″r内各节点进行时间维拟合,最终得到经过时空拟合后的集合m″′r,其中,g(t)表示如下:

g(t)=c0+c1sinw1t+c2cosw2t+…+c2p-1sinw2p-1t+c2pcosw2pt

其中,p=1,2,…,n,g(t)是基于傅里叶逼近得到的周期拟合函数。

本发明提供的一种基于视觉辅助测量的机载分布式pos数据融合装置,首先通过获取模块200利用视觉测量主pos与子imu相对位置姿态,作为量测信息辅助传统传递对准,获得所有节点子imu的运动参数m0;其次,通过模型建立模块400基于弹性力学模态叠加方法,建立机翼柔性基线挠曲、振颤模型θ(x,t);然后,通过降噪模块600将m0经刚性杆臂补偿减去主pos运动信息,获得对准后子imu与主pos的相对运动信息mr,采用dbscan聚类法对mr进行降噪处理得到m′r;最后,通过融合模块800基于所建柔性基线模型,采用正交多项式拟合对m′r空间维数据进行融合处理,获得m″r,采用傅里叶逼近对m″r时间维数据进行融合处理,获得m″′r,再经刚性杆臂补偿加上主pos运动信息,获得分布式pos所有节点子imu高精度运动参数m1,提高机载分布式pos测量精度。

本发明实施例还提供了一种计算机可读存储介质。该计算机可读存储介质上存储有计算机程序,该程序被图1或图2中处理器执行。

本发明实施例还提供了一种包含指令的计算机程序产品。当该计算机程序产品在计算机上运行时,使得计算机执行上述图1或2的方法。

本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(read-onlymemory,rom)或随机存储记忆体(randomaccessmemory,ram)等。

以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。

以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1