Control the servo motor