kinematic controllability for decoupled trajectory planning in underactuated mechanical systems .
Randomized Kinodynamic Motion Planning with Moving Obstacles