New control now working with the real servos