Combined schedule
-
check if contour for trajectory has already been done -
lazily calculate allowed time offsets -
add minimum wait time based on other robots -
test with random trajectory order -
time combined scheduling for ~100 contours (with collision checking already done, and without)