一种基于Euler－q算法和DD2滤波的航天器姿态确定方法

摘要

一种基于Euler-q(Euler-quaternion)算法和DD2(Divided Difference2)滤波的航天器姿态确定方法，本发明涉及一种基于矢量观测的状态估计姿态确定方法。其特征在于根据参考星历和由星敏感器观测得到的参考矢量和观测矢量，通过Euler-q算法获得航天器姿态四元数，经过DD2滤波，一方面反馈校正陀螺解算获得的姿态阵，另一方面，修正三轴陀螺角速度输出，对陀螺仪的常值漂移进行补偿。这样既可以得到高精度实时的航天器姿态信息，又可以在线标定陀螺仪的常值漂移。本发明是一种自主式姿态确定方法，具有精度高，实时性好，简便易行的特点，可应用于各种航天器的姿态确定系统。