Fix updateServo output