A real-time motion planner with trajectory optimization for autonomous vehicles
optimal trajectory generation for dynamic street scenarios in a frenet frame .