Arduino Program for controlling Hitech HS-785HB 3.5 Turns Servo