diff --git a/libraries/AP_RobotisServo/AP_RobotisServo.cpp b/libraries/AP_RobotisServo/AP_RobotisServo.cpp
index e4dc7eddff..5261b1615d 100644
--- a/libraries/AP_RobotisServo/AP_RobotisServo.cpp
+++ b/libraries/AP_RobotisServo/AP_RobotisServo.cpp
@@ -373,6 +373,7 @@ void AP_RobotisServo::update()
     if (detection_count < DETECT_SERVO_COUNT) {
         detection_count++;
         detect_servos();
+        return;
     }
 
     if (servo_mask == 0) {