Attitude estimation based on quaternion square-root cubature Kalman filter
-
摘要: 针对飞行器姿态确定中乘性扩展卡尔曼滤波(MEKF, Multiplicative Extended Kalman Filter)在较大初始姿态误差角情况下存在估计精度低及收敛速度慢的问题,提出了一种四元数平方根容积卡尔曼滤波(QSCKF,Quaternion Square-root Cubature Kalman Filter)算法.在推导姿态确定系统四元数非线性误差模型的基础上,采用容积数值积分理论来计算非线性函数的均值与方差,同时使用平方根的形式来提高数值稳定性;针对四元数规范化问题,采用拉格朗日代价函数法求解四元数加权均值.仿真结果表明:在初始姿态误差较大的情况下,该算法相比较于MEKF以及无迹四元数估计法(USQUE, Unscented Quaternion Estimator),估计精度高且收敛速度快,滤波稳定性好,同时估计时间比USQUE缩短了1/3.
-
关键词:
- 平方根容积卡尔曼滤波 /
- 四元数 /
- 拉格朗日代价函数法 /
- 姿态估计
Abstract: Considering that a multiplicative extended Kalman filter (MEKF) existed lower estimation accuracy and slower convergence rate for large initialization errors, a quaternion square-root cubature Kalman filter (QSCKF) was proposed. A quaternion nonlinear error model was derived for attitude determination system, and then the cubature numerical integration theory was used to calculate the mean and variance of the nonlinear function. The square-root forms were used to improve numerical stability. To avoid the quaternion normalization problem, a Lagrange loss function was derived to compute the average quaternion. The simulation results indicate that the proposed algorithm provides higher estimation precision with faster convergence rate and better filter's stability than MEKF and unscented quaternion estimator (USQUE) for large initialization errors. And, the estimated time of this algorithm is shortened by 1/3 compared to USQUE. -
[1] Markley F L.Attitude error representations for Kalman filtering[J].Journal of Guidance,Control,and Dynamics,2003,26(2):311-317 [2] Choukroun D,Bar-Itzhack I Y,Oshman Y.Novel quaternion Kalman filter[J].IEEE Transactions on Aerospace and Electronic Systems,2006,42(1):174-190 [3] Hamada M,Khayatian A,Karimaghaee P.Attitude estimation by divided difference filter in quaternion space[J].Acta Astronautica,2012,75:95-107 [4] Lefferts E J,Markley F L,Shuster M D.Kalman filtering for spacecraft attitude estimation[J].Journal of Guidance Control and Dynamics,1982,5(5):417-429 [5] Crassidis J L,Markley F L.Unscented filtering for spacecraft attitude estimation[J].Journal of Guidance Control and Dynamics,2003,26(4):536-542 [6] Tang Xiaojun,Liu Zhenbao,Zhang Jiasheng.Square-root quaternion cubature Kalman filtering for spacecraft attitude estimation[J].Acta Astronautica,2012,76:84-94 [7] Oshman Y,Carmi A.Attitude estimation from vector observations using genetic-algorithm-embedded quaternion particle filer[J].Journal of Guidance Control and Dynamics,2006,29(4):879-891 [8] Markley F L,Cheng Yang,Crassidis J L,et al.Averaging quaternions[J].Journal of Guidance Control and Dynamics,2007,30(4):1193-1197 [9] 乔相伟,周卫东,吉宇人.用四元数状态切换无迹卡尔曼滤波器估计的飞行器姿态[J].控制理论与应用,2012,29(1): 97-103
Qiao Xiangwei,Zhou Weidong,Ji Yuren.Aircraft attitude estimation based on quaternion state-switching unscented Kalman filter[J].Control Theory & Applications,2012,29(1):97-103(in Chinese)[10] Arasaratnam I,Haykin S.Cubature Kalman filters[J].IEEE Transactions on Automatic Control,2009,54(6):1254-1269 期刊类型引用(17)
1. 王金硕,何冉,刘海平. 高超滑翔飞行器对地侦察轨迹的分段优化策略. 战术导弹技术. 2025(01): 113-125+135 . 百度学术
2. 汪馨茹,苏子康,荆献勇,曾靖轩,黄宇. 基于未知坡度倾斜跑道地形融合的无人机定点着陆轨迹优化. 战术导弹技术. 2024(06): 94-106 . 百度学术
3. 熊文祥,陈倩,汪守利,杨贵玉,杨钊. 基于二阶锥规划的飞行器滑翔段轨迹优化. 导航与控制. 2024(Z1): 129-136 . 百度学术
4. 徐慧,蔡光斌,崔亚龙,侯明哲,姚二亮. 高超声速滑翔飞行器再入轨迹优化. 哈尔滨工业大学学报. 2023(04): 44-55 . 百度学术
5. 邵雷,李明杰,赵锦. 基于局部模型的再入滑翔类飞行器轨迹在线调整算法设计. 空军工程大学学报. 2023(03): 64-72 . 百度学术
6. 王帅,杨冬,陈贵亮,唐润智. 基于自适应radau伪谱法的机械手轨迹规划方法研究. 制造业自动化. 2022(03): 103-108+117 . 百度学术
7. 周池军,邵雷,骆长鑫,李明杰,雷虎民. 高动态目标拦截弹制导与控制前沿技术展望. 空天技术. 2022(02): 61-74 . 百度学术
8. 吕名添,周祥,张洪波. 基于解析初值的滑翔飞行器轨迹快速规划方法. 宇航总体技术. 2022(04): 35-40 . 百度学术
9. 张伟,陈国明,黄威,薛辉辉. 空投变掠翼滑翔炸弹轨迹优化. 飞行力学. 2022(06): 39-43 . 百度学术
10. 宋少倩,陈永信,任鹏飞,周文勇,李伟喆. 面向航程能力的固体火箭发动机方案设计优化. 哈尔滨工业大学学报. 2022(12): 27-37 . 百度学术
11. 王培臣,张睿轩,闫循良. 不确定条件下高超声速俯冲弹道鲁棒优化. 飞控与探测. 2022(06): 61-68 . 百度学术
12. 刘平,刘航,仇国庆,刘兴高. 热率约束下高超声速飞行器Gauss时间网格参数化轨迹规划. 控制理论与应用. 2022(12): 2283-2292 . 百度学术
13. 贾高伟,王建峰. 无人机集群任务规划方法研究综述. 系统工程与电子技术. 2021(01): 99-111 . 百度学术
14. 颜楚雄,王蕴宝,秦绪国,童轶男,宋加洪. 最小动压约束下的全程轨迹优化设计方法. 导弹与航天运载技术. 2021(01): 86-90 . 百度学术
15. 任鹏飞,王洪波,周国峰,王亮,蔡强,韩英宏,余家泉,袁亚. 临近空间固体动力飞行器发动机与轨迹一体化设计优化. 推进技术. 2021(09): 1936-1947 . 百度学术
16. 陈永信. 滑翔飞行器气动外形与轨迹一体化设计优化. 空天防御. 2021(03): 76-84 . 百度学术
17. 崔乃刚,郭冬子,李坤原,韦常柱. 飞行器轨迹优化数值解法综述. 战术导弹技术. 2020(05): 37-51+75+5 . 百度学术
其他类型引用(14)
-

计量
- 文章访问数: 2575
- HTML全文浏览量: 201
- PDF下载量: 1098
- 被引次数: 31