Time-Optimal Motion Planner