|
|
@@ -232,6 +232,7 @@ bool mc_start(u8 mode) {
|
|
|
PMSM_FOC_Brake(true);
|
|
|
}
|
|
|
gpio_beep(200);
|
|
|
+
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
@@ -495,7 +496,10 @@ bool mc_encoder_zero_calibrate(s16 vd) {
|
|
|
phase_current_calibrate_wait();
|
|
|
PMSM_FOC_Set_Angle(0);
|
|
|
PMSM_FOC_SetOpenVdq(vd, 0);
|
|
|
- delay_ms(2000);
|
|
|
+ for (int i = 0; i < 10; i++) {
|
|
|
+ delay_ms(1000);
|
|
|
+ wdog_reload();
|
|
|
+ }
|
|
|
float phase = motor_encoder_zero_phase_detect();
|
|
|
delay_ms(500);
|
|
|
PMSM_FOC_SetOpenVdq(0, 0);
|