IMU Data Fusing: Complementary, Kalman, and Mahony Filter
这篇国外的文章应该是相当 权威、完整了,先看这个 总结 主要内容、思想
记录下 两个公式
pitch = 180 * atan (accelerationX/sqrt(accelerationY*accelerationY + accelerationZ*accelerationZ))/M_PI;
roll = 180 * atan (accelerationY/sqrt(accelerationX*accelerationX + accelerationZ*accelerationZ))/M_PI;
http://x-io.co.uk/open-source-imu-and-ahrs-algorithms/
这个好像是一个比较有名的求位姿算法
四元数AHRS姿态解算和IMU姿态解算分析
http://www.bspilot.com/?p=121
这大概是一个代码注释