LieIPM: Lie Group Interior Point Method for Direct Trajectory Optimization of Rigid Bodies

• URL: http://arxiv.org/abs/2606.10579v1
• Date: Tue, 09 Jun 2026 08:45:08 GMT
• Title: LieIPM: Lie Group Interior Point Method for Direct Trajectory Optimization of Rigid Bodies
• Abstract summary: We develop a structure-aware framework for constrained trajectory optimization directly on Lie groups.<n>Our approach is based on the second-order rigid body models utilizing Lie group structures.<n>We demonstrate superior robustness and faster convergence compared to general-purpose solvers and structure-exploiting optimal control methods.
• Score: 24.359624843338946
• License: http://arxiv.org/licenses/nonexclusive-distrib/1.0/
• Abstract: 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.

Related papers

• Learning Smooth SE(3) Trajectories under Left-Invariant Riemannian Metrics [11.609667074830412]
  This paper presents a learning-based framework for approximating higher-order smooth trajectories on SE(3) on Lie groups.<n>The proposed framework enables generalization across diverse metric structures and motion conditions.<n>We demonstrate two practical applications of the proposed framework: real-time generation of diverse motion primitives and refinement for quadrotor flight.
  arXiv  Detail & Related papers  (2026-08-03T00:40:03Z)
• Learning Adaptive Solvers for Distributed Factor Graph Optimization on Matrix Lie Groups [10.991847864573437]
  DeepCORD is a learning-augmented framework for distributed factor graph optimization on general matrix Lie groups.<n>Our method achieves lower objective values than existing distributed baselines on most benchmarks across realistic operating scenarios.
  arXiv  Detail & Related papers  (2026-07-09T17:35:26Z)
• General Covariant Action Modeling: Constructing Generalized Manifolds via Spatio-Temporal Decoupling [48.559681359374146]
  Generalized Action Manifold (GAM) framework enforces general covariance through structural disentanglement.<n>GAM enables superior transfer and robustness capabilities, outperforming geometry-agnostic baselines.
  arXiv  Detail & Related papers  (2026-05-27T03:38:15Z)
• Orthogonal Model Merging [21.902153344111223]
  Merging finetuned Large Language Models (LLMs) has become increasingly important for integrating diverse capabilities into a single unified model.<n>We propose Orthogonal Model Merging (OrthoMerge) to preserve the geometric structure of the model's weights.
  arXiv  Detail & Related papers  (2026-02-05T17:57:14Z)
• Riemannian Flow Matching for Disentangled Graph Domain Adaptation [51.98961391065951]
  Graph Domain Adaptation (GDA) typically uses adversarial learning to align graph embeddings in Euclidean space.<n>DisRFM is a geometry-aware GDA framework that unifies embedding and flow-based transport.
  arXiv  Detail & Related papers  (2026-01-31T11:05:35Z)
• Riemannian Lyapunov Optimizer: A Unified Framework for Optimization [6.493476506951333]
  We introduce a family of optimization algorithms that unifies classic algorithms within one geometric framework.<n>RLOs bridge control theory and modern machine learning optimization, providing a unified language and a systematic toolkit.
  arXiv  Detail & Related papers  (2026-01-29T20:00:25Z)
• From Coefficients to Directions: Rethinking Model Merging with Directional Alignment [66.99062575537555]
  We introduce a unified geometric framework, emphMerging with Directional Alignment (method), which aligns directional structures consistently in both the parameter and feature spaces.<n>Our analysis shows that directional alignment improves structural coherence, and extensive experiments across benchmarks, model scales, and task configurations further validate the effectiveness of our approach.
  arXiv  Detail & Related papers  (2025-11-29T08:40:58Z)
• Learning Geometry: A Framework for Building Adaptive Manifold Models through Metric Optimization [8.201374511929538]
  This paper proposes a novel paradigm for machine learning that moves beyond traditional parameter optimization.<n>We optimize the metric tensor field on a manifold with a predefined topology, thereby dynamically shaping the geometric structure of the model space.<n>This work lays a solid foundation for constructing fully dynamic "meta-learners" capable of autonomously evolving their geometry and topology.
  arXiv  Detail & Related papers  (2025-10-30T01:53:32Z)
• Generalized Tensor-based Parameter-Efficient Fine-Tuning via Lie Group Transformations [50.010924231754856]
  Adapting pre-trained foundation models for diverse downstream tasks is a core practice in artificial intelligence.<n>To overcome this, parameter-efficient fine-tuning (PEFT) methods like LoRA have emerged and are becoming a growing research focus.<n>We propose a generalization that extends matrix-based PEFT methods to higher-dimensional parameter spaces without compromising their structural properties.
  arXiv  Detail & Related papers  (2025-04-01T14:36:45Z)
• Training Deep Learning Models with Norm-Constrained LMOs [56.00317694850397]
  We propose a new family of algorithms that uses the linear minimization oracle (LMO) to adapt to the geometry of the problem.<n>We demonstrate significant speedups on nanoGPT training using our algorithm, Scion, without any reliance on Adam.
  arXiv  Detail & Related papers  (2025-02-11T13:10:34Z)
• Structured Regularization for Constrained Optimization on the SPD Manifold [1.1126342180866644]
  We introduce a class of structured regularizers, based on symmetric gauge functions, which allow for solving constrained optimization on the SPD manifold with faster unconstrained methods. We show that our structured regularizers can be chosen to preserve or induce desirable structure, in particular convexity and "difference of convex" structure.
  arXiv  Detail & Related papers  (2024-10-12T22:11:22Z)
• A Multi-body Tracking Framework -- From Rigid Objects to Kinematic Structures [23.933556023366695]
  Most model-based 3D tracking methods only consider rigid objects. We propose a flexible framework that allows the extension of existing 6DoF algorithms to kinematic structures. Based on the proposed framework, we extend ICG, which is a state-of-the-art rigid object tracking algorithm, to multi-body tracking.
  arXiv  Detail & Related papers  (2022-08-02T14:49:34Z)
• Geometry-aware Bayesian Optimization in Robotics using Riemannian Mat\'ern Kernels [64.62221198500467]
  We show how to implement geometry-aware kernels for Bayesian optimization. This technique can be used for control parameter tuning, parametric policy adaptation, and structure design in robotics.
  arXiv  Detail & Related papers  (2021-11-02T09:47:22Z)
• Optimization on manifolds: A symplectic approach [127.54402681305629]
  We propose a dissipative extension of Dirac's theory of constrained Hamiltonian systems as a general framework for solving optimization problems. Our class of (accelerated) algorithms are not only simple and efficient but also applicable to a broad range of contexts.
  arXiv  Detail & Related papers  (2021-07-23T13:43:34Z)

This list is automatically generated from the titles and abstracts of the papers in this site.

This site does not guarantee the quality of this site (including all information) and is not responsible for any consequences.