On Sub-Riemannian Geodesics in SE(3) Whose Spatial Projections do not Have Cusps

Remco Duits, Arpan Ghosh, T.c.j. Dela Haije, Alexey MashtakovJournal of Dynamical and Control Systems 2016 · DOI

Abstract

We consider the problem $P_{curve}$ of minimizing $\int_0^L (\kappa^2(s) + \alpha^2) ds$ for a curve $\mathbf{x}$ in $\mathbb{R}^3$ with fixed boundary points and directions. Here, the total length $L$ is free, $s$ denotes the arclength parameter, $\kappa$ denotes the absolute curvature of $\mathbf{x}$, and $\alpha > 0$ is constant. We lift problem $P_{curve}$ on $\mathbb{R}^3$ to a sub-Riemannian problem $P_{mec}$ on $SE(3)/(\{0\} \times SO(2))$. Here, for admissible boundary conditions, the spatial projections of sub-Riemannian geodesics do not exhibit cusps and they solve problem $P_{curve}$. We apply the Pontryagin Maximum Principle (PMP) and prove Liouville integrability of the Hamiltonian system. We derive explicit analytic formulas for such sub-Riemannian geodesics, relying on the co-adjoint orbit structure, an underlying Cartan connection, and the matrix representation of $SE(3)$ arising in the Cartan-matrix. These formulas allow us to extract geometrical properties of the sub-Riemannian geodesics with cuspless projection, such as planarity conditions, explicit bounds on their torsion, and their symmetries. Furthermore, they allow us to parameterize all admissible boundary conditions reachable by geodesics with cuspless spatial projection. Such projections lay in the upper half space. We prove this for most cases, and the rest is checked numerically. Finally, we employ the formulas to numerically solve the boundary value problem, and visualize the set of admissible boundary conditions.

Introduction: The Challenge of Cusps in 3D

In applications ranging from robotics to medical image analysis, finding the "optimal" path between two points with prescribed orientations is a fundamental task. While well-understood in 2D, the 3D case—modeled on the Lie group $SE(3)$—presents significant complexity. A primary issue is the emergence of "cusps" in the spatial projection of sub-Riemannian geodesics. These singular points, where a curve abruptly reverses direction, are physically unrealistic for modeling structures like blood vessels or neural fibers. This research provides the first explicit analytic framework for identifying and computing geodesics in $SE(3)$ that project to smooth, cuspless curves in $\mathbb{R}^3$.

Spatial projection of a geodesic in $\mathbb{R}^3$ showing the boundary positions $\mathbf{x}_0, \mathbf{x}_1$ and orientations $\mathbf{n}_0, \mathbf{n}_1$.

Methodology: Lifting and Integrating

The problem is addressed by lifting the curve-fitting task from $\mathbb{R}^3$ to the sub-Riemannian structure of $SE(3)$. By moving to the Lie group (position + orientation), the authors treat the curve as a sub-Riemannian problem where only specific directions of movement are admissible. Using the Pontryagin Maximum Principle, they derive a Hamiltonian system and prove its Liouville integrability by identifying six independent first integrals. The solution process leverages Cartan connections and the co-adjoint orbit structure of the group, ultimately expressing the geodesics through elliptic integrals of the first and third kind.

Key Insights: The Cusp-Free Zone and Torsion Bounds

A critical finding is the characterization of the "cusp-free" reachable set $\mathcal{R}$. The authors demonstrate that smooth geodesics are generally constrained to the "upper half-space" relative to their initial orientation. Furthermore, the paper establishes explicit bounds on the torsion (the "twistiness") of these curves, ensuring they remain physically plausible. Symmetry reductions in the exponential map—identifying rotational and reflectional symmetries—are also utilized to simplify the underlying boundary value problems.

Results and Numerical Implementation

The core contribution is the derivation of explicit analytic formulas for the spatial components of the geodesics. Numerical verification confirms that the Jacobian of the exponential map remains positive within the identified cusp-free range, supporting the conjecture that these geodesics remain locally optimal until they hit a cusp. A specialized shooting algorithm, implemented in Wolfram Mathematica, allows for efficient and stable computation of these paths compared to standard numerical integration.

Visualization of a family of sub-Riemannian geodesics in $\mathbb{R}^3$ computed using the derived analytic formulas.

Conclusion

This work bridges the gap between abstract sub-Riemannian geometry and practical 3D curve modeling. While the global optimality of these cuspless paths remains a conjecture, the provided analytic tools offer a robust foundation for future exploration of sub-Riemannian spheres and Maxwell sets in $SE(3)$.

Summary updated

Abstract

We consider the problem P curve of minimizing L 0 2 + 2 (s) ds for a curve x in R 3 with fixed boundary points and directions. Here, the total length L 0 is free, s denotes the arclength parameter, denotes the absolute curvature of x, and > 0 is constant. We lift problem P curve on R 3 to a sub-Riemannian problem P mec on SE(3)/({0} SO(2)). Here, for admissible boundary conditions, the spatial projections of sub-Riemannian geodesics do not exhibit cusps and they solve problem P curve . We apply the Pontryagin Maximum Principle (PMP) and prove Liouville integrability of the Hamiltonian system. We derive explicit analytic formulas for such sub-Riemannian geodesics, relying on the co-adjoint orbit structure, an underlying Cartan connection, and the matrix representation of SE(3) arising in the Cartan-matrix. These formulas allow us to extract geometrical properties of the sub-Riemannian geodesics with cuspless projection, such as planarity conditions, explicit bounds on their torsion, and their symmetries. Furthermore, they allow us to parameterize all admissible boundary conditions reachable by geodesics with cuspless spatial projection. Such projections lay in the upper half space. We prove this for most cases, and the rest is checked numerically. Finally, we employ the formulas to numerically solve the boundary value problem, and visualize the set of admissible boundary conditions.
BibTeX
@article{duits2016sub,
  author = {Remco Duits and Arpan Ghosh and T.C.J. Dela Haije and Alexey Mashtakov},
  title = {{On Sub-Riemannian Geodesics in SE(3) Whose Spatial Projections do not Have Cusps}},
  journal = {Journal of Dynamical and Control Systems},
  year = {2016},
  doi = {10.1007/s10883-016-9329-4},
}
Figure