Galileo: A Pseudospectral Collocation Framework for Legged Robots

Ethan Chandler,Akshay Jaitly,Mahdi Agheli
2024-09-19
Abstract:Dynamic maneuvers for legged robots present a difficult challenge due to the complex dynamics and contact constraints. This paper introduces a versatile trajectory optimization framework for continuous-time multi-phase problems. We introduce a new transcription scheme that enables pseudospectral collocation to optimize directly on Lie Groups, such as SE(3) and quaternions without special normalization constraints. The key insight is the change of variables - we choose to optimize over the history of the tangent vectors rather than the states themselves. Our approach uses a modified Legendre-Gauss-Radau (LGR) method to produce dynamic motions for various legged robots. We implement our approach as a Model Predictive Controller (MPC) and track the MPC output using a Quadratic Program (QP) based whole-body controller. Results on the Go1 Unitree and WPI HURON humanoid confirm the feasibility of the planned trajectories.
Robotics
What problem does this paper attempt to address?
The main objective of this paper is to address the problem of trajectory optimization in the dynamic operation of legged robots. Specifically, due to the complex multi-phase dynamics and contact constraints of legged robots, their dynamic operation faces significant challenges. The paper introduces a new trajectory optimization framework capable of handling continuous-time multi-phase problems. This method introduces a new transcription scheme that allows pseudospectral collocation to be directly optimized on Lie groups (such as SE(3) and quaternions) without the need for additional normalization constraints. The main contributions include: 1. Proposing Galileo—a lightweight, scalable, and open-source optimization library based on a modified Legendre-Gauss-Radau (LGR) pseudospectral collocation method, specifically designed for switching systems. 2. Developing a new transcription method that allows pseudospectral collocation on differentiable manifolds, avoiding additional normalization constraints. 3. Implementing a Galileo model predictive controller (MPC) for legged robots and validating its effectiveness in simulations, such as applications to the Unitree Go1 quadruped robot and WPI's HURON humanoid robot. Through these improvements, the researchers aim to enhance the trajectory planning capabilities of legged robots in dynamic motion and demonstrate the feasibility and superiority of this method in practical applications.