Correct box detection and arm movement

Now the robot does detect a box and moves the arm in a correct way.
Steering still needs improvement