一种针对星敏感器和陀螺联合滤波的改进方法

摘要

本发明公开了一种针对星敏感器和陀螺联合滤波的改进方法，其包含：步骤1，构造扩展卡尔曼滤波器，进行扩展卡尔曼滤波算法；步骤2，确定出扩展卡尔曼滤波算法的输入量四元数测量值q_s的跳变时刻：四元数测量值的标部小于阈值，且，四元数测量值矢量部分中绝对值最大的数的当前拍与前一拍异号；步骤3，在跳变时刻，重置四元数参考值以获得跳变时刻与四元数测量值相适应的四元数参考值；步骤4，以重置后的继续进行扩展卡尔曼滤波算法。本发明通过重置跳变时刻四元数参考值的方法解决了四元数测量值跳变导致四元数估计值需重新收敛的问题，为姿态确定系统提供了稳定地连续地高精度姿态信息；同时该方法算法简单，星载软件容易实现，可靠性高。