Servo controlling code added.