Added servocontrol class