基于对偶四元数的惯性/卫星/天文组合导航系统改进联邦滤波方法  

An Improved SINS/GNSS/CNS Federal Filter Based on Dual Quaternions

作　　者：闵艳玲 熊智[1] 邢丽 刘建业[1] 殷德全[1] 

机构地区：[1]南京航空航天大学自动化学院,江苏南京211100

出　　处：《兵工学报》2018年第2期315-324,共10页Acta Armamentarii

基　　金：国家自然科学基金项目(61374115;61533008;61533009;61673208;61703208);陆军装备部"十三五"预先研究项目(30102080101);江苏省"333工程"科研项目(BRA2016405);江苏省六大人才高峰项目(2013-JY-013);航空科学基金项目(20165552043;20165852052);江苏高校优势学科建设工程项目(2014年);江苏省"物联网与控制技术"重点实验室基金项目(2014年);中央高校基本科研业务费专项项目(NZ2016104;NS2017016;NP2017209;NZ2017001;NJ20170005);江苏省自然科学基金项目(BK20170815;BK20170767)

摘　　要：传统惯性/卫星/天文组合导航系统联邦滤波中主滤波器和子滤波器状态量保持一致,而天文姿态信息仅对部分状态具有可观测性。常用的惯性/天文组合模式需将高精度的天文姿态信息进行坐标转换,从而降低组合导航精度。针对上述问题,提出了一种基于对偶四元数的惯性/卫星/天文组合导航系统改进联邦滤波方法,通过可观测性分析对子滤波器进行降维,能在保证导航精度的同时提高系统实时性。基于对偶四元数的降维惯性/天文组合方法可直接利用天文姿态信息进行组合,实现了天文高精度信息的有效利用,且避免将不可观测状态进行反馈修正从而提高组合精度。仿真结果表明,提出的改进联邦滤波方法能获得与集中式滤波相当的精度,在卫星信号丢失或故障情况下,相比于传统惯性/天文组合具有更优的性能。In traditional SINS/GNSS/CNS federal filter,the master filter and the local filters have the same state variables. However,the attitudes information output by CNS is observable for some state components in state vector. In common SINS/CNS integrated mode,the output information of CNS needs to be converted to navigation coordinate frame,which may decrease the accuracy of integrated navigation system. For the problems above,an improved SINS/GNSS/CNS federal filter based on dual quaternions is proposed. The dimension of local filter is decreased by the observability analysis of state vector,which assures the navigation accuracy and improves the real-time performance at the same time. The improved SINS/CNS integrated mode based on dual quaternions can utilize the attitudes information of CNS to integrate directly and avoid using those unobservable state components to correct SINS. Thus,the effective use of high precision CNS information is realized. The simulated results show that the proposed methodhas the same navigation accuracy as centralized Kalman filter,and can obtain better navigation performance when GNSS signal is lost.

关 键 词：捷联惯性导航系统 卫星导航系统 天文导航系统 对偶四元数 可观测性分析 联邦滤波 

分 类 号：V249.328[航空宇航科学与技术—飞行器设计]