message: fix early return in critical section entry
diff: @@ -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) {
  