Optimization-based dynamic motion planning and control for quadruped robots

Fast trajectory planning and control frameworks improve locomotion robustness against disturbances and uncertainties. In this paper, dynamic motions are optimized under the constraint of a decoupled spring-loaded inverted pendulum model. Subsequently, a hierarchical Quadratic Programming whole-body controller is employed to execute the planned trajectories while ensuring compliance with all physical feasibility constraints. Both the motion planner and the whole-body controller operate within the same high-frequency control loop. Furthermore, the unified whole-body controller governs all gait phases, including flight phases. The proposed algorithms are evaluated through simulation and real experiments, showcasing dynamic gaits such as hopping, twist jumping, and trotting in challenging environments. The algorithms demonstrate resilience against external disturbances and environmental uncertainties.