|
|
@@ -1431,10 +1431,12 @@ void PMSM_FOC_Calc_Current(void) {
|
|
|
raw_idc = m_pow / v_dc;// * 1.5f * 0.66f; //s16q5
|
|
|
}
|
|
|
LowPass_Filter(gFoc_Ctrl.out.s_CalciDC, raw_idc, 0.02f);
|
|
|
-
|
|
|
+#ifdef VBUS_I_CHAN
|
|
|
raw_idc = get_vbus_current();
|
|
|
LowPass_Filter(gFoc_Ctrl.out.s_FilteriDC, raw_idc, 0.05f);
|
|
|
-
|
|
|
+#else
|
|
|
+ gFoc_Ctrl.out.s_FilteriDC = gFoc_Ctrl.out.s_CalciDC;
|
|
|
+#endif
|
|
|
gFoc_Ctrl.out.s_RealCurrentFiltered = sqrtf(SQ(gFoc_Ctrl.out.s_FilterIdq.d) + SQ(gFoc_Ctrl.out.s_FilterIdq.q));
|
|
|
|
|
|
}
|