基于地磁信息辅助GPS的高旋转载体的测姿方法及装置

摘要

本发明提供了一种基于地磁信息辅助GPS的高旋转载体的测姿方法及装置，该方法利用地磁传感器输出的三轴模拟地磁信息、GPS接收机输出的位置信息、速度信息与时间信息和世界地磁模型输出的地磁分量得到实时的航向角、实时的俯仰角和解算出的滚转角，再基于解算出的滚转角、弹体的转速和采样计数推算得到实时的滚转角，从而得到弹体实时的姿态角。本发明解决了姿态解算周期大于弹体旋转周期的解算滞后问题，实现了在姿态解算滞后的情况下，通过采样点推算获取实时的姿态信息，从而有效解决了传统硬件运算速率不能满足高旋转弹体的实时姿态解算的工程问题。本发明还解决了因GPS接收机定位频率低而引起的与地磁传感器采样时间不同步问题。