Servo class. Initial draft and test program