IEEE Transactions on Robotics and Automation, 17(4):402-412, August 2001

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.
Available as pdf (248 K)

Figure 1: A spacecraft with three thrusters aligned with the principal axes but offset from the center of mass. These three thrusters are sufficient to make the spacecraft locally kinematically controllable on SE(3), with decoupling velocities being translation along the x-axis and rotation about axes aligned with y and z but offset from the center of mass.


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.


Return to publications.
Return to Kevin Lynch's home page.