|
@@ -298,10 +298,10 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasSpeed_Process(MC_GasMode_Struct_t GasMo
|
|
|
Tmp = Tmp > 2048 ? 2048 : Tmp;
|
|
|
Tmp = (Tmp*Tmp)/2048; //指拨值改为抛物线,低速控制行程变大
|
|
|
/*电机转速设定,根据指拨大小、车轮限速值和速比,换算*/
|
|
|
- SpeedSet = (Tmp * ((MC_ConfigParam1.SpeedLimit + MC_GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * SpdProportion) / 10 >> 11); //(Tmp >> 11) * cd_Speedlimit * ( SpdProportion / 10)
|
|
|
+ SpeedSet = (Tmp * ((MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj + MC_GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * SpdProportion) / 10 >> 11); //(Tmp >> 11) * cd_Speedlimit * ( SpdProportion / 10)
|
|
|
|
|
|
//超过限速值,设定电机转速为0
|
|
|
- if(wheelSpeed > ((MC_ConfigParam1.SpeedLimit + MC_GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + 20))
|
|
|
+ if(wheelSpeed > ((MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj + MC_GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + 20))
|
|
|
{
|
|
|
SpeedSet = 0;
|
|
|
}
|
|
@@ -478,19 +478,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
case MC_GearSt_Torque_ECO:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_ECO.StarModel_GAIN <= 90)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_ECO.StarModel_GAIN >= 110)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_ECO.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_ECO.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_ECO.DecCnt;
|
|
|
//根据输入调节力矩环给定
|
|
@@ -509,19 +497,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
case MC_GearSt_Torque_NORM:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_NORM.StarModel_GAIN <= 90)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_NORM.StarModel_GAIN >= 110)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_NORM.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_NORM.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_NORM.DecCnt;
|
|
|
//根据输入调节力矩环给定
|
|
@@ -540,19 +516,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
case MC_GearSt_Torque_SPORT:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_SPORT.StarModel_GAIN <= 90)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_SPORT.StarModel_GAIN >= 110)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_SPORT.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_SPORT.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_SPORT.DecCnt;
|
|
|
//根据输入调节力矩环给定
|
|
@@ -571,19 +535,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
case MC_GearSt_Torque_TURBO: case MC_GearSt_SMART:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN <= 90)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN >= 110)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_TURBO.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_TURBO.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_TURBO.DecCnt;
|
|
|
//根据输入调节力矩环给定
|
|
@@ -611,19 +563,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
else if(GasMode_Param.Mode_bit.PowerLimitFlag == 0) //不根据挡位限制功率,按照Turbo参数
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN <= 90)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN >= 110)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_SMART.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_SMART.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_TURBO.DecCnt;
|
|
|
//根据输入调节力矩环给定
|
|
@@ -641,11 +581,11 @@ MC_CalParam_Struct_t MC_AssistRunMode_GasTorque_Process(MC_GasMode_Struct_t GasM
|
|
|
|
|
|
//限速值设定
|
|
|
static uint16_t speedLimitStart = 250, speedLimitEnd = 272, slewRate = 52;
|
|
|
- if((MC_ConfigParam2.speedLimitStartAdj > 50) || (MC_ConfigParam2.speedLimitStartAdj < -50)) MC_ConfigParam2.speedLimitStartAdj=0;
|
|
|
- if((MC_ConfigParam2.speedLimitEndAdj > 50) || (MC_ConfigParam2.speedLimitEndAdj < -50)) MC_ConfigParam2.speedLimitEndAdj=0;
|
|
|
+ if((MC_ConfigParam2.SpeedLimitStartAdj > 50) || (MC_ConfigParam2.SpeedLimitStartAdj < -50)) MC_ConfigParam2.SpeedLimitStartAdj=0;
|
|
|
+ if((MC_ConfigParam2.SpeedLimitEndAdj > 50) || (MC_ConfigParam2.SpeedLimitEndAdj < -50)) MC_ConfigParam2.SpeedLimitEndAdj=0;
|
|
|
|
|
|
- speedLimitStart = (MC_ConfigParam1.SpeedLimit + GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + MC_ConfigParam2.speedLimitStartAdj;
|
|
|
- speedLimitEnd = (MC_ConfigParam1.SpeedLimit + GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + MC_ConfigParam2.speedLimitEndAdj + 22;
|
|
|
+ speedLimitStart = (MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj + GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + MC_ConfigParam2.SpeedLimitStartAdj;
|
|
|
+ speedLimitEnd = (MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj + GasMode_Param.Mode_bit.SpeedLimit - (0xAA >> 2)) * 10 + MC_ConfigParam2.SpeedLimitEndAdj + 22;
|
|
|
slewRate = 1024 / (speedLimitEnd - speedLimitStart - 3);
|
|
|
|
|
|
//随车速调节助力比
|
|
@@ -1090,25 +1030,11 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
case MC_GearSt_Torque_ECO:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_ECO.StarModel_GAIN <= 80)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_ECO.StarModel_GAIN >= 120)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_ECO.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_ECO.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_ECO.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_ECO.DecCnt;
|
|
|
//随力矩输入调节助力比
|
|
|
Torque_Temp = (uint16_t)((uint32_t)(MC_TorqueProcess_Param.TorqueApp * Coefficient_GainCal(MC_AssisParam.Gear_ECO.Gain_K >> 1, MC_AssisParam.Gear_ECO.Gain_K, MC_AssisParam.Gear_ECO.TorqueApp_TH, MC_TorqueProcess_Param.TorqueApp)) >> 10);
|
|
|
- //根据助力增益调节助力比
|
|
|
- Torque_Temp = Torque_Temp * MC_ConfigParam1.UserAdjParam_ECO.Assist_K_GAIN / 100;
|
|
|
//给定下限
|
|
|
Torque_Temp = (Torque_Temp < MC_AssisParam.Gear_ECO.Lower_Iq) ? MC_AssisParam.Gear_ECO.Lower_Iq : Torque_Temp;
|
|
|
//给定上限
|
|
@@ -1125,25 +1051,11 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
case MC_GearSt_Torque_NORM:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_NORM.StarModel_GAIN <= 80)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_NORM.StarModel_GAIN >= 120)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_NORM.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_NORM.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_NORM.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_NORM.DecCnt;
|
|
|
//随力矩输入调节助力比
|
|
|
Torque_Temp = (uint16_t)((uint32_t)(MC_TorqueProcess_Param.TorqueApp * Coefficient_GainCal(MC_AssisParam.Gear_NORM.Gain_K >> 1, MC_AssisParam.Gear_NORM.Gain_K, MC_AssisParam.Gear_NORM.TorqueApp_TH, MC_TorqueProcess_Param.TorqueApp)) >> 10);
|
|
|
- //根据助力增益调节助力比
|
|
|
- Torque_Temp = Torque_Temp * MC_ConfigParam1.UserAdjParam_NORM.Assist_K_GAIN / 100;
|
|
|
//给定下限
|
|
|
Torque_Temp = (Torque_Temp < MC_AssisParam.Gear_NORM.Lower_Iq) ? MC_AssisParam.Gear_NORM.Lower_Iq : Torque_Temp;
|
|
|
//给定上限
|
|
@@ -1161,25 +1073,11 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
case MC_GearSt_Torque_SPORT:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_SPORT.StarModel_GAIN <= 80)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_SPORT.StarModel_GAIN >= 120)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SPORT.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_SPORT.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_SPORT.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_SPORT.DecCnt;
|
|
|
//随力矩输入调节助力比
|
|
|
Torque_Temp = (uint16_t)((uint32_t)(MC_TorqueProcess_Param.TorqueApp * Coefficient_GainCal(MC_AssisParam.Gear_SPORT.Gain_K >> 1, MC_AssisParam.Gear_SPORT.Gain_K, MC_AssisParam.Gear_SPORT.TorqueApp_TH, MC_TorqueProcess_Param.TorqueApp)) >> 10);
|
|
|
- //根据助力增益调节助力比
|
|
|
- Torque_Temp = Torque_Temp * MC_ConfigParam1.UserAdjParam_SPORT.Assist_K_GAIN / 100;
|
|
|
//给定下限
|
|
|
Torque_Temp = (Torque_Temp < MC_AssisParam.Gear_SPORT.Lower_Iq) ? MC_AssisParam.Gear_SPORT.Lower_Iq : Torque_Temp;
|
|
|
//给定上限
|
|
@@ -1196,25 +1094,11 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
case MC_GearSt_Torque_TURBO:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN <= 80)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_TURBO.StarModel_GAIN >= 120)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_TURBO.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_TURBO.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_TURBO.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_TURBO.DecCnt;
|
|
|
//随力矩输入调节助力比
|
|
|
Torque_Temp = (uint16_t)((uint32_t)(MC_TorqueProcess_Param.TorqueApp * Coefficient_GainCal(MC_AssisParam.Gear_TURBO.Gain_K >> 1, MC_AssisParam.Gear_TURBO.Gain_K, MC_AssisParam.Gear_TURBO.TorqueApp_TH, MC_TorqueProcess_Param.TorqueApp)) >> 10);
|
|
|
- //根据助力增益调节助力比
|
|
|
- Torque_Temp = Torque_Temp * MC_ConfigParam1.UserAdjParam_TURBO.Assist_K_GAIN / 100;
|
|
|
//给定下限
|
|
|
Torque_Temp = (Torque_Temp < MC_AssisParam.Gear_TURBO.Lower_Iq) ? MC_AssisParam.Gear_TURBO.Lower_Iq : Torque_Temp;
|
|
|
//给定上限
|
|
@@ -1231,19 +1115,7 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
case MC_GearSt_SMART:
|
|
|
{
|
|
|
//控制输入给定加速斜率
|
|
|
- if(MC_ConfigParam1.UserAdjParam_SMART.StarModel_GAIN <= 80)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SMART.AccCnt - 1;
|
|
|
- }
|
|
|
- else if(MC_ConfigParam1.UserAdjParam_SMART.StarModel_GAIN >= 120)
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SMART.AccCnt + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- TorqueAccStep = MC_AssisParam.Gear_SMART.AccCnt;
|
|
|
- }
|
|
|
- TorqueAccStep = (TorqueAccStep <= 0) ? 1 : TorqueAccStep;
|
|
|
+ TorqueAccStep = (MC_AssisParam.Gear_SMART.AccCnt <= 0) ? 1 : MC_AssisParam.Gear_SMART.AccCnt;
|
|
|
//控制输入给定减速斜率
|
|
|
TorqueDecStep = MC_AssisParam.Gear_SMART.DecCnt;
|
|
|
//助力比控制系数
|
|
@@ -1255,9 +1127,6 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
{
|
|
|
Torque_Temp = (uint32_t)(MC_TorqueProcess_Param.TorqueApp * MC_TorqueProcess_Param.TorqueApp) / (MC_AssisParam.Gear_SMART.TorqueApp_TH);
|
|
|
}
|
|
|
-
|
|
|
- //根据助力增益调节助力比
|
|
|
- Torque_Temp = Torque_Temp * MC_ConfigParam1.UserAdjParam_SMART.Assist_K_GAIN / 100;
|
|
|
//给定下限
|
|
|
Torque_Temp = (Torque_Temp < MC_AssisParam.Gear_SMART.Lower_Iq) ? MC_AssisParam.Gear_SMART.Lower_Iq : Torque_Temp;
|
|
|
//给定上限
|
|
@@ -1279,13 +1148,15 @@ MC_CalParam_Struct_t MC_AssistRunMode_Torque_Process(uint16_t SenorData, MC_Gear
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- static uint16_t speedLimitStart=250, speedLimitEnd=272, slewRate=52;
|
|
|
- if((MC_ConfigParam2.speedLimitStartAdj>50) || (MC_ConfigParam2.speedLimitStartAdj<-50)) MC_ConfigParam2.speedLimitStartAdj=0;
|
|
|
- if((MC_ConfigParam2.speedLimitEndAdj>50) || (MC_ConfigParam2.speedLimitEndAdj<-50)) MC_ConfigParam2.speedLimitEndAdj=0;
|
|
|
|
|
|
- speedLimitStart = MC_ConfigParam1.SpeedLimit*10 + MC_ConfigParam2.speedLimitStartAdj;
|
|
|
- speedLimitEnd = MC_ConfigParam1.SpeedLimit*10 + MC_ConfigParam2.speedLimitEndAdj + 22;
|
|
|
- slewRate = 1024/(speedLimitEnd-speedLimitStart-3);
|
|
|
+ //限速参数调整
|
|
|
+ static uint16_t speedLimitStart = 250, speedLimitEnd = 272, slewRate = 52;
|
|
|
+ if((MC_ConfigParam2.SpeedLimitStartAdj > 50) || (MC_ConfigParam2.SpeedLimitStartAdj < -50)) MC_ConfigParam2.SpeedLimitStartAdj = 0;
|
|
|
+ if((MC_ConfigParam2.SpeedLimitEndAdj > 50) || (MC_ConfigParam2.SpeedLimitEndAdj < -50)) MC_ConfigParam2.SpeedLimitEndAdj = 0;
|
|
|
+
|
|
|
+ speedLimitStart = (MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj) * 10 + MC_ConfigParam2.SpeedLimitStartAdj;
|
|
|
+ speedLimitEnd = (MC_ConfigParam1.SpeedLimit + (int8_t)MC_ConfigParam2.SpeedLimitAdj) * 10 + MC_ConfigParam2.SpeedLimitEndAdj + 22;
|
|
|
+ slewRate = 1024 / (speedLimitEnd - speedLimitStart - 3);
|
|
|
//随车速调节助力比
|
|
|
Torque_Temp = (uint16_t)((uint32_t)(Torque_Temp * Function_Linear_3Stage(speedLimitStart, 0, speedLimitStart, slewRate, MC_SpeedSensorData.Speed_Data)) >> 10);
|
|
|
|