|
@@ -744,7 +744,7 @@ void Can_voMC_Run_5ms(void)
|
|
|
|
|
|
void Can_voMC_Run_200ms(void)
|
|
|
{
|
|
|
- // UWORD TempPower;
|
|
|
+ static SLONG slCadenceFltSum = 0;
|
|
|
|
|
|
// 电池通讯异常采用控制器计算电量
|
|
|
if((cp_ulSystickCnt - ulBMS_ComTimeOutCount) > 3000)
|
|
@@ -792,7 +792,8 @@ void Can_voMC_Run_200ms(void)
|
|
|
MC_RunInfo.Power= Powercal.PowerPoit; //功率
|
|
|
MC_RunInfo.BusVoltage = ((ULONG)adc_stUpOut.uwVdcLpfPu * cof_uwUbVt * 100) >> 14; //母线电压 1mV,地址偏移6
|
|
|
MC_RunInfo.BusCurrent = ((ULONG)adc_stUpOut.uwIbusAvgLpfPu) * cof_uwIbAp * 10 >> 14; //母线电流 1mA,地址偏移8
|
|
|
- MC_RunInfo.Cadence = (cadence_stFreGetOut.uwLPFFrequencyPu * cof_uwFbHz * 60) >> 20; //踏频 1rpm,地址偏移10
|
|
|
+ slCadenceFltSum += ((cadence_stFreGetOut.uwLPFFrequencyPu << 4) - slCadenceFltSum ) >> 3;
|
|
|
+ MC_RunInfo.Cadence = ((slCadenceFltSum >> 4) * cof_uwFbHz * 60 ) >> 20; //踏频 1rpm,地址偏移10
|
|
|
MC_RunInfo.Torque = ((ULONG)torsensor_stTorSensorOut.uwTorquePu * cof_uwTorqNm / 10) >> 14; //踩踏力矩 1Nm,地址偏移11
|
|
|
MC_RunInfo.CadenceDir = (MC_CadenceDir_Struct_t)cadence_stFreGetOut.cadence_dir; //踩踏方向 0-正,1-反,2-停止,地址偏移12
|
|
|
MC_RunInfo.GearSt = MC_ControlCode.GearSt; //助力档位,地址偏移13
|