Abstract:Matrix Lie groups are an important class of manifolds commonly used in control and robotics, and optimizing control policies on these manifolds is a fundamental problem. In this work, we propose a novel computationally efficient approach for trajectory optimization on matrix Lie groups using an augmented Lagrangian-based constrained discrete Differential Dynamic Programming (DDP). The method involves lifting the optimization problem to the Lie algebra during the backward pass and retracting back to the manifold during the forward pass. Unlike previous approaches that addressed constraint handling only for specific classes of matrix Lie groups, the proposed method provides a general solution for nonlinear constraint handling across generic matrix Lie groups. We evaluate the effectiveness of the proposed DDP method in handling constraints within a mechanical system characterized by rigid body dynamics in SE(3), assessing its computational efficiency compared to existing direct optimization solvers. Additionally, the method demonstrates robustness under external disturbances when applied as a Lie-algebraic feedback control policy on SE(3), and in optimizing a quadrotor's trajectory in a challenging realistic scenario. Experiments show that the proposed approach effectively manages general constraints defined on configuration, velocity, and inputs during optimization, while also maintaining stability under external disturbances when executing the resultant control policy in closed-loop.

Model Predictive Tracking Control for Invariant Systems on Matrix Lie Groups via Stable Embedding Into Euclidean Spaces

Robust Immersion and Invariance Adaptive Coordinated Control for a Class of Biaxial Gantry Systems

Exploiting Equivariance in the Design of Tracking Controllers for Euler-Poincare Systems on Matrix Lie Groups

Controller Design for Systems on Manifolds in Euclidean Space

A Learning-Based Optimal Tracking Controller for Continuous Linear Systems with Unknown Dynamics: Theory and Case Study

On Controller Design for Systems on Manifolds in Euclidean Space

Almost Global Asymptotic Trajectory Tracking for Fully-Actuated Mechanical Systems on Homogeneous Riemannian Manifolds

Exponentially Stable First Order Control on Matrix Lie Groups

Robust I I Adaptive Tracking Control of Systems with Nonlinear Parameterization: an ISS Perspective

Model Predictive Regulation on Manifolds in Euclidean Space

Formation Tracking Control for Multiple Rigid Bodies on Matrix Lie Groups: A System Decomposition Approach

Model Predictive Control for Trajectory Tracking on Differentiable Manifolds

Tracking control for a class of fully actuated systems on manifolds with impulsive effects

Adaptive Tracking Control Via Immersion and Invariance: an (i)iss Perspective.

Trajectory Tracking of Nonholonomic Mobile Robots by Geometric Control on Special Euclidean Group

Finite‐Time Optimal Tracking Control for Dynamic Systems on Lie Groups

Constrained Trajectory Optimization on Matrix Lie Groups via Lie-Algebraic Differential Dynamic Programming

Contributions to Tracking Control for Mechanical Systems on SE(2)

Point Stabilization and Trajectory Tracking of Underactuated Surface Vessels: A Geometric Control Approach.

H ∞ Reference Tracking Control Design for a Class of Nonlinear Systems with Time-Varying Delays

A Generalized Trajectory Tracking Controller for Robot Manipulators with Bounded Inputs