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

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.