Fix bug in done moving logic that caused the soft motors to hang if "go" button
was pressed without changing the position.
Move delay in forward chain to a better suited position. This simplifies the processing
chain.