Kinematic Controllability for Decoupled Trajectory Planning in Underactuated
Mechanical Systems
Francesco Bullo and Kevin M. Lynch
Abstract
We introduce the notion of kinematic controllability for second-order underactuated mechanical systems. For systems satisfying this property, the problem of planning fast collision-free trajectories between zero velocity states can be decoupled into the computationally simpler problems of path planning for a kinematic system followed by time-optimal time scaling. While this approach is well known for fully actuated systems, until now there has been no way to apply it to underactuated dynamic systems. The results in this paper form the basis for efficient collision-free trajectory planning for a class of underactuated mechanical systems including manipulators and vehicles in space and underwater environments.
Figure 2: Any configuration in obstacle-free SE(3) can be reached by
a sequence of two rotations (to point the spacecraft at the goal), a
translation, and three rotations (ZYZ Euler angles) to achieve the desired
final orientation.
Figure 3: The kinematic path can then be time-scaled to yield a time-optimal
trajectory along the path. For thruster limits of 100 N, the time-optimal
trajectory takes 19.16 seconds and the thruster actuations are shown in the
figure.