diff --git a/firmware/pump_control.cpp b/firmware/pump_control.cpp
index 513dab8..7d3131c 100644
--- a/firmware/pump_control.cpp
+++ b/firmware/pump_control.cpp
@@ -23,10 +23,10 @@ static void PumpThread(void*)
 
             // result is in mA
             SetPumpCurrentTarget(result / 1000.0f);
-
-            // Run at 500hz
-            chThdSleepMilliseconds(2);
         }
+
+        // Run at 500hz
+        chThdSleepMilliseconds(2);
     }
 }