|
@@ -874,6 +874,7 @@ void ass_voAssistCmdDeal(void)
|
|
|
/** Record Last assist mode */
|
|
|
ass_stCadAssParaPro.uwAssitModeLast = ass_stCadAssParaPro.uwAssitMode;
|
|
|
|
|
|
+#if 0
|
|
|
/** Cart Comand */
|
|
|
if(ass_stCadAssParaIn.uwGearSt == 0x22)
|
|
|
{
|
|
@@ -892,8 +893,8 @@ void ass_voAssistCmdDeal(void)
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- tmp_slAssistSpdCmd = (SLONG)ass_stCadAssCoef.swKmhToMSpdPu*(SLONG)ass_stCadAssCoef.uwCartMaxBikeSpeed >> 4;
|
|
|
- }
|
|
|
+ tmp_slAssistSpdCmd = (SLONG)ass_stCadAssCoef.swKmhToMSpdPu*(SLONG)ass_stCadAssCoef.uwCartMaxBikeSpeed >> 4;
|
|
|
+ }
|
|
|
}
|
|
|
else if((ass_stCadAssParaIn.uwGearSt > 0)&&(ass_stCadAssParaIn.uwGearSt <= 5))
|
|
|
{
|
|
@@ -901,7 +902,7 @@ void ass_voAssistCmdDeal(void)
|
|
|
if(ass_stCadAssParaIn.uwThrottlePercent > 250)
|
|
|
{
|
|
|
ass_stCadAssParaPro.uwAssitMode = 7;
|
|
|
- #if(THROTTLEGEAR !=0)
|
|
|
+ #if(THROTTLEGEAR != 0)
|
|
|
if(ass_stCadAssParaIn.uwGearSt == 1)
|
|
|
{
|
|
|
ass_MaxSpeed.MaxBikeSpeed = ass_MaxSpeed.uwGearOne;
|
|
@@ -950,7 +951,7 @@ void ass_voAssistCmdDeal(void)
|
|
|
{
|
|
|
#if(INTELLIGENCADGEAR_EN!=0)
|
|
|
tmp_slAssistCadSpdCmd = (SLONG)ass_voCadCmdDeal(); //Q14
|
|
|
-#endif
|
|
|
+ #endif
|
|
|
/** Assist command,gear 1 to 5 */
|
|
|
if(ass_stCadAssParaIn.uwGearSt == 1)
|
|
|
{
|
|
@@ -1085,7 +1086,33 @@ void ass_voAssistCmdDeal(void)
|
|
|
ass_stCadAssParaPro.uwAssitMode = 0;
|
|
|
tmp_slAssistSpdCmd = 0; /**< Q15 */
|
|
|
}
|
|
|
-
|
|
|
+#else //仪表挡位控制转速
|
|
|
+ if((ass_stCadAssParaIn.uwGearSt >= 0x01) && (ass_stCadAssParaIn.uwGearSt <= 0x05) )
|
|
|
+ {
|
|
|
+ ass_stCadAssParaPro.uwAssitMode = 6;
|
|
|
+ if(ass_stCadAssParaIn.uwGearSt == 0x01)
|
|
|
+ MC_MotorSPD_rpm_Percent = 20;
|
|
|
+ else if(ass_stCadAssParaIn.uwGearSt == 0x02)
|
|
|
+ MC_MotorSPD_rpm_Percent = 40;
|
|
|
+ else if(ass_stCadAssParaIn.uwGearSt == 0x03)
|
|
|
+ MC_MotorSPD_rpm_Percent = 60;
|
|
|
+ else
|
|
|
+ MC_MotorSPD_rpm_Percent = 100;
|
|
|
+ tmp_slAssistSpdCmd = (SLONG)ass_stCadAssCoef.swKmhToMSpdPu*(SLONG)ass_stCadAssCoef.uwThrottleMaxBikeSpeed >> 4;
|
|
|
+ tmp_slAssistSpdCmd= ((SLONG)MC_MotorSPD_rpm_Percent * tmp_slAssistSpdCmd) / 100;
|
|
|
+
|
|
|
+ if(MC_MotorSPD_rpm_Percent <= 2)
|
|
|
+ {
|
|
|
+ tmp_slAssistSpdCmd = 0;
|
|
|
+ ass_stCadAssParaPro.uwAssitMode = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ ass_stCadAssParaPro.uwAssitMode = 0;
|
|
|
+ tmp_slAssistSpdCmd = 0; /**< Q15 */
|
|
|
+ }
|
|
|
+#endif
|
|
|
/** Stop Assist when Bike Brake */
|
|
|
if((BikeBrake_blGetstate() == TRUE) ||(BMS_RunInfo.Status.Status_Bit.Charge!=0))
|
|
|
{
|