fixed arm up movement

The encoder on motor F is not working. To stop motor F while the arm is
going up, we added a delay of 2 seconds. All tests are working