Variational-Based Geometric Nonlinear Model Predictive Control for Robust Locomotion of Quadruped Robots

This paper proposes a novel nonlinear model predictive control (NMPC) method based on geometric variational calculus for high-dynamic and complex motion control of quadruped robots. By approximating system trajectory tracking error dynamics on the Special Euclidean group (SE(3)), the method avoids the singularities of Euler angles and the challenges of quaternion representation while capturing the coupling between rotational and translational dynamics for a more comprehensive motion description. Leveraging variational calculus, the resulting Geometric Nonlinear Model Predictive Controller (GNMPC) enables high-frequency updates while preserving essential nonlinear system characteristics. Experimental results across various scenarios validate the effectiveness and advantages of the proposed controller.