Conveyor: Introduce wait_for_empty_queue
Endstops: Properly wait for queue to empty