Constrained Optimal Motion Planning for Autonomous Vehicles Using PRONTO