geometric motion planning : the local connection , stokes ' theorem , and the importance of coordinate choice .
kinematic controllability for decoupled trajectory planning in underactuated mechanical systems .