Add Servo driver