MIMU和磁强计组合在线定姿算法研究

摘要

为了满足航姿参考系统(AHRS)小型化、低成本工程实现的需要,基于微惯性测量单元(MIMU)和微磁强计,提出了一种在线实时定姿方法.该方法首先采用四元数法描述系统模型,接着利用优化的梯度下降算法对加速度计和磁强计测得的数据进行处理,然后采用快速小波变换阈值去噪方法对陀螺仪输出信号进行预处理,最后通过互补滤波器将以上得到的结果进行融合,提高了姿态解算精度.在线测试和Kalman滤波表明,在线定姿法实现简单、参数调整方便、姿态跟踪误差小,便于在嵌入式微处理器中实现,具有较强的实用性.