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.

Singular trajectories in multi-input time-optimal problems: Application to controlled mechanical systems

Regularizing Numerical Extremals Along Singular Arcs: A Lie-Theoretic Approach

Time-Optimal Control for High-Order Chain-of-Integrators Systems with Full State Constraints and Arbitrary Terminal States (Extended Version)

Minimum Time Optimal Synthesis for a Control System on SU(2)

Stochastic trajectory optimization for mechanical systems with parametric uncertainties

Switching in time-optimal problem. The 3-D case with 2-D control

Optimal control on distributions

Variable structure control of time-variant linear time-delay singular system

On the existence of time-optimal control of mechanical manipulators

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

Discrete Optimal Control of Interconnected Mechanical Systems

Hidden regularity in singular optimal control of port-Hamiltonian systems

On Time-optimal Trajectories for a Car-like Robot with One Trailer

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

Time Optimal Control Problems for Some Non-Smooth Systems

A Novel State-Centric Necessary Condition for Time-Optimal Control of Controllable Linear Systems Based on Augmented Switching Laws (Extended Version)

Chattering Phenomena in Time-Optimal Control for High-Order Chain-of-Integrator Systems with Full State Constraints (Extended Version)

Time-optimal Dubins trajectory for moving obstacle avoidance

Selective and Robust Time-Optimal Rotations of Spin Systems

Polynomial mechanics and optimal control

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