摘要:针对站球机器人在坡面运动过程中,由于系统振荡倾向性导致的姿态估计不准确以及在估计中存在噪声等问题,设计 了一种基于 Huber 鲁棒估计的改进互补滤波姿态解算算法。 首先,对站球机器人在斜坡上进行了动力学分析和运动性能分析。 其次,利用 Huber 鲁棒估计抑制站球机器人在坡面运动过程中由于机身振荡所引入的干扰噪声,并改进互补滤波进行姿态解 算。 最后,为了减少磁力计输出不稳定对姿态解算的干扰,设计了一种数据平滑切换方法。 实物实验结果表明,设计的基于 Huber 鲁棒估计的改进互补滤波姿态解算算法相比于互补滤波算法,对俯仰角、横滚角和偏航角的估计精度分别平均提高 19. 21%、25. 48%和 36. 04%,该算法可以有效地抑制站球机器人在坡面运动过程中由于机身振荡引入的噪声,能够保证姿态解 算的准确性和实时性。