Title: Autonomous Vehicles Planning and Control