基于KF的自平衡机器人姿态角补偿方法

Position Angular Compensation for Self-Balance Robot Based on Kalman Filtering

  • 摘要: 研究基于卡尔曼滤波(KF)的低通滤波补偿方法,对采用单轴加速度计的自平衡机器人姿态角测量系统进行补偿,消除由于振动、冲击等引起的信号失真,增强控制系统的稳定性. 根据前期研究及实验,深入分析振动、冲击对传感器信号的影响,提出了一种基于最小二乘拟合原理的姿态角计算模型. 在获得机器人自由振荡频率的基础上,设计了基于KF的混合低通滤波单元,并进行了物理模型实验. 结果表明,该补偿方法能完全消除振动造成的传感信号失真. 此外,该补偿方法对强烈冲击所造成的信号波动亦有明显衰减,能显著提升自平衡机器人的稳定性.

     

    Abstract: This paper studies the compensation method based on low pass KF filter to eliminate the signal distortion caused by vibration or shock in angular position measurement system using single-axis accelerometers, and to improve the system stability. Least square fitting principle was used to build the posture angle calculation model, a hybrid low-pass filter was designed after getting the free frequency, and the physical test was implemented. The results show that the proposed compensation method can completely eliminate the signal distortion caused by high frequency vibrations, and it can also significantly improve the stability of self-balancing robot as well as the signal fluctuations caused by heavy impact.

     

/

返回文章
返回
Baidu
map