IMU姿态融合算法

本文为博主“声时刻”原创文章，未经博主允许不得转载。
联系方式：[email protected]

##高低通滤波，EKF，Mahony滤波

IMU姿态融合算法，MPU9250,高低通滤波，EKF，互补滤波

###蓝牙传输的数据为100Hz
###计算所用的时间 : Mahony$<$高低通$<$EKF

EKF出自论文《A Double-Stage Kalman Filter for Orientation Tracking with an Integrated Processor in 9-D IMU》

Mahony的网上代码很多。利用预测姿态计算的重力，磁力计向量夹角进行PI控制。

高低通是自己想的，应该和互补滤波一样，角速度计算的姿态高通滤波，加速度与磁力计计算的姿态低通滤波。

###补充
新写的一篇关于IMU校正与姿态融合的博客IMU校正以及姿态融合，里面有更好校正参数。
具体请参考github开源代码：IMUCalibration-Gesture.

赞助：如果您觉得此文对您所要做的工作有帮助，欢迎打赏。或者帮忙在github上标星星。

---