Control the Servo Motor