Safety-critical Decision-making and Control for Autonomous Vehicles with Highest Priority