Servo control ok!