Optimal Motion Planning