Advanced Motion Planner