基于EKF的地磁/陀螺信息融合姿态测量算法研究

摘要

针对智能弹药机动飞行中仅利用地磁信息制导时无法实现全姿态角解算的问题,提出一种采用三轴陀螺仪角速率信息辅助三轴磁传感器信息进行弹体姿态角解算的EKF融合算法.算法利用磁传感器测量模型和四元数微分方程建立观测方程和状态方程,并分别对非线性的系统进行线性化得到卡尔曼滤波方程.通过在高速飞行仿真转台上进行半物理仿真试验,最终全姿态角的解算实现对地磁/陀螺信息的融合.经过对仿真信号的处理,在弹体俯仰角±30°变化的情况下,该EKF融合算法解算滚转角和俯仰角比传统单纯依靠地磁信息进行滚转角和俯仰角解算的精度提高近一个数量级,并且解算偏航角误差在1°以内.