Add Servo write