四元數姿態解算中的地磁計融合解讀

    筆者最近在作四軸，涉及到地磁計的融合算法，網上大多數是x-IMU的融合代碼，可是這段代碼對於地磁計的融合說明沒有作過多的解釋，網上沒有相關討論，僅在阿莫論壇看到一篇相關的代碼解釋，裏面有關於地磁計融合部分的解說，我的以爲說的不是很清楚，雖然是正確的，我這裏再補充囉嗦一下。算法     首先給出x-IMU關於陀螺儀、加速度計、地磁計的融合代碼：數組 void MahonyAHRSupdate

>>阅读原文<<