航空学报 > 2010, Vol. 31 Issue (1): 165-171

基于可观测度分析的稳定姿态滤波器

苗育红1,2, 周江滑3   

  1. 1.第二炮兵工程学院 603教研室 2.清华大学 自动化系 3.中国科学院 光电研究院
  • 收稿日期:2008-11-28 修回日期:2009-03-02 出版日期:2010-01-25 发布日期:2010-01-25
  • 通讯作者: 苗育红

Stable Extended Kalman Filter for Attitude DeterminationBased on Observability Analysis

Miao Yuhong1,2, Zhou Jianghua3   

  1. 1.Department 603, Second Artillery Engineering College 2.Department of Automation, Tsinghua University 3.Institute of Optics and Electronics, Chinese Academy of Siences
  • Received:2008-11-28 Revised:2009-03-02 Online:2010-01-25 Published:2010-01-25
  • Contact: Miao Yuhong

摘要:

提出一种适用于惯性/天文组合航天飞行器的稳定姿态滤波器,可以在不降低系统可观测度的前提下解决滤波计算中的奇异问题。对于奇异问题的传统解决方案是删除观测方程的一行,通过对比删除前后系统可观测度的变化,证明此解决方案会导致系统可观测度下降,并指出如何选择最优删除方案以使系统可观测度下降最小。根据对传统解决方案的分析结果,提出了不降低系统可观测度的投影算法。理论分析和仿真试验证明,应用了投影算法的姿态滤波器更为稳定,估计效率更高。

关键词: 姿态估计, 天文导航, 卡尔曼滤波, 可观测度, 系统稳定性

Abstract: This article presents a stable extended Kalman filter algorithm for spacecraft attitude determination by means of angular rate and vector observation. The filter using the proposed algorithm can solve the singularity in the filtering computation without any loss of system observability degree. The traditional singularity-solving method is to delete a line from the measurement equation. By comparing the system observability degree after and before the line deleting, it is proved that the traditional method tends to decrease the system observability degree. This article also proposes a method to choose the optimal deleting line to reduce the obser-vability degree loss to a minimum. The proposed projection algorithm gives a general solution to the singularity problem without observability degree loss. Theoretical analysis and numerical simulation show that an attitude filter using the projection algorithm provides more stable performance and higher estimation efficiency than one using the traditional method.

Key words: attitude estimation, celestial navigation, Kalman filtering, observability degree, system stability

中图分类号: