https://1library.org/document/ydvovdly-optimal-arrival-time-scheduling-automated-vehicles-intersections.html