|
@@ -108,32 +108,24 @@ void Speed_response(void)
|
|
|
mcFocCtrl.LoopTime++;
|
|
mcFocCtrl.LoopTime++;
|
|
|
mcFocCtrl.IND_DEC_LoopTime++;
|
|
mcFocCtrl.IND_DEC_LoopTime++;
|
|
|
|
|
|
|
|
- if (mcFocCtrl.IND_DEC_LoopTime > SPEED_INC_DEC_TIME)
|
|
|
|
|
- {
|
|
|
|
|
- mcSpeedRamp.TargetValue = motorControl.TargetRef;
|
|
|
|
|
- mc_ramp(&mcSpeedRamp);
|
|
|
|
|
- mcFocCtrl.IND_DEC_LoopTime = 0;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
|
|
+// if (mcFocCtrl.IND_DEC_LoopTime > SPEED_INC_DEC_TIME)
|
|
|
|
|
+// {
|
|
|
|
|
+// mcSpeedRamp.TargetValue = motorControl.TargetRef;
|
|
|
|
|
+// mc_ramp(&mcSpeedRamp);
|
|
|
|
|
+// mcFocCtrl.IND_DEC_LoopTime = 0;
|
|
|
|
|
+// }
|
|
|
|
|
+ mcSpeedRamp.ActualValue = motorControl.TargetRef;
|
|
|
if (mcFocCtrl.LoopTime > SPEED_LOOP_TIME)
|
|
if (mcFocCtrl.LoopTime > SPEED_LOOP_TIME)
|
|
|
{
|
|
{
|
|
|
#if (OUT_LOOP_CONTROL)
|
|
#if (OUT_LOOP_CONTROL)
|
|
|
{
|
|
{
|
|
|
#if (LOOP_MODE == SPEED_CONTROL_MODE)
|
|
#if (LOOP_MODE == SPEED_CONTROL_MODE)
|
|
|
- mcFocCtrl.IsRef = HW_Zero_Calc(mcSpeedRamp.ActualValue - motorControl.ActualSpeed);
|
|
|
|
|
|
|
+ FOC_IQREF = HW_Zero_Calc(mcSpeedRamp.ActualValue - motorControl.ActualSpeed);
|
|
|
#endif
|
|
#endif
|
|
|
|
|
|
|
|
- // STT_FOC_THECOMP_CLEAR();
|
|
|
|
|
}
|
|
}
|
|
|
#else
|
|
#else
|
|
|
{
|
|
{
|
|
|
-// motorControl.ActualQOutValue = FOC_IQREF;
|
|
|
|
|
-//
|
|
|
|
|
-// if (motorControl.ActualQOutValue < motorControl.QOutRef)
|
|
|
|
|
-// { motorControl.ActualQOutValue += QOUTINC; }
|
|
|
|
|
-// else if (FOC_IQREF > motorControl.QOutRef)
|
|
|
|
|
-// { motorControl.ActualQOutValue -= QOUTINC; }
|
|
|
|
|
-
|
|
|
|
|
FOC_IQREF = motorControl.QOutRef;
|
|
FOC_IQREF = motorControl.QOutRef;
|
|
|
}
|
|
}
|
|
|
#endif
|
|
#endif
|