磁强计和微机械陀螺/加速度计组合定姿的扩展卡尔曼滤波器设计

摘要

微机械陀螺近年来获得广泛应用,但是由于其性能较低,并不能提供长时间的稳定的姿态,必须和其它传感器组合使用.提出了一种基于磁强计和微机械陀螺/加速度计组合姿态确定的四元数卡尔曼滤波算法,该算法利用加速度计的输出判断是否使用卡尔曼滤波器计算姿态,并在卡尔曼滤波器中利用加速度计和磁强计计算的姿态角补偿陀螺的漂移.仿真和实验结果表明了该算法的有效性.