Explorar o código

超前角标定,q轴电流根据调度的s符号定正负

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui %!s(int64=3) %!d(string=hai) anos
pai
achega
d36cc2955f
Modificáronse 1 ficheiros con 3 adicións e 0 borrados
  1. 3 0
      Applications/foc/core/PMSM_FOC_Core.c

+ 3 - 0
Applications/foc/core/PMSM_FOC_Core.c

@@ -668,6 +668,9 @@ static __INLINE void PMSM_FOC_idq_Assign(void) {
 				gFoc_Ctrl.in.s_targetIdq.d = -gFoc_Ctrl.hwLim.s_FWDCurrMax;
 			}
 			gFoc_Ctrl.in.s_targetIdq.q = sqrtf(SQ(gFoc_Ctrl.in.s_targetCurrent) - SQ(gFoc_Ctrl.in.s_targetIdq.d));
+			if (s < 0) {
+				gFoc_Ctrl.in.s_targetIdq.q = -gFoc_Ctrl.in.s_targetIdq.q;
+			}
 		}else {
 			gFoc_Ctrl.in.s_targetIdq.d = 0;
 			gFoc_Ctrl.in.s_targetIdq.q = gFoc_Ctrl.in.s_targetCurrent;