Added Servo Testing

This tests (and still contains) information about how the arm servos are
to act with the new claw.

Teleop and movement have been modified to reflect the new arm