Servo loop with position loop