米 刚,田增山,金 悦,李 泽,周 牧
(重庆邮电大学移动通信技术重庆市重点实验室,重庆 400065)
基于MIMU和磁力计的姿态更新算法研究*
米 刚,田增山*,金 悦,李 泽,周 牧
(重庆邮电大学移动通信技术重庆市重点实验室,重庆 400065)
针对传统人体姿态解算算法中存在MEMS陀螺误差发散快的问题,提出一种基于微惯性测量单元(MIMU)及磁力计信息融合的姿态解算算法。该算法利用互补滤波结合PI调节控制完成陀螺零偏校正,然后在加速度计和磁强计的辅助校正下,通过EKF(Expand Kalman Filter)滤波器更新四元数法实现陀螺姿态解算。本算法采用MPU9150传感器模块完成测试实验,实验中对比分析了单独扩展卡尔曼滤波算法与本算法的滤波效果。实验结果表明,本算法能够有效地抑制陀螺的发散,实现稳定地输出高精度姿态数据。
传感器;姿态解算;陀螺校正;互补滤波;PI调节;EKF
人体姿态的准确解算是实现行人航迹推算系统的基础,其在行人定位系统的研究中起着很重要的作用。随着MEMS(Micro-Electro-Mechanical Systems)及计算机技术的快速发展,由陀螺、加速度计组成的微惯性测量单元MIMU(Miniature Inertial Measuringunit),辅以微磁力计,组成了航向姿态参考系统AHRS(Attitude and Heading Reference System),其可实现载体的全姿态参数测量。在AHRS中,加速计同时对重力加速度和运动加速度敏感,并且磁传感器易受铁磁性物质干扰,所以利用加速度计和磁传感器的测量值解算姿态角在载体运动情况下易产生较大误差。同时MEMS陀螺也存在零偏问题,短时间内陀螺偏移也会引起较大的姿态误差。
常用的解决上述问题的方法是采用互补滤波和卡尔曼滤波器。……