High Level Scheduling of Energy Optimal Trajectories