QCKF based rapid transfer alignment for large misalignment angles
-
摘要: 提出了一种机载武器捷联惯导系统大失准角情况下快速传递对准QCKF(Quaternion Cubature Kalman Filter)算法.采用乘性四元数表示失准角,建立了基于四元数的速度加姿态匹配传递对准模型.将噪声扩维为状态思想应用到CKF(Cubature Kalman Filter)中以解决非线性过程噪声和量测噪声问题.考虑到表示旋转的四元数具有规范化以及符号相反的四元数表示相同旋转的性质,对CKF算法中关于四元数部分加权求均值转变为约束条件下基于投影长度的加权求均值,对CKF算法中关于四元数部分求方差进行符号预处理.仿真结果表明算法能在大失准角情况下提高对准精度.Abstract: A quaternion cubature Kalman filter(QCKF) based rapid transfer alignment for airborne weapon-s strapdown inertial navigation system with large misalignment angles was presented. The transfer alignment of velocity plus attitude match model based on multiplicative quaternion was derived. The idea of augmenting the noise into the state vector was adopted to handle the nonlinear process and measurement noise. Considering the rotation quaternion has the characteristics of normalization and quaternion with opposite sign represents the same rotation, the weighted averaging of quaternion part in cubature Kalman filter(CKF) algorithm was changed into projection length weighted averaging with constraint conditions and the quaternion-s sign was processed before calculating covariance in the CKF algorithm. Simulation results show that the proposed algorithm can improve the alignment accuracy in large misalignment angles case.
-
[1] Kain J E, Cloutier J R.Rapid transfer alignment for tactical weapon applications[C]//Proceedings of the AIAA Guidance, Navigation and Control Conference.Boston:MA, 1989:1290-1300 [2] Lyou J, Lim Y C.Transfer alignment considering measurement time delay and ship body flexure[J].Journal of Mechanical Science and Technology, 2009, 23(1):195-203 [3] Yu M J, Lee J G, Park H W.Comparison of SDINS in-flight alignment using equivalent error models[J].IEEE Transactions on Aerospace and Electronic Systems, 1999, 35(3):1046-1053 [4] Groves P D.Optimising the transfer alignment of weapon INS[J].The Journal of Navigation, 2003, 56(2):323-335 [5] 韩英宏, 陈万春.新型快速传递对准方法[J].北京航空航天大学学报, 2012, 38(2):149-152 Han Yinghong, Chen Wanchun.New method for rapid transfer alignment[J].Journal of Beijing University of Aeronautics and Astronautics, 2012, 38(2):149-152(in Chinese) [6] 高青伟, 赵国荣, 吴芳.大方位失准角传递对准非线性模型研究[J].控制与决策, 2011, 26(3):402-406 Gao Qingwei, Zhao Guorong, Wu Fang.Research on nonlinear error model of transfer alignment with large azimuth misalignment angle[J].Control and Decision, 2011, 26(3):402-406(in Chinese) [7] 孙枫, 唐李军.基于CKF的SINS大方位失准角初始对准[J].仪器仪表学报, 2012, 33(2):327-333 Sun Feng, Tang Lijun.Initial alignment of large azimuth misalignment angle in SINS based on CKF[J].Chinese Journal of Scientific Instrument, 2012, 33(2):327-333(in Chinese) [8] 熊芝兰, 郝燕玲, 孙枫.基于四元数的惯导系统快速匹配对准算法[J].哈尔滨工程大学学报, 2008, 29(1):28-34 Xiong Zhilan, Hao Yanling, Sun Feng.Rapid matching alignment algorithm of inertial navigation system based on quaternion[J].Journal of Harbin Engineering University, 2008, 29(1):28-34(in Chinese) [9] 周卫东, 吉宇人, 乔相伟.四元数扩维无迹卡尔曼滤波算法及其在大失准角快速传递对准中的应用[J].控制理论与应用.2011, 28(11):1583-1588 Zhou Weidong, Ji Yuren, Qiao Xiangwei.Quaternion augmented unscented Kalman filter and its application to rapid transfer alignment under large misalignment[J].Control Theory & Applications, 2011, 28(11):1583-1588(in Chinese) [10] Arasaratnam I, Haykin S.Cubature Kalman filters[J].IEEE Transactions on Automatic Control, 2009, 54(6):1254-1269 [11] 解春明, 赵剡, 邓俊云.一种改进的自适应平方根传递对准滤波算法[J].系统工程与电子技术, 2011, 33(3):622-626 Xie Chunming, Zhao Yan, Deng Junyun.Improved adaptive square root filtering algorithm for transfer alignment[J].Systems Engineering and Electronics.2011, 33(3):622-626(in Chinese) [12] 秦永元.惯性导航[M].北京:科学出版社, 2006 Qin Yongyuan.Inertial navigation[M].Beijing:Science Press, 2006(in Chinese) [13] 周卫东, 乔相伟, 任蕾, 等.QUKF算法及其在SINS初始对准中的应用[J].仪器仪表学报, 2010, 31(2):264-269 Zhou Weidong, Qiao Xiangwei, Ren Lei, et al.Quaternion unscented Kalman filter and its application to initial alignment of SINS[J].Chinese Journal of Scientific Instrument, 2010, 31(2): 264-269(in Chinese) [14] Julier S J, Uhlmann J K.Unscented filtering and nonlinear estimation[J].Proceedings of the IEEE, 2004, 92(3):401-422 [15] Sun Feng, Tang Lijun.Augmented and nonaugmented cubature Kalman filter[J].Journal of Information & Computational Science, 2012, 9(2):437-450 [16] Markley F L, Cheng Y, Crassidis J L, et al.Quaternion averaging[J].Journal of Guidance, Control, and Dynamics, 2007, 30(4):1193-1197
点击查看大图
计量
- 文章访问数: 3699
- HTML全文浏览量: 163
- PDF下载量: 503
- 被引次数: 0