Search papers, labs, and topics across Lattice.
This paper introduces the Lie Group Interior Point Method (LieIPM) for trajectory optimization of rigid bodies, addressing the limitations of existing optimizers that operate in Euclidean space and neglect the manifold structure of rigid body motions. By leveraging second-order rigid body models and Lie group structures, the authors achieve efficient Newton-type updates while maintaining geometric integrity. The proposed method shows significant improvements in robustness and convergence speed in numerical tests compared to traditional solvers and optimal control methods.
Rigid body trajectory optimization can now avoid singularities and achieve faster convergence with a new structure-aware method that respects the underlying geometry.
Designing dynamically feasible trajectories for rigid bodies is a fundamental problem in robotics. While direct methods are widely used, the existing constrained optimizers typically operate in Euclidean space and ignore the manifold structure of rigid body motions. This mismatch may introduce singularities or lead to poorly conditioned optimization problems. To bridge this gap, we develop a structure-aware framework for constrained trajectory optimization directly on matrix Lie groups. Our approach is based on the second-order rigid body models utilizing Lie group structures, which enables efficient Newton-type updates while preserving the underlying geometry. Building on this model, we propose a line-search Lie Group Interior Point Method (LieIPM) to handle constraints on the manifolds. We instantiate the framework for rigid body motion planning using Lie group variational integrators and derive closed-form intrinsic derivatives that exploit group symmetries. The LieIPM preserves the topology of rotation motions by construction and avoids singularities. Numerical results demonstrate superior robustness and faster convergence compared to general-purpose solvers and structure-exploiting optimal control methods.
