Whole-Body Control for Quadruped Locomotion on the Unitree Go2
I designed an instantaneous QP-based whole-body controller for trotting locomotion on the Unitree Go2, implemented in MuJoCo. At each control step, a single QP resolves contact forces and joint torques simultaneously, satisfying rigid-body dynamics, friction cone constraints, and actuator limits while tracking Cartesian tasks for base height, orientation, and velocity. Swing foot trajectories are generated online with a Raibert-style heuristic, and early touchdown detection handles contact timing mismatches during the trot gait.