kinematic controllability for decoupled trajectory planning in underactuated mechanical systems .
Improving the Efficiency of Time-Optimal Path-Following Algorithms