Real-Time Trajectory Generation And Control For Autonomous Vehicles