Simulation of Disturbance Recovery Based on MPC and Whole-Body Dynamics Control of Biped Walking

Biped robots are similar to human beings and have broad application prospects in the fields of family service, disaster rescue and military affairs. However, simplified models and fixed center of mass (COM) used in previous research ignore the large-scale stability control ability implied by whole-body motion. The present paper proposed a two-level controller based on a simplified model and whole-body dynamics. In high level, a model predictive control (MPC) controller is implemented to improve zero moment point (ZMP) control performance. In low level, a quadratic programming optimization method is adopted to realize trajectory tracking and stabilization with friction and joint constraints. The simulation shows that a 12-degree-of-freedom force-controlled biped robot model, adopting the method proposed in this paper, can recover from a 40 Nm disturbance when walking at 1.44 km/h without adjusting the foot placement, and can walk on an unknown 4 cm high stairs and a rotating slope with a maximum inclination of 10°. The method is also adopted to realize fast walking up to 6 km/h.