四元数扩维无迹卡尔曼滤波算法及其在大失准角快速传递对准中的应用  

Quaternion augmented unscented Kalman filter and its application to rapid transfer alignment under large misalignment

作　　者：周卫东[1] 吉宇人[1] 乔相伟[1] 

机构地区：[1]哈尔滨工程大学自动化学院

出　　处：《控制理论与应用》2011年第11期1583-1588,共6页Control Theory & Applications

基　　金：国家自然科学基金资助项目(60834005)

摘　　要：针对快速传递对准中量测失准角为大角度的情况,在非线性欧拉角误差模型基础上,推导了一种基于乘性四元数的等效快速传递对准模型.为解决四元数在无迹卡尔曼滤波(UKF)算法中的应用问题,提出了一种基于四元数的状态扩维无迹卡尔曼滤波(Q--AUKF)算法.该算法将系统噪声增广到状态向量中,解决了乘性四元数噪声无法进行向量意义下四则运算的问题.针对四元数加权均值规范化的限制,采用平均四元数算法保证其正交规范化要求.最后将其应用到快速传递对准中的仿真实验结果表明,在量测误差角为大角度的情况下,该算法具有更高的估计精度与收敛速度.An equivalent rapid transfer alignment model based on the multiplicative quaternion is derived for large misalignment measurements on the basis of nonlinear Euler angle error model.In order to apply quaternion to the un-scented Kalman filter（UKF）,a quaternion augmented UKF（Q-AUKF） algorithm is proposed.The arithmetic problem of multiplicative quaternion noise is solved by augmenting the system noise onto the state vector.An average quaternion method is adopted to guarantee the normalization of weighted quaternion.The Q-AUKF algorithm is applied to the rapid transfer alignment model and the simulation results show that the proposed algorithm has higher filter accuracy and faster convergence speed.

关 键 词：快速传递对准 乘性四元数 无迹卡尔曼滤波 规范性 

分 类 号：E911[军事]