|
|
@@ -521,9 +521,9 @@ bool mc_start_epm_move(EPM_Dir_t dir, bool is_command) {
|
|
|
mc_auto_hold(false);
|
|
|
}
|
|
|
if (dir == EPM_Dir_Back) {
|
|
|
- PMSM_FOC_Change_VelLoop_Params(3.0f, 500.0f);
|
|
|
+ PMSM_FOC_Change_VelLoop_Params(CONFIG_LADRC_EPM_Wcv, CONFIG_LADRC_EPMBK_B0);
|
|
|
}else {
|
|
|
- PMSM_FOC_Change_VelLoop_Params(3.0f, 350.0f);
|
|
|
+ PMSM_FOC_Change_VelLoop_Params(CONFIG_LADRC_EPM_Wcv, CONFIG_LADRC_EPM_B0);
|
|
|
}
|
|
|
PMSM_FOC_TorqueLimit(motor.f_epm_trq);
|
|
|
PMSM_FOC_Set_Speed(motor.f_epm_vel);
|