本发明涉及航空航天技术领域,特别是涉及一种基于融合权重矩阵的机载分布式pos传递对准方法和装置。
背景技术:
机载多任务遥感载荷高精度对地观测已经成为空基对地观测的重要发展方向,如集成高分辨率测绘相机、成像光谱仪、大视场红外扫描仪、合成孔径雷达(syntheticapertureradar,sar)于同一载机的多任务载荷,机载分布式阵列天线sar和柔性多基线干涉sar等。机载多任务遥感载荷对地观测系统要实现高精度成像,需要获取各载荷的高精度运动参数。位置姿态测量系统(positionandorientationsystem,pos)由惯性测量单元(inertialmeasurementunit,imu)、全球定位系统(globalpositionsystem,gps)接收机、pos计算机(poscomputersystem,pcs)和后处理软件组成,可以为成像载荷提供位置姿态信息。对于机载多任务遥感载荷对地观测系统,传统的单一pos无法满足不同载荷安置点的高精度运动参数测量需求。因此,必须建立起高精度机载分布式pos系统,为高性能航空遥感系统中所有载荷提供高精度高可靠的运动参数。高精度pos系统可以为高分辨率航空遥感系统提供高频、高精度的时间、空间及精度信息,通过运动补偿提高成像精度和效率,是实现高分辨率成像系统的关键。
机载分布式pos系统一般由一个高精度主pos和多个分布在机体(包括机翼)上的低精度子imu组成。主、子系统分别安装在机体或机翼两侧的不同载荷附近,用于测量载荷中心的运动参数。主pos通过传递对准将高精度位置、速度、姿态等运动参数传递给子imu,从而获得各子节点的高精度运动参数信息。在飞机飞行过程中,机载分布式pos的子imu受到多种干扰影响:一方面由于子imu安装在机翼外舱,环境温度以及气压的变化对imu的影响不容忽视;另一方面在传递对准中机翼高低频的振动对子imu也会造成巨大影响;此外,飞机和遥感载荷在工作过程中产生电磁干扰也可能导致imu主子传递对准超出精度范围。若任意子imu传递对准结果超出精度范围,则该子系统所对应的节点处的成像载荷的姿态等导航信息均无法满足需求,致使整个航空遥感测绘结果出现错误,造成严重后果,所以提高机载分布式pos传递对准精度有着十分重要的意义。
现有分布式pos传递对准方法,在每个子imu处设立一个滤波器,依靠主系统的高精度导航信息,对子系统进行传递对准。若任意子imu受干扰导致主子传递对准超出精度范围,则该子系统所对应的节点处成像载荷的导航信息无法满足需求,所以现有分布式pos传递对准方法尚不能完全满足分布式pos系统对精度的要求。基于融合权重矩阵的机载分布式pos传递对准方法,在现有方法的基础上,基于信息融合,建立分布式pos融合权重矩阵
技术实现要素:
基于此,有必要针对传统技术存在的问题,提供一种基于融合权重矩阵的机载分布式pos传递对准方法和装置,能够克服传统技术中的缺陷,建立的分布式pos融合权重矩阵
第一方面,本发明实施例提供了一种基于融合权重矩阵的机载分布式pos传递对准方法,所述方法包括:基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn;建立其它节点子imu相对第k个节点子imu的融合权重矩阵;加权计算第k个节点子imu传递对准观测量;针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。
在其中一个实施例中,还包括:采用状态χ2检验法,判断所有节点子imu导航信息y1,y2…yn是否可用于第二次传递对准。
在其中一个实施例中,所述建立其它节点子imu相对第k个节点子imu的融合权重矩阵包括:基于其他节点子imu与第k个节点子imu间杆臂距离
在其中一个实施例中,还包括:基于其它节点子imu导航信息ys(s=1,2…k-1,k+1,…n),利用融合权重矩阵
在其中一个实施例中,所述建立其它节点子imu相对第k个节点子imu的融合权重矩阵包括:其他节点子imu相对第k个节点子imu的融合权重矩阵
其中,
其中,ps为其它节点子imu主子传递对准精度因子,由其它节点子imu的主子传递对准滤波估计误差协方差ps(s=1,2…k-1,k+1,…n)计算得到:
其中,ps(4,4),ps(5,5)…ps(9,9)分别对应主子传递对准速度误差、位置误差的估计误差协方差。
在其中一个实施例中,所述第k个节点子imu的传递对准观测量
其中,
在其中一个实施例中,所述加权计算第k个节点子imu传递对准观测量包括:通过第k个节点子imu的传递对准观测量
第二方面,本发明实施例提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面的基于融合权重矩阵的机载分布式pos传递对准方法。
第三方面,本发明实施例提供了一种包含指令的计算机程序产品,当该计算机程序产品在计算机上运行时,使得计算机执行上述第一方面所述的方法。
第四方面,本发明实施例还提供了一种基于融合权重矩阵的机载分布式pos传递对准装置,所述装置包括:获取模块,用于基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn;建立模块,用于建立其它节点子imu相对第k个节点子imu的融合权重矩阵;计算模块,用于加权计算第k个节点子imu传递对准观测量;对准模块,用于针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。
本发明提供的一种基于融合权重矩阵的机载分布式pos传递对准方法和装置,基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn;建立其它节点子imu相对第k个节点子imu的融合权重矩阵;加权计算第k个节点子imu传递对准观测量;针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。该方法能够克服传统技术中的缺陷,建立的分布式pos融合权重矩阵
附图说明
图1为本发明一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法的流程示意图;
图2本发明另一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法的流程示意图;
图3为本发明一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法中的机载分布式pos主子系统空间分布关系图;以及
图4为本发明一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准装置的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例对本发明基于融合权重矩阵的机载分布式pos传递对准方法和装置进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
如图1所示,为一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法的流程示意图。具体包括以下步骤:
步骤102,基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn。
步骤104,建立其它节点子imu相对第k个节点子imu的融合权重矩阵。
本实施例中,建立其它节点子imu相对第k个节点子imu的融合权重矩阵包括:基于其他节点子imu与第k个节点子imu间杆臂距离
步骤106,加权计算第k个节点子imu传递对准观测量。
本实施例中,第k个节点子imu的传递对准观测量
其中,
进一步地,在一个实施例中,本公开提出的一种基于融合权重矩阵的机载分布式pos传递对准方法还包括:通过第k个节点子imu的传递对准观测量
步骤108,针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。
在一个实施例中,本公开提出的一种基于融合权重矩阵的机载分布式pos传递对准方法还包括:基于其它节点子imu导航信息ys(s=1,2…k-1,k+1,…n),利用融合权重矩阵
具体的,所述建立其它节点子imu相对第k个节点子imu的融合权重矩阵包括:其他节点子imu相对第k个节点子imu的融合权重矩阵
其中,
其中,ps为其它节点子imu主子传递对准精度因子,由其它节点子imu的主子传递对准滤波估计误差协方差ps(s=1,2…k-1,k+1,…n)计算得到:
其中,ps(4,4),ps(5,5)…ps(9,9)分别对应主子传递对准速度误差、位置误差的估计误差协方差。
本发明提供的一种基于融合权重矩阵的机载分布式pos传递对准方法,基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息;建立其它节点子imu相对第k个节点子imu的融合权重矩阵;加权计算第k个节点子imu传递对准观测量;针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。该方法能够克服传统技术中的缺陷,建立的分布式pos融合权重矩阵
为了更清楚地理解与应用本发明提出的基于融合权重矩阵的机载分布式pos传递对准方法,进行以下示例。需要说明的是,本发明的保护范围不局限以下示例。
结合图2和图3。其中,如图2所示,为另一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法的流程示意图;图3为本发明一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准方法中的机载分布式pos主子系统空间分布关系图。
具体的,基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn;此外,采用状态χ2检验法,判断各子imu导航信息y1,y2…yn是否可用于第二次传递对准。
需要说明的是,首先分布式pos所有节点子imu进行主子传递对准,采用“速度+姿态”的匹配方式进行传递对准建模。滤波器的模型包括状态方程和量测方程,针对分布式pos任意节点子imu进行主子传递对准步骤如下:
系统状态方程为:
式中:
为状态变量。φ=[φxφyφz]t为子imu的三轴平台失准角,δv=[δvxδvyδvz]t为子imu的速度误差,δl、δλ、δh分别为子imu的纬度、经度和高度误差,ε=[εxεyεz]t为陀螺漂移,
式中:
其中,ωie为地球自转角速度;rm和rn分别为地球沿子午圈和卯酉圈的主曲率半径;l和h分别为子imu捷联解算的纬度和高度;t为滤波周期;vx、vy、vz分别为子imu捷联解算的东向、北向、天向速度;
进一步地,选取主子节点系统的姿态角误差、速度误差和位置误差作为量测量,完整的量测方程如下:
z=h·x+v
式中:z=[δψδθδγδvxδvyδvz]t为量测量,v是量测噪声,假定其为零均值的高斯白噪声,其协方差为e[vvt]=r;量测矩阵为:
其中,ta为主pos载体坐标系到其导航坐标系的方向余弦矩阵。其j=1,2,3,
i=1,2,3,表示ta(ji)的第j行、第i列元素。利用上述主子传递对准误差状态量计算修正子imu位置、速度和姿态。
可以理解的是,其中,速度修正公式为:
其中,vx′,vy′,vz′分别为修正后子imu的东向、北向和天向速度;
位置修正公式为:
其中,λ为捷联解算得到的子imu的经度;l′、λ′和h′分别为修正后子imu的纬度、经度和高度。
姿态修正公式为:
利用
修正后的子imu载体坐标系到导航坐标系的方向余弦矩阵
其中,
经过误差修正后得到子imu经过主子传递对准后的导航信息记为y:
y=[ψ′θ′γ′vx′vy′vz′l′λ′h′]
对分布式pos所有节点子imu重复上述步骤,得到所有节点子imu的导航信息y1,y2…yn。
更进一步地,采用状态χ2检验法,判断各子imu导航信息y1,y2…yn是否可用于第二次传递对准。
可以理解的是,检测函数为;
λ=βtt-1β
e{β}=0e{ββt}=t
其中,
子imu导航信息是否可用于第二次传递对准的准则为:
其中td=36.24,作为子imu主子传递对准判定阈值。考虑状态χ2检验法的延时性,为保证系统的可靠性,设定子imuλ≤td持续时间大于等于0.2s输出导航信息有效,可用于第二次传递对准。
基于上述步骤,进行基于其他节点子imu与第k个节点子imu间杆臂距离
利用其他节点子imu与第k个节点子imu间杆臂距离
利用其他节点子imu的主子传递对准滤波估计误差协方差ps,建立子imu主子传递对准精度因子ps:
由归一化得到其他节点相对于第k个节点子imu的融合权重矩阵
基于上述步骤,基于其他节点子imu导航信息ys(s=1,2…k-1,k+1,…n),利用融合权重矩阵
具体的,将其他节点子imu第一次主子传递对准后获得的导航信息ys(s=1,2…k-1,k+1,…n),通过杆臂补偿到第k个节点,得到补偿后导航信息
其中,
基于上述步骤,再利用加权计算得到的第k个节点子imu的传递对准观测量
其中,
需要说明的是,状态模型为:
其中,
对第k个节点子imu第二次传递对准采用“速度+位置”匹配方式,选取第k个节点子imu第二次传递对准观测量
需要说明的是,量测模型为:
其中,
利用上述传递对准误差状态量计算修正第k个节点子imu位置、速度和姿态。其中,速度修正公式为:
其中,vx′、vy′和vz′主子传递对准后第k个节点子imu东向、北向和天向速度;
此外,位置修正公式为:
其中,l′、λ′和h′主子传递对准后第k个节点子imu纬度、经度和高度,
再次,姿态修正公式为:
利用
修正后的转换矩阵
其中,
最终,基于上述操作流程步骤,针对分布式pos系统各子imu重复前述步骤,直至循环结束完成传递对准,得到机载分布式pos中所有节点的全局位置、速度、姿态信息。
综上所述,本公开提出的一种基于融合权重矩阵的机载分布式pos传递对准方法的原理为通过第一次主子传递对准,获得所有节点子imu的导航信息y1,y2…yn,基于其他节点与第k个节点间杆臂距离
需要说明的是,本公开提出的一种基于融合权重矩阵的机载分布式pos传递对准方法的优点在于建立的分布式pos融合权重矩阵
基于同一发明构思,还提供了一种基于融合权重矩阵的机载分布式pos传递对准装置。由于此装置解决问题的原理与前述一种基于融合权重矩阵的机载分布式pos传递对准方法相似,因此,该装置的实施可以按照前述方法的具体步骤时限,重复之处不再赘述。
如图4所示,为一个实施例中的一种基于融合权重矩阵的机载分布式pos传递对准装置的结构示意图。该基于融合权重矩阵的机载分布式pos传递对准装置10包括:获取模块200、建立模块400、计算模块600和对准模块800。
其中,获取模块200用于基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息y1,y2…yn;建立模块400用于建立其它节点子imu相对第k个节点子imu的融合权重矩阵;计算模块600用于加权计算第k个节点子imu传递对准观测量;对准模块800用于针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。
本发明提供的一种基于融合权重矩阵的机载分布式pos传递对准装置,通过获取模块200基于分布式pos所有n个节点子imu通过第一次主子传递对准,获得导航信息;再通过建立模块400建立其它节点子imu相对第k个节点子imu的融合权重矩阵;再通过计算模块600加权计算第k个节点子imu传递对准观测量;最终通过对准模块800针对第k个节点子imu进行第二次传递对准得到第k个节点全局位置、速度、姿态信息,并进行加1重复迭代操作完成分布式pos所有节点全局位置、速度、姿态信息的对准。该装置能够克服传统技术中的缺陷,建立的分布式pos融合权重矩阵
本发明实施例还提供了一种计算机可读存储介质。该计算机可读存储介质上存储有计算机程序,该程序被图1或图2中处理器执行。
本发明实施例还提供了一种包含指令的计算机程序产品。当该计算机程序产品在计算机上运行时,使得计算机执行上述图1或2的方法。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(read-onlymemory,rom)或随机存储记忆体(randomaccessmemory,ram)等。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。