Arduino controlling 3 wire Vex Servo – 1