Extended Kalman Filter-Enhanced LQR for Balance Control of Wheeled Bipedal Robots

With the rapid development of mobile robotics, wheeled bipedal robots, which combine the terrain adaptability of legged robots with the high mobility of wheeled systems, have attracted increasing research attention. To address the balance control problem during both standing and locomotion while reducing the influence of noise on control performance, this paper proposes a balance control framework based on a Linear Quadratic Regulator integrated with an Extended Kalman Filter (KLQR). Specifically, a baseline LQR controller is designed using the robot’s dynamic model, where the control input is generated in the form of wheel-hub motor torques. To mitigate measurement noise and suppress oscillatory behavior, an Extended Kalman Filter is applied to smooth the LQR torque output, which is then used as the final control command. Filtering experiments demonstrate that, compared with median filtering and other baseline methods, the proposed EKF-based approach significantly reduces high-frequency torque fluctuations. In particular, the peak-to-peak torque variation is reduced by more than 60%, and large-amplitude torque spikes observed in the baseline LQR controller are effectively eliminated, resulting in continuous and smooth torque output. Static balance experiments show that the proposed KLQR algorithm reduces the pitch-angle oscillation amplitude from approximately ±0.03 rad to ±0.01 rad, corresponding to an oscillation reduction of about threefold. The estimated RMS value of the pitch angle is reduced from approximately 0.010 rad to 0.003 rad, indicating improved convergence and steady-state stability. Furthermore, experiments involving constant-speed straight-line locomotion and turning indicate that the KLQR algorithm maintains stable motion with velocity fluctuations limited to within ±0.05 m/s. The lateral displacement deviation during locomotion remains below 0.02 m, and no abrupt acceleration or deceleration is observed throughout the experiments. Overall, the results demonstrate that applying Extended Kalman filtering to smooth the control torque effectively improves the smoothness and stability of LQR-based balance control for wheeled bipedal robots.