Basic Servo interface implented