一种基于迭代容积卡尔曼滤波姿态估计方法

摘要

本发明公开了一种基于迭代容积卡尔曼滤波姿态估计方法，包括以下几个步骤：步骤一：采集陀螺与星敏感器的输出数据作为量测量；步骤二：确定状态向量和量测向量；步骤三：在k‑1时刻利用迭代容积卡尔曼滤波估计出k时刻的误差四元数矢量部分以及陀螺漂移误差；步骤四：对于k时刻的估计求出四元数估计及陀螺漂移估计，对姿态及陀螺漂移进行校正，得到修正后k时刻姿态及陀螺漂移；步骤五：姿态估计非线性离散系统的运行时间为M，若k＝M，则输出姿态及陀螺漂移的结果；若k＜M，则重复步骤三至步骤四，直至姿态估计系统运行结束。本发明具有估计精度高、计算量少的优点。