飞控中 Mahony 互补滤波的设计思路
哪些公司问过
答案要点
- 思路是用加速度计、磁力计的长期稳定性修正陀螺仪积分漂移
- 误差由测量的重力向量与姿态估计出的重力向量叉积得到,磁力计误差用于修正偏航
- PI 控制器补偿角速度:Kp 决定收敛速度,Ki 用于估计和消除陀螺零偏
- 修正后的角速度用于四元数积分更新并归一化,计算量小适合嵌入式实时运行
易错点
- 说加速度计能修正偏航角,实际重力方向对偏航没有约束
- 忘记对加速度计向量和四元数做归一化
- 不理解积分项的作用是补偿陀螺仪零偏
面试官常见追问
- Kp 和 Ki 调大调小各有什么影响?
- Mahony 和卡尔曼滤波相比怎么样?
- 没有磁力计时偏航角会怎样?
完整的口述示范答案、每个追问的参考回答,在启面刷题中心查看;也可以让 AI 面试官用语音按这道题连环追问你。