Fast data fusion method for MGNC integrated navigation system
-
摘要: 微小型导航制导控制系统MGNC(Micro Guidance Navigation and Control)传感器多,且数据处理能力有限,为实时提供导航结果,传统上采用降维滤波提高实时性,但这样会造成精度损失.为保证不减少滤波状态量,不损失精度,针对捷联和滤波特点提出一种新的实时解算方法:在捷联解算中以直接递推求解方向余弦矩阵代替以四元数为中间变量进行的间接求解;在滤波计算中用序贯方法处理量测修正值,避免复杂的矩阵求逆;采用稀疏矩阵三元组法,应用于协方差阵计算,减少乘法次数.仿真和实验证明改进算法对计算精度没有损失,且滤波计算时间比原算法减少了34.50%,显著提高了MGNC系统的实时性、鲁棒性和实用性.Abstract: To reduce the computation time of the integrated navigation, an improved algorithm was proposed without model state vector reduction for the micro guidance navigation and control (MGNC) system. The direction cosine matrix was deserved by iterative computation instead of using quaternion as an intermediary. The measurement correction was processed one by one to avoid computing the matrix reciprocal. A triple elements method was proposed based on the sparseness of the transformation matrix while calculating the covariance matrix forecast equation. Mathematical simulation and experiment show that the improved algorithm can provide the same accuracy as the traditional method for navigation and can reduce the filtering calculation time by 34.50%. The method can improve the robustness of the MGNC system and is quite useful in practical application.
-
Key words:
- integrated navigation /
- real time /
- the direction cosine matrix /
- iterative computation /
- sparse matrix
-
[1] 吴海仙,俞文伯,房建成.高空长航时无人机SINS/CNS组合导航系统仿真研究[J].航空学报,2006,27(2):299-304 Wu Haixian,Yu Wenbo,Fang Jiancheng.Simulation of SINS/CNS integrated navigation system used on high altitude longflight-time unpiloted aircraft[J]. Acta Aeronautica et Astronautica Sinica,2006,27(2): 299-304 (in Chinese) [2] 刘志国,王仕成,邓方林,等. 基于降阶模型的GPS/PINS 组合导航试验研究[J].系统仿真学报,2007,19(3):637-643 Liu Zhiguo, Wang Shicheng, Deng Fanglin, et al. Research on GPS/PINS integrated navigation semi-physical simulation based on order reduced model [J]. Journal of System Simulation, 2007,19(3): 637-643(in Chinese) [3] 曹娟娟,房建成,盛蔚. 一种组合导航系统快速滤波方法及半物理仿真[J]. 北京航空航天大学学报,2006,32(11):1281-1285 Cao Juanjuan,Fang Jiancheng,Sheng Wei. Fast data fusion method for integrated navigation system and hardware in loop simulation [J]. Journal of Beijing University of Aeronautics and Astronautic, 2006,32(11):1281-1285(in Chinese) [4] 扈光锋,马小艳,王艳东, 等. 北斗双星/SINS 组合导航实时滤波方法[J]. 弹箭与制导学报,2005,25(2):39-42 Hu Guangfeng, Ma Xiaoyan, Wang Yandong, et al. A method of real-time filter in RDSS/SINS integrity navigation system [J]. Journal of Missile and Guidance, 2005, 25(2):39-42 (in Chinese) [5] 李连仲,王小虎,蔡述江. 捷联惯性导航、制导系统中方向余弦矩阵的递推算法[J].宇航学报,2006,27(3):349-353 Li Lianzhong, Wang Xiaohu, Cai Shujiang. A new recursion formula used in the matrix of the direction cosine in the strapdown inertial navigation and guidance system [J]. Journal of Astronautics, 2006,27(3):349-353(in Chinese) [6] 董绪荣,张守信,华仲春.GPS/INS组合导航定位及其应用[M].长沙:国防科技大学出版社,1998:265-271 Dong Xurong,Zhang Shouxin,Hua Zhongchun. Position and application of GPS/INS integrated navigation system [M].Changsha:National University of Defense Technology Press,1998:265-271(in Chinese) [7] Bierman G J. A comparison of discrete linear filter algorithm [J]. IEEE Trans on Aerospace and Electronic Systems, IEEE-AES9(1) ,1973(a):28-37 [8] Bierman G J. Factorization methods for discrete sequential estimation [M]. New York:Academic Press,1977:245-252
点击查看大图
计量
- 文章访问数: 4411
- HTML全文浏览量: 155
- PDF下载量: 2233
- 被引次数: 0