Autonomous Vehicle Control and Planning