|
@@ -441,27 +441,20 @@ void ass_voAssitTorqPI(ASS_TORQ_PI_IN *in, ASS_TORQ_PI_OUT *out)
|
|
|
|
|
|
SWORD ass_pvt_swVoltCnt=0;
|
|
|
UWORD ass_pvt_uwTorqAccCnt=0,ass_pvt_uwTorqDecCnt=0,ass_pvt_uwSpd2TorqCnt=0;
|
|
|
-
|
|
|
+static void AssitCuvApplPerVolt(void)
|
|
|
+{
|
|
|
SLONG slTeTorAssitTmpPu,slTeTorAssitLinerPu,slTeCadAssitTmpPu;
|
|
|
SWORD swTeTorAssitPu1, swTeTorAssitPu2;
|
|
|
SWORD swTeCadAssitPu1, swTeCadAssitPu2;
|
|
|
SWORD swTmpSpdtoTorqCur;
|
|
|
SLONG slTmpSmoothCur;
|
|
|
SWORD swTorqCmd1, swTorqCmd, swCadCmd;
|
|
|
-static SWORD AssitCuvApplPerVolt(void)
|
|
|
-{
|
|
|
-// SLONG slTeTorAssitTmpPu,slTeTorAssitLinerPu,slTeCadAssitTmpPu;
|
|
|
-// SWORD swTeTorAssitPu1, swTeTorAssitPu2;
|
|
|
-// SWORD swTeCadAssitPu1, swTeCadAssitPu2;
|
|
|
-// SWORD swTmpSpdtoTorqCur;
|
|
|
-// SLONG slTmpSmoothCur;
|
|
|
-// SWORD swTorqCmd1, swTorqCmd, swCadCmd;
|
|
|
UWORD uwTorqAccStep = 50,uwTorqDecStep = 80;
|
|
|
SWORD swCurSwitch = 0;
|
|
|
SWORD swTmpVoltPu,swTmpVoltPu2;
|
|
|
SLONG slSpdErr,slTmpVoltLim;
|
|
|
SWORD swSpdKpPu = 500; //Q10
|
|
|
- UWORD uwVoltAccStep = 3, uwVoltDecStep = 10;
|
|
|
+ UWORD uwVoltAccStep = 1, uwVoltDecStep = 3;
|
|
|
UWORD uwTmpStopCnt = 0;
|
|
|
ORIG_COEF stStopOrigCoef = {-100, 0, 0};
|
|
|
POLY_COEF stStopCoef;
|
|
@@ -562,10 +555,14 @@ static SWORD AssitCuvApplPerVolt(void)
|
|
|
{
|
|
|
case Startup:
|
|
|
ass_stCalCoef.swSmoothGain = Q12_1;
|
|
|
- swSpdKpPu = 500; //ass_stParaSet.uwStartUpCadNm;
|
|
|
+ swSpdKpPu = 2000; //ass_stParaSet.uwStartUpCadNm;
|
|
|
slSpdErr = (SLONG)ass_stCalOut.swCadSpd2MotSpd - (SLONG)ass_stCalIn.uwSpdFbkAbsPu;
|
|
|
+ if(slSpdErr < 0)
|
|
|
+ {
|
|
|
+ slSpdErr = 0;
|
|
|
+ }
|
|
|
|
|
|
- ass_stCalCoef.StartFlag = 1;
|
|
|
+// ass_stCalCoef.StartFlag = 1;
|
|
|
/* Open Voltage Limit according SpdErr*/
|
|
|
if(ass_stCalCoef.StartFlag == 0)
|
|
|
{
|
|
@@ -580,7 +577,7 @@ static SWORD AssitCuvApplPerVolt(void)
|
|
|
}
|
|
|
ass_stCalOut.swVoltLimitPu = slTmpVoltLim;
|
|
|
|
|
|
- if(slSpdErr <= 1500 )
|
|
|
+ if(slSpdErr <= 800)
|
|
|
{
|
|
|
ass_stCalCoef.StartFlag=1;
|
|
|
}
|