论文部分内容阅读
针对基于磁强计的组合导航研究中,须事先确定滚转角这一不足,提出了一种磁强计和MEMS陀螺组合确定姿态的四元数卡尔曼滤波算法。利用陀螺测量的姿态角速率,结合磁强计输出的地磁分量测量值,运用卡尔曼滤波算法对三个姿态角同时进行最优估计,而不需要先验假设。仿真误差分析表明:姿态角解算结果具有较小的误差,且不随时间积累。