diff --git a/Firmware/MotorControl/low_level.h b/Firmware/MotorControl/low_level.h
index 0b594e34..605db9ba 100644
--- a/Firmware/MotorControl/low_level.h
+++ b/Firmware/MotorControl/low_level.h
@@ -54,8 +54,9 @@ void pwm_in_init();
 void update_brake_current();
 
 inline uint32_t cpu_enter_critical() {
-    return __get_PRIMASK();
+    uint32_t primask = __get_PRIMASK();
     __disable_irq();
+    return primask;
 }
 
 inline void cpu_exit_critical(uint32_t priority_mask) {