Trajectory Optimization for Curvature Bounded Non-Holonomic Vehicles: Application to Autonomous Driving.