|
|
@@ -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;
|