Removed servo code from MotorTester.
A few updates to TeleOp that remove old code and fix bugs and added Arm, Shoulder, and Hand to MotorTester