Allowed for more precise unit waypoint ordering as well as more precise  unit waypoint-goal-reaching