diff --git a/esp32/include/peripherals/servo_controller.h b/esp32/include/peripherals/servo_controller.h
index dc3ac74..5b41353 100644
--- a/esp32/include/peripherals/servo_controller.h
+++ b/esp32/include/peripherals/servo_controller.h
@@ -92,10 +92,7 @@ class ServoController : public StatefulService<ServoSettings> {
             auto &servo = state().servos[i];
             float angle = servo.direction * angles[i] + servo.centerAngle;
             uint16_t pwm = angle * servo.conversion + servo.centerPwm;
-            if (pwm < 125 || pwm > 600) {
-                continue;
-            }
-            pwms[i] = pwm;
+            pwms[i] = pwm = std::clamp<uint16_t>(pwm, 125, 600);
         }
         _pca.setMultiplePWM(pwms, 12);
     }