Servo controlling function...