Removed initial sleep in wait for motors to stop