Kinodynamic trajectory optimization and control for car-like robots
planning algorithms .