Servo controller dev