Changed mapping of gamepad to servos and added functionality to arm/claw