Просмотр исходного кода

tcs修改,影响autohold的启动

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui 2 лет назад
Родитель
Сommit
ffad80bf9c

+ 2 - 1
Applications/foc/core/PMSM_FOC_Core.c

@@ -3,6 +3,7 @@
 #include "foc/foc_config.h"
 #include "foc/motor/motor_param.h"
 #include "foc/core/e_ctrl.h"
+#include "foc/core/etcs.h"
 #include "math/fix_math.h"
 #include "math/fast_math.h"
 #include "foc/motor/current.h"
@@ -1378,7 +1379,7 @@ void PMSM_FOC_AutoHold(bool lock) {
 				PI_Controller_Reset(&gFoc_Ctrl.pi_vel, hold_torque);
 #endif
 			}
-			eCtrl_reset_Torque(hold_torque);
+			etcs_reset_torque(hold_torque);
 			gFoc_Ctrl.out.f_autohold_trq = hold_torque;
 		}else {
 			gFoc_Ctrl.out.f_autohold_trq = 0;

+ 5 - 0
Applications/foc/core/etcs.c

@@ -28,6 +28,11 @@ void etcs_enable(bool enable) {
 	b_etcs_en = enable;
 }
 
+void etcs_reset_torque(float torque) {
+	f_torque_ref = torque;
+	eCtrl_reset_Torque(torque);
+}
+
 void etcs_process(void) {
 	if (!b_etcs_en) {
 		PMSM_FOC_Set_Torque(f_torque_ref);

+ 1 - 0
Applications/foc/core/etcs.h

@@ -5,5 +5,6 @@ void etcs_set_torque(float torque);
 bool etcs_is_running(void);
 void etcs_enable(bool enable);
 void etcs_process(void);
+void etcs_reset_torque(float torque);
 #endif /* _ETSC_H__ */