Heterogeneous Autonomous Vehicles Scheduling