|
@@ -175,12 +175,15 @@ bool mc_stop(void) {
|
|
|
PMSM_FOC_SetErrCode(FOC_Throttle_Err);
|
|
PMSM_FOC_SetErrCode(FOC_Throttle_Err);
|
|
|
return false;
|
|
return false;
|
|
|
}
|
|
}
|
|
|
|
|
+
|
|
|
|
|
+ u32 mask = cpu_enter_critical();
|
|
|
_mc_internal_init(CTRL_MODE_OPEN, false);
|
|
_mc_internal_init(CTRL_MODE_OPEN, false);
|
|
|
adc_stop_convert();
|
|
adc_stop_convert();
|
|
|
pwm_stop();
|
|
pwm_stop();
|
|
|
PMSM_FOC_Stop();
|
|
PMSM_FOC_Stop();
|
|
|
pwm_up_enable(true);
|
|
pwm_up_enable(true);
|
|
|
-
|
|
|
|
|
|
|
+ cpu_exit_critical(mask);
|
|
|
|
|
+
|
|
|
return true;
|
|
return true;
|
|
|
}
|
|
}
|
|
|
|
|
|