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.

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

Finite-time formation tracking control for vehicles based on motion planning approach

Finite-time Optimal Formation Control on Lie Groups

Finite‐time Formation Tracking Control for Multiple Vehicles: A Motion Planning Approach

Finite-time optimal formation tracking control of vehicles in horizontal plane

Intrinsic Optimal Control for Mechanical Systems on Lie Group

Lie Algebraic Cost Function Design for Control on Lie Groups

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

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

Event-Triggered Adaptive Control for Practically Finite-Time Position-Constrained Tracking of Space Robot Manipulators

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

Discrete Mechanics Modelling and Real-Time Optimal Control Method Based on Lie Group Variational Integrator

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

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

Optimal Tracking Control for Large-Scale Interconnected Systems with Time-Delays

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

Adaptive Fault‐Tolerant Attitude Tracking Control of Rigid Spacecraft on Lie Group with Fixed‐Time Convergence

Further Results on Optimal Tracking Control for Nonlinear Systems with Nonzero Equilibrium Via Adaptive Dynamic Programming

Finite-Time Attitude Trajectory Tracking Control of Rigid Spacecraft.

Optimal attitude control of a rigid body on special orthogonal group using LGVI and FD-GMRES

Logarithmic Control, Trajectory Tracking, and Formation for Nonholonomic Vehicles on Lie Group SE(2)