https://5dok.org/document/zwvw2rkl-goal-oriented-collision-free-schedule.html