Abstract:The International Journal of Robotics Research, Ahead of Print. This paper reports a novel result: with proper robot models based on geometric mechanics, one can formulate the kinodynamic motion planning problems for rigid body systems as exact polynomial optimization problems. Due to the nonlinear rigid body dynamics, the motion planning problem for rigid body systems is nonconvex. Existing global optimization-based methods do not parameterize 3D rigid body motion efficiently; thus, they do not scale well to long-horizon planning problems. We use Lie groups as the configuration space and apply the variational integrator to formulate the forced rigid body dynamics as quadratic polynomials. Then, we leverage Lasserre's hierarchy of moment relaxation to obtain the globally optimal solution via semidefinite programming. By leveraging the sparsity of the motion planning problem, the proposed algorithm has linear complexity with respect to the planning horizon. This paper demonstrates that the proposed method can provide globally optimal solutions or certificates of infeasibility at the second-order relaxation for 3D drone landing using full dynamics and inverse kinematics for serial manipulators. Moreover, we extend the algorithms to multi-body systems via the constrained variational integrators. The testing cases on cart-pole and drone with cable-suspended load suggest that the proposed algorithms can provide rank-one optimal solutions or nontrivial initial guesses. Finally, we propose strategies to speed up the computation, including an alternative formulation using quaternion, which provides empirically tight relaxations for the drone landing problem at the first-order relaxation.

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

Optimal Attitude Control of a Rigid Body Using Geometrically Exact Computations on SO(3)

Disturbance Observer-Based Attitude Stabilization on Lie Groups

Optimal Velocity Control of Spherical Robots Based on Offset-free Linear Model Predictive Control

Robust Immersion and Invariance Adaptive Coordinated Control for a Class of Biaxial Gantry Systems

Convex Optimization of Bearing Formation Control of Rigid bodies on Lie Group

Generalized homogeneous rigid-body attitude control

Generalized Homogeneous Rigid-BodyAttitude Control

Stochastic Kinematic Optimal Control on SO(3)

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

Attitude Control For Flexible Spacecraft With Swinging Components

Convex geometric motion planning of multi-body systems on lie groups via variational integrators and sparse moment relaxation

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

Geometric PID-type attitude tracking control on SO(3)

Kinematic-Free Orientation Control for a Deformable Manipulator Based on the Geodesic in Rotation Group SO(3)

Exponential Attitude and Gyro-Bias Estimation on the Special Orthogonal Group SO(3)

Nonlinear control of flexible spacecraft based on LMI constrained convex optimization

Specified Finite Time Attitude Stabilization for Rigid Body on SO(3)

Convex Geometric Motion Planning on Lie Groups via Moment Relaxation

Geometric tracking control of the attitude dynamics of a rigid body on SO(3)

Lie Algebraic Cost Function Design for Control on Lie Groups