Mahony姿态解算算法的原理
哪些公司问过
答案要点
- 本质是基于四元数的互补滤波:以陀螺仪积分为主,用加速度计和磁力计修正漂移
- 误差取加速度计测得的重力方向与四元数推算重力方向的叉积
- PI修正:Kp决定收敛速度,Ki积分项估计并补偿陀螺零偏
- 修正后的角速度代入四元数微分方程更新姿态,并对四元数归一化
- 仅用加速度计无法修正航向角,九轴版本借助磁力计修正yaw
易错点
- 把梯度下降说成Mahony的核心,那是Madgwick算法的做法
- 以为只用六轴数据就能得到不漂的航向角
- 忘记对加速度向量和四元数做归一化
- 运动加速度大时仍完全信任加速度计,导致姿态被拉偏
面试官常见追问
- Mahony和Madgwick有什么区别?
- Kp、Ki怎么调?
- 和卡尔曼滤波相比如何?
完整的口述示范答案、每个追问的参考回答,在启面刷题中心查看;也可以让 AI 面试官用语音按这道题连环追问你。