/** * @file canAppl.c * @author Zhang, Kai(zhangkai71@midea.com) * @brief * @version 0.1 * @date 2022-03-02 * * @copyright Copyright (c) 2022 * */ #include "canAppl.h" #include "CodePara.h" #include "FuncLayerAPI.h" #include "adc.h" #include "alarm.h" #include "can.h" #include "flash_master.h" #include "glbcof.h" #include "spdctrmode.h" #include "string.h" #include "syspar.h" #include "AssistCurve.h" #include "hwsetup.h" #include "spi_master.h" #include "user.h" /****************************** * * Parameter * ******************************/ MC_RunInfo_Struct_t MC_RunInfo; MC_ErrorCode_Struct_t MC_ErrorCode = CAN_MC_ALARMCODE_DEFAULT; MC_ErrorCode_CNT_RECORD_Struct_t MC_ErrorCntRecord = CAN_MC_ALARMCODE_CNT_RECORD_DEFAULT; MC_VerInfo_Struct_t MC_VerInfo; char Firmware_Special[32]; MC_MacInfo_Struct_t MC_MacInfo; MC_RideLog_Struct_t MC_RideLog; BMS_RunInfo_Struct_t BMS_RunInfo; MC_ControlCode_Struct_t MC_ControlCode; MC_RunInfoToCDL_Struct_t MC_RunInfoToCDL; MC_RS_ASCII_Struct_t MC_RsASSCII; MC_UpperPCInfo_Struct_t MC_UpcInfo; BMS_VoltEstimat_Struct_t BMS_VoltEstimat; OBC_SetCustomPara_Struct_t OBC_SetCustomPara; OBC_ButtonStatus_Struct_t OBC_ButtonStatus = {0,0,0}; ULONG ulOBC_ComTimeOutCount = 0; uint8_t MC_MotorSPD_rpm_Percent = 0; uint8_t MC_WorkMode; uint8_t MC_BC_COM = 1; LPF_OUT BMS_swCurIdcLpf; void Can_voUpdateMC_UpcInfo(void) { MC_UpcInfo.stMotorInfo.uwPolePairs = cp_stMotorPara.swMotrPolePairs; MC_UpcInfo.stMotorInfo.uwRsmOhm = cp_stMotorPara.swRsOhm; MC_UpcInfo.stMotorInfo.uwLduH = cp_stMotorPara.swLdmH; MC_UpcInfo.stMotorInfo.uwLquH = cp_stMotorPara.swLqmH; MC_UpcInfo.stMotorInfo.uwFluxmWb = cp_stMotorPara.swFluxWb; MC_UpcInfo.stMotorInfo.uwIdMaxA = cp_stMotorPara.swIdMaxA; MC_UpcInfo.stMotorInfo.uwIdMinA = cp_stMotorPara.swIdMinA; MC_UpcInfo.stMotorInfo.uwRSpdRpm = cp_stMotorPara.swRSpeedRpm; MC_UpcInfo.stMotorInfo.uwRPwrWt = cp_stMotorPara.swRPwrWt; MC_UpcInfo.stMotorInfo.uwRCurA = cp_stMotorPara.swRIarmsA; MC_UpcInfo.stMotorInfo.uwRVolV = cp_stMotorPara.swRUdcV; MC_UpcInfo.stMotorInfo.uwJD = cp_stMotorPara.swJD; MC_UpcInfo.stMotorInfo.uwTorMaxNm = cp_stMotorPara.swTorMax; MC_UpcInfo.stBikeInfo.uwWheelPerimeter = ass_stParaCong.uwWheelPerimeter; MC_UpcInfo.stBikeInfo.uwMechRationMotor = ass_stParaCong.uwMechRationMotor; MC_UpcInfo.stBikeInfo.uwAssistMaxSpdKmH = ass_stParaCong.uwAssistMaxSpdKmH; MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH = ass_stParaCong.uwThrottleMaxSpdKmH; MC_UpcInfo.stBikeInfo.uwNmFrontChainring = ass_stParaCong.uwNmFrontChainring; MC_UpcInfo.stBikeInfo.uwNmBackChainring = ass_stParaCong.uwNmBackChainring; MC_UpcInfo.stBikeInfo.uwAssistSelect1 = ass_stParaCong.uwAssistSelect1; MC_UpcInfo.stBikeInfo.uwAssistSelect2 = ass_stParaCong.uwAssistSelect2; MC_UpcInfo.stBikeInfo.uwLightVoltage = ass_stParaCong.uwLightVoltage; MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = ass_stParaCong.swDeltPerimeter; MC_UpcInfo.stBikeInfo.uwStartMode = ass_stParaCong.uwStartMode; MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime = ass_stParaCong.uwAutoPowerOffTime; MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin = spi_stResolverOut.swSpiThetaOffsetOrignPu; MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow = spi_stResolverOut.swSpiThetaOffsetPu; MC_UpcInfo.stMContorlInfo.uwIPeakMaxA = cp_stMotorPara.swIpeakMaxA; MC_UpcInfo.stMContorlInfo.uwAlamOCurA = cp_stControlPara.swAlmOverCurrentVal; MC_UpcInfo.stMContorlInfo.uwAlamOVolV = cp_stControlPara.swAlmOverVolVal3; MC_UpcInfo.stMContorlInfo.uwAlamUVolV = cp_stControlPara.swAlmUnderVolVal2; MC_UpcInfo.stMContorlInfo.uwAlamOverSpdRpm = cp_stControlPara.swAlmOverSpdVal; MC_UpcInfo.stMContorlInfo.uwAlamOverHeatCe = cp_stControlPara.swAlmOverHeatCeVal; MC_UpcInfo.stMContorlInfo.uwAlamRecHeatCe = cp_stControlPara.swAlmRecOHeatVal; MC_UpcInfo.stMContorlInfo.uwPwrLimitStartCe = cp_stControlPara.swAlmPwrLimitStartTempVal; MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin = torsensor_stTorSensorCof.uwTorqueOffsetOrign; MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow1 = torsensor_stTorSensorCof.uwTorqueOffsetNow1; MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow2 = torsensor_stTorSensorCof.uwTorqueOffsetNow2; MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow3 = torsensor_stTorSensorCof.uwTorqueOffsetNow3; MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow4 = torsensor_stTorSensorCof.uwTorqueOffsetNow4; MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm = torsensor_stTorSensorCof.uwMaxSensorTorquePu; MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep1RealNm; MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = torsensor_stTorSensorCof.uwBikeTorStep1ADC; MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep2RealNm; MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = torsensor_stTorSensorCof.uwBikeTorStep2ADC; MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep3RealNm; MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = torsensor_stTorSensorCof.uwBikeTorStep3ADC; MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep4RealNm; MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = torsensor_stTorSensorCof.uwBikeTorStep4ADC; MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm = cadence_stFreGetCof.uwNumbersPulses; MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm = bikespeed_stFreGetCof.uwNumbersPulses; MC_UpcInfo.stAssistInfo.swStartupGain = ass_stParaSet.uwStartupCoef; MC_UpcInfo.stAssistInfo.swStartcruiseGain = ass_stParaSet.uwStartupCruiseCoef; MC_UpcInfo.stAssistInfo.uwAssistStartNm = ass_stParaSet.uwAssistStartNm; MC_UpcInfo.stAssistInfo.uwAssistStopNm = ass_stParaSet.uwAssistStopNm; MC_UpcInfo.stAssistInfo.uwStartUpGainStep = ass_stParaSet.uwStartUpGainStep; MC_UpcInfo.stAssistInfo.uwStartUpCadNm = ass_stParaSet.uwStartUpCadNm; MC_UpcInfo.stAssistInfo.uwTorLPFCadNm = ass_stParaSet.uwTorLPFCadNm; MC_UpcInfo.stAssistInfo.uwSpeedAssistSpdRpm = ass_stParaSet.uwSpeedAssistSpdRpm; MC_UpcInfo.stAssistInfo.uwSpeedAssistIMaxA = ass_stParaSet.uwSpeedAssistIMaxA; MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart = ass_stParaSet.uwAssistLimitBikeSpdStart; MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop = ass_stParaSet.uwAssistLimitBikeSpdStop; MC_UpcInfo.stAssistInfo.uwCadenceAssistWeight = ass_stParaSet.uwCadenceWeight; MC_UpcInfo.stHistoryInfo.uwOpenTimes = cp_stHistoryPara.uwOpenTimes; MC_UpcInfo.stHistoryInfo.uwUsedTimeH = (UWORD)(cp_stHistoryPara.ulUsedTime >> 16); MC_UpcInfo.stHistoryInfo.uwUsedTimeL = (UWORD)(cp_stHistoryPara.ulUsedTime); MC_UpcInfo.stHistoryInfo.uwNTCTempMaxCe = cp_stHistoryPara.uwNTCTempMaxCe; MC_UpcInfo.stHistoryInfo.uwNTCTempMinCe = cp_stHistoryPara.uwNTCTempMinCe; ; MC_UpcInfo.stHistoryInfo.uwAlamHOcurTimes = cp_stHistoryPara.uwAlamHOcurTimes; MC_UpcInfo.stHistoryInfo.uwAlamSOcurTimes = cp_stHistoryPara.uwAlamSOcurTimes; MC_UpcInfo.stHistoryInfo.uwAlamOHeatTimes = cp_stHistoryPara.uwAlamOHeatTimes; MC_UpcInfo.stHistoryInfo.uwAlamRotorLockTimes = cp_stHistoryPara.uwAlamRotorLockTimes; MC_UpcInfo.stHistoryInfo.uwAlamPhsLossTimes = cp_stHistoryPara.uwAlamPhsLossTimes; MC_UpcInfo.stHistoryInfo.uwAlamOVolTimes = cp_stHistoryPara.uwAlamOVolTimes; MC_UpcInfo.stHistoryInfo.uwAlamUVolTimes = cp_stHistoryPara.uwAlamUVolTimes; MC_UpcInfo.stHistoryInfo.uwAlamComOTimeTimes = cp_stHistoryPara.uwAlamComOTimeTimes; MC_UpcInfo.stHistoryInfo.uwG1AvgPwrConsumption = cp_stHistoryPara.uwG1AvgPwrConsumption; MC_UpcInfo.stHistoryInfo.uwG2AvgPwrConsumption = cp_stHistoryPara.uwG2AvgPwrConsumption; MC_UpcInfo.stHistoryInfo.uwG3AvgPwrConsumption = cp_stHistoryPara.uwG3AvgPwrConsumption; MC_UpcInfo.stHistoryInfo.uwG4AvgPwrConsumption = cp_stHistoryPara.uwG4AvgPwrConsumption; MC_UpcInfo.stHistoryInfo.uwG5AvgPwrConsumption = cp_stHistoryPara.uwG5AvgPwrConsumption; MC_UpcInfo.stHistoryInfo.uwODOTripH = (UWORD)(cp_stHistoryPara.ulODOTrip >> 16); MC_UpcInfo.stHistoryInfo.uwODOTripL = (UWORD)cp_stHistoryPara.ulODOTrip; MC_UpcInfo.stHistoryInfo.uwODOTimeH = (UWORD)(cp_stHistoryPara.ulODOTime >> 16); MC_UpcInfo.stHistoryInfo.uwODOTimeL = (UWORD)cp_stHistoryPara.ulODOTime; MC_UpcInfo.stHistoryInfo.uwTripSumH = (UWORD)(cp_stHistoryPara.ulTripSum >> 16); MC_UpcInfo.stHistoryInfo.uwTripSumL = (UWORD)cp_stHistoryPara.ulTripSum; MC_UpcInfo.stHistoryInfo.uwTripSumTimeH = (UWORD)(cp_stHistoryPara.ulTripSumTime >> 16); MC_UpcInfo.stHistoryInfo.uwTripSumTimeL = (UWORD)cp_stHistoryPara.ulTripSumTime; MC_UpcInfo.stHistoryInfo.uwTorSensorAlamTimes = cp_stHistoryPara.uwTorSensorAlamTimes; MC_UpcInfo.stHistoryInfo.uwCadSensorAlamTimes = cp_stHistoryPara.uwCadSensorAlamTimes; MC_UpcInfo.stHistoryInfo.uwBikeSpdSensorAlamTimes = cp_stHistoryPara.uwBikeSpdSensorAlamTimes; MC_UpcInfo.stHistoryInfo.uwPosSensorAlamTimes = cp_stHistoryPara.uwPosSensorAlamTimes; MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg = cp_stFlg.ParaFirstSetFlg; MC_UpcInfo.stTestParaInfo.uwSPIOffsetFirstSetFlg = cp_stFlg.SpiOffsetFirstSetFlg; MC_UpcInfo.stTestParaInfo.RunModelSelect = cp_stFlg.RunModelSelect; MC_UpcInfo.stTestParaInfo.ThetaGetModelSelect = cp_stFlg.ThetaGetModelSelect; MC_UpcInfo.stTestParaInfo.CurrentSampleModelSelect = cp_stFlg.CurrentSampleModelSelect; MC_UpcInfo.stTestParaInfo.RotateDirectionSelect = cp_stFlg.RotateDirectionSelect; MC_UpcInfo.stTestParaInfo.uwInitPosCurAmp = cp_stControlPara.swAlignCurAp; MC_UpcInfo.stTestParaInfo.uwVFControlVolAmp = cp_stControlPara.swDragVolAp; MC_UpcInfo.stTestParaInfo.uwIFControlCurAmp = cp_stControlPara.swDragCurAp; MC_UpcInfo.stTestParaInfo.uwVFIFTargetFreHz = cp_stControlPara.swDragSpdHz; MC_UpcInfo.stTestParaInfo.uwSpeedLoopAccRate = 500; MC_UpcInfo.stTestParaInfo.uwSpeedLoopDecRate = 100; MC_UpcInfo.stTestParaInfo.uwSpeedLoopBandWidthHz = cp_stControlPara.swAsrPIBandwidth; MC_UpcInfo.stTestParaInfo.uwSpeedLoopCoefM = cp_stControlPara.swAsrPIM; MC_UpcInfo.stTestParaInfo.uwCuerrentLoopBandWidthHz = cp_stControlPara.swAcrPIBandwidth; MC_UpcInfo.stTestParaInfo.uwCurrentLoopCoefM = cp_stControlPara.swAcrRaCoef; MC_UpcInfo.stTestParaInfo.uwFluxObsBandWidthHz = cp_stControlPara.swObsFluxPICrossfreHz; MC_UpcInfo.stTestParaInfo.uwFluxObsCoefM = cp_stControlPara.swObsFluxPIDampratio; MC_UpcInfo.stTestParaInfo.uwThetaObsPLLBandWidthHz = cp_stControlPara.swObsSpdPLLBandWidthHz; MC_UpcInfo.stTestParaInfo.uwThetaObsPLLCoefM = cp_stControlPara.swObsSpdPLLM; MC_UpcInfo.stTestParaInfo.uwJm = cp_stMotorPara.swJD ; MC_UpcInfo.stTestParaInfo.uwPWMMaxDuty = cp_stControlPara.swPWMMaxDuty; MC_UpcInfo.stTestParaInfo.uwPWM7to5Duty = cp_stControlPara.swPWM7to5Duty; MC_UpcInfo.stTestParaInfo.uwPwrLimit = cp_stControlPara.swPwrLimitValWt; MC_UpcInfo.stTestParaInfo.uwPwrLimitError = cp_stControlPara.swPwrLimitErrWt; MC_UpcInfo.stTestParaInfo.uwPwrLimitKp = cp_stControlPara.swPwrLimitKpPu; MC_UpcInfo.stTestParaInfo.uwPwrLimitKi = cp_stControlPara.swPwrLimitKiPu; OBC_SetCustomPara.uwWheelPerimeter = ass_stParaCong.uwWheelPerimeter; OBC_SetCustomPara.StartUpMod = ass_stParaCong.uwStartMode; OBC_SetCustomPara.BikeSpeedLimit = ass_stParaCong.uwAssistMaxSpdKmH; OBC_SetCustomPara.DeltDiameter = ass_stParaCong.swDeltPerimeter; OBC_SetCustomPara.AssistMod = ass_stParaSet.uwAsssistSelectNum; OBC_SetCustomPara.AutoPowerOffTime = ass_stParaCong.uwAutoPowerOffTime; } UWORD SizeMCUP; void Can_voInitMC_Run(void) { flash_voRead(); // Hardware version if (MOTOR_ID_SEL == MOTOR_WELLING_CITY_36V) strncpy(MC_VerInfo.HW_Version, (char *)"CITY-36V. ", 16); else if (MOTOR_ID_SEL == MOTOR_WELLING_CITY_48V) strncpy(MC_VerInfo.HW_Version, (char *)"CITY-48V. ", 16); else if (MOTOR_ID_SEL == MOTOR_WELLING_MTB_36V) strncpy(MC_VerInfo.HW_Version, (char *)"MTB-36V. ", 16); else if (MOTOR_ID_SEL == MOTOR_WELLING_MTB_48V) strncpy(MC_VerInfo.HW_Version, (char *)"MTB-48V. ", 16); else strncpy(MC_VerInfo.HW_Version, (char *)"TEST. ", 16); // Software version strncpy(MC_VerInfo.FW_Version, (char *)"V0r1r9_20230531.", 16); // Firmware Special Info strncpy(Firmware_Special, (char*)"TC00000-MC00000-V0r0. ", 32); // Model name memcpy(MC_VerInfo.Mode, flash_stPara.ubMotorVersion, sizeof(flash_stPara.ubMotorVersion)); // SN memcpy(MC_VerInfo.SN_Num, flash_stPara.ubSN, sizeof(flash_stPara.ubSN)); // Product information memcpy(MC_MacInfo.Manufacturer, flash_stPara.ubProdInfo.Manufacturer, sizeof(flash_stPara.ubProdInfo)); // User information memcpy(MC_RsASSCII.CustomASCII1, flash_stPara.ubRsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1)); memcpy(MC_RsASSCII.CustomASCII2, flash_stPara.ubRsASSCII.CustomASCII2, sizeof(MC_RsASSCII.CustomASCII2)); memcpy(MC_RsASSCII.CustomASCII3, flash_stPara.ubRsASSCII.CustomASCII3, sizeof(MC_RsASSCII.CustomASCII3)); BMS_VoltEstimat.uwInterResistpu = ((ULONG)1700 << 15) / cof_uwRbOm; //Q15 0.1mOhm BMS internal resistance 150mOhm + 20mOhm mth_voLPFilterCoef(1000000 / 100, EVENT_1MS_HZ, &BMS_swCurIdcLpf.uwKx); //100Hz } void Can_voMC_Run_1ms(void) { if (cp_stBikeRunInfoPara.BikeSpeedKmH > 30) { cp_stBikeRunInfoPara.ulRiTime++; cp_stHistoryPara.ulUsedTime++; } else {} if (adc_stUpOut.PCBTemp > ((SWORD)cp_stHistoryPara.uwNTCTempMaxCe)) { cp_stHistoryPara.uwNTCTempMaxCe = adc_stUpOut.PCBTemp; } else {} if (adc_stUpOut.PCBTemp < ((SWORD)cp_stHistoryPara.uwNTCTempMaxCe)) { cp_stHistoryPara.uwNTCTempMaxCe = adc_stUpOut.PCBTemp; } else {} // Error Cnt record and Error Display Set MC_ErrorCntRecord.ulAlamCntTimeCnt_1ms ++; if(MC_ErrorCntRecord.ulAlamCntTimeCnt_1ms == ALAM_DETECT_CNT_IN_1ms && MC_ErrorCode.Code == 0) { MC_ErrorCntRecord.Protect_OverCurrentCnt = 0; MC_ErrorCntRecord.Protect_OverVoltageCnt = 0; MC_ErrorCntRecord.Protect_UnderVoltageCnt = 0; MC_ErrorCntRecord.Protect_LockRotorCnt = 0; MC_ErrorCntRecord.Protect_OverTempCnt = 0; MC_ErrorCntRecord.Fault_PhaseLineCnt = 0; MC_ErrorCntRecord.ulAlamCntTimeCnt_1ms = 0; } else {} if (alm_blAlmOccrFlg == TRUE) { if (alm_blAlmSingleRecordDoneFlg == FALSE) { if (alm_unCode.bit.IPMFlt == 1) { MC_ErrorCntRecord.Protect_OverCurrentCnt++; cp_stHistoryPara.uwAlamHOcurTimes++; if (MC_ErrorCntRecord.Protect_OverCurrentCnt == ALAM_DISPLAY_CNT_0LEVEL)//ALAM_DISPLAY_CNT_2LEVEL { MC_ErrorCode.ERROR_Bit.Protect_OverCurrent = 1; } else {} } if (alm_unCode.bit.OvrCur == 1) { MC_ErrorCntRecord.Protect_OverCurrentCnt++; cp_stHistoryPara.uwAlamSOcurTimes++; if (MC_ErrorCntRecord.Protect_OverCurrentCnt == ALAM_DISPLAY_CNT_0LEVEL)//ALAM_DISPLAY_CNT_2LEVEL { MC_ErrorCode.ERROR_Bit.Protect_OverCurrent = 1; } else {} } if (alm_unCode.bit.OvrVlt == 1) { MC_ErrorCntRecord.Protect_OverVoltageCnt++; cp_stHistoryPara.uwAlamOVolTimes++; if (MC_ErrorCntRecord.Protect_OverVoltageCnt == ALAM_DISPLAY_CNT_0LEVEL)//ALAM_DISPLAY_CNT_2LEVEL { MC_ErrorCode.ERROR_Bit.Protect_OverVoltage = 1; } } if (alm_unCode.bit.UndrVlt == 1) { MC_ErrorCntRecord.Protect_UnderVoltageCnt++; cp_stHistoryPara.uwAlamUVolTimes++; if (MC_ErrorCntRecord.Protect_UnderVoltageCnt == ALAM_DISPLAY_CNT_0LEVEL)//ALAM_DISPLAY_CNT_2LEVEL { MC_ErrorCode.ERROR_Bit.Protect_UnderVoltage = 1; } } if (alm_unCode.bit.RotorLock == 1) { MC_ErrorCntRecord.Protect_LockRotorCnt++; cp_stHistoryPara.uwAlamRotorLockTimes++; if (MC_ErrorCntRecord.Protect_LockRotorCnt ==ALAM_DISPLAY_CNT_0LEVEL)//ALAM_DISPLAY_CNT_2LEVEL { MC_ErrorCode.ERROR_Bit.Protect_LockRotor = 1; } } if (alm_unCode.bit.IPMOvrHeat == 1) { MC_ErrorCntRecord.Protect_OverTempCnt++; cp_stHistoryPara.uwAlamOHeatTimes++; if (MC_ErrorCntRecord.Protect_OverTempCnt == ALAM_DISPLAY_CNT_0LEVEL) { MC_ErrorCode.ERROR_Bit.Protect_OverTemp = 1; } } if (alm_unCode.bit.PhsLoss == 1) { MC_ErrorCntRecord.Fault_PhaseLineCnt++; cp_stHistoryPara.uwAlamPhsLossTimes++; if (MC_ErrorCntRecord.Fault_PhaseLineCnt == ALAM_DISPLAY_CNT_0LEVEL) { MC_ErrorCode.ERROR_Bit.Fault_PhaseLine = 1; } } // if(alm_unCode.bit.CommOvrTm) // { // cp_stHistoryPara.uwAlamComOTimeTimes++; // } if (alm_unCode.bit.SpiThetaFlt == 1) { MC_ErrorCode.ERROR_Bit.Fault_SpiPosSensor = 1; } if (alm_unBikeCode.bit.BikeSpdSen == 1) { MC_ErrorCode.ERROR_Bit.Fault_BikeSpdSensor = 1; } if (alm_unBikeCode.bit.CadenceSen == 1) { MC_ErrorCode.ERROR_Bit.Fault_CadenceSensor = 1; } if (alm_unBikeCode.bit.PCBNTC == 1) { MC_ErrorCode.ERROR_Bit.Fault_PCBNTC = 1; } if (alm_unBikeCode.bit.Throttle == 1) { MC_ErrorCode.ERROR_Bit.Fault_Throttle = 1; } if (alm_unBikeCode.bit.TorqSen == 1) { MC_ErrorCode.ERROR_Bit.Fault_TorqueSensor = 1; } alm_blAlmSingleRecordDoneFlg = TRUE; } } else {} // Claear error Display if (MC_ErrorCode.ERROR_Bit.Protect_OverCurrent == 1) { if (alm_unCode.bit.IPMFlt != 1 && alm_unCode.bit.OvrCur != 1) { MC_ErrorCntRecord.Protect_OverCurrentCnt = 0; MC_ErrorCode.ERROR_Bit.Protect_OverCurrent = 0; } } else {} if (MC_ErrorCode.ERROR_Bit.Protect_OverVoltage == 1) { if (alm_unCode.bit.OvrVlt != 1) { MC_ErrorCntRecord.Protect_OverVoltageCnt = 0; MC_ErrorCode.ERROR_Bit.Protect_OverVoltage = 0; } } else {} if (MC_ErrorCode.ERROR_Bit.Protect_UnderVoltage == 1) { if (alm_unCode.bit.UndrVlt != 1) { MC_ErrorCntRecord.Protect_UnderVoltageCnt = 0; MC_ErrorCode.ERROR_Bit.Protect_UnderVoltage = 0; } } else {} if (MC_ErrorCode.ERROR_Bit.Protect_LockRotor == 1) { if (alm_unCode.bit.RotorLock != 1) { MC_ErrorCntRecord.Protect_LockRotorCnt = 0; MC_ErrorCode.ERROR_Bit.Protect_LockRotor = 0; } } else {} if (MC_ErrorCode.ERROR_Bit.Protect_OverTemp == 1) { if (alm_unCode.bit.IPMOvrHeat != 1) { MC_ErrorCntRecord.Protect_OverTempCnt = 0; MC_ErrorCode.ERROR_Bit.Protect_OverTemp = 0; } } else {} if (MC_ErrorCode.ERROR_Bit.Fault_PhaseLine == 1) { if (alm_unCode.bit.PhsLoss != 1) { MC_ErrorCntRecord.Fault_PhaseLineCnt = 0; MC_ErrorCode.ERROR_Bit.Fault_PhaseLine = 0; } } else {} if(MC_ErrorCode.ERROR_Bit.Fault_SpiPosSensor == 1) { if (alm_unCode.bit.SpiThetaFlt != 1) { MC_ErrorCode.ERROR_Bit.Fault_SpiPosSensor = 0; } } if(MC_ErrorCode.ERROR_Bit.Fault_BikeSpdSensor == 1) { if (alm_unBikeCode.bit.BikeSpdSen != 1) { MC_ErrorCode.ERROR_Bit.Fault_BikeSpdSensor = 0; } } if(MC_ErrorCode.ERROR_Bit.Fault_CadenceSensor == 1) { if (alm_unBikeCode.bit.CadenceSen != 1) { MC_ErrorCode.ERROR_Bit.Fault_CadenceSensor = 0; } } if(MC_ErrorCode.ERROR_Bit.Fault_PCBNTC == 1) { if (alm_unBikeCode.bit.PCBNTC != 1) { MC_ErrorCode.ERROR_Bit.Fault_PCBNTC = 0; } } if(MC_ErrorCode.ERROR_Bit.Fault_Throttle == 1) { if (alm_unBikeCode.bit.Throttle != 1) { MC_ErrorCode.ERROR_Bit.Fault_Throttle = 0; } } if(MC_ErrorCode.ERROR_Bit.Fault_TorqueSensor == 1) { if (alm_unBikeCode.bit.TorqSen != 1) { MC_ErrorCode.ERROR_Bit.Fault_TorqueSensor = 0; } } BMS_VoltEstimat.swIdcPu = (((ULONG)scm_stMotoPwrInLpf.slY.sw.hi << 13) / adc_stUpOut.uwVdcLpfPu); //Q15+Q13-Q14=Q14 Calculated dc current if(BMS_VoltEstimat.swIdcPu < 0) { BMS_VoltEstimat.swIdcPu = 0; } mth_voLPFilter(BMS_VoltEstimat.swIdcPu, &BMS_swCurIdcLpf); BMS_VoltEstimat.uwVdcCompPu = (ULONG)BMS_swCurIdcLpf.slY.sw.hi * BMS_VoltEstimat.uwInterResistpu >> 15; //Q14+Q15-Q15=Q14 } void Can_voMC_Run_5ms(void) { cp_stBikeRunInfoPara.BikeSpeedKmH = (((SQWORD)bikespeed_stFreGetOut.uwLPFFrequencyPu * FBASE * (ass_stParaCong.uwWheelPerimeter + ass_stParaCong.swDeltPerimeter) * 36 >> 20) * 1048 * 10) >> 20; // 1048 = Q20(1/1000) 0.1 km/h // MC_RunInfo.BusVoltage = ((SLONG)adc_stUpOut.uwVdcPu * cof_uwUbVt >> 14) * 100; MC_RunInfo.BusVoltage = ((ULONG)(adc_stUpOut.uwVdcLpfPu + BMS_VoltEstimat.uwVdcCompPu) * cof_uwUbVt * 100) >> 14; MC_RunInfo.MotorSpeed = (SLONG)scm_uwSpdFbkLpfAbsPu * cof_uwVbRpm >> 15; MC_RunInfo.BikeSpeed = cp_stBikeRunInfoPara.BikeSpeedKmH;//MC_RunInfo.MotorSpeed / 10; } void Can_voMC_Run_200ms(void) { UWORD TempPower; Can_GearSt_switch(); SizeMCUP = sizeof(MC_UpcInfo.stAssistInfo); if (MC_BC_COM == 0) { MC_RunInfoToCDL.Torque = ((ULONG)ass_stTorqMafValue.swValue * TORQUEBASE / 10) >> 14; // 0.1 Nm MC_RunInfoToCDL.CadenceDir = (MC_CadenceDir_Struct_t)cadence_stFreGetOut.cadence_dir; // 踩踏方向 0-正,1-反,2-停止， MC_RunInfoToCDL.Cadence = (cadence_stFreGetOut.uwLPFFrequencyPu * cof_uwVbRpm) >> 20; // rpm MC_RunInfoToCDL.GearSt = MC_ControlCode.GearSt; MC_RunInfoToCDL.T_PCB = adc_stUpOut.PCBTemp + 40; MC_RunInfoToCDL.T_Coil = adc_stUpOut.PCBTemp + 40; MC_RunInfoToCDL.BusVoltage = ((ULONG)adc_stUpOut.uwVdcLpfPu * cof_uwUbVt * 100) >> 14; // 1mV MC_RunInfoToCDL.BusCurrent = (((ULONG)scm_stMotoPwrInLpf.slY.sw.hi << 13) / adc_stUpOut.uwVdcLpfPu * cof_uwIbAp * 100) >> 14; // 1mA MC_RunInfoToCDL.MotorSpeed = (SLONG)scm_stSpdFbkLpf.slY.sw.hi * cof_uwVbRpm >> 15; // MC_RunInfoToCDL.BikeSpeed = // (((SQWORD)bikespeed_stFreGetOut.uwLPFFrequencyPu * cof_uwFbHz * ass_stParaCong.uwWheelPerimeter * 3216 * 36 >> 15) * 1050) >> // 35; // 600 0.1cm 3216 = Q10(3.1415926) 105 = Q20(1/10000) 0.1 km/h; // MC_RunInfoToCDL.BikeSpeed = (((SQWORD)bikespeed_stFreGetOut.uwLPFFrequencyPu * FBASE * ass_stParaCong.uwWheelPerimeter * 36 >> 20) * 1048 * 10) >> 20; MC_RunInfoToCDL.IqCurrent = ((SLONG)scm_swIqRefPu * cof_uwIbAp * 100) >> 14; MC_RunInfoToCDL.AlarmCode = MC_ErrorCode.Code && 0x00FF; SendData(ID_MC_TO_CDL, MODE_REPORT, 0xF112, (uint8_t *)&MC_RunInfoToCDL.Torque); } MC_RunInfo.BikeSpeed = cp_stBikeRunInfoPara.BikeSpeedKmH; ///>车速 0.1km/h，地址偏移0 MC_RunInfo.MotorSpeed = (SLONG)scm_uwSpdFbkLpfAbsPu * cof_uwVbRpm >> 15; ///>输出转速 1rpm，地址偏移2 if(scm_swMotorPwrInLpfWt > 5000) { scm_swMotorPwrInLpfWt = 5000; } if(scm_swMotorPwrInLpfWt < 0 ) { scm_swMotorPwrInLpfWt = 0; } if(hw_blPWMOnFlg == FALSE) { scm_swMotorPwrInLpfWt = 0; } else { } MC_RunInfo.Power = scm_swMotorPwrInLpfWt / 10; ///>电功率 1W，地址偏移4 MC_RunInfo.BusVoltage = ((ULONG)(adc_stUpOut.uwVdcLpfPu + BMS_VoltEstimat.uwVdcCompPu) * cof_uwUbVt * 100) >> 14; ///>???? 1mV?????6 if (scm_stMotoPwrInLpf.slY.sw.hi < 10) { TempPower = 0; } else { TempPower = scm_stMotoPwrInLpf.slY.sw.hi; } MC_RunInfo.BusCurrent = (((ULONG)TempPower << 13) / adc_stUpOut.uwVdcLpfPu) * cof_uwIbAp * 100 >> 14; ///>母线电流 1mA，地址偏移8 MC_RunInfo.Cadence =(cadence_stFreGetOut.uwLPFFrequencyPu * cof_uwFbHz * 60) >> 20; ///>踏频 1rpm，地址偏移10 MC_RunInfo.Torque = ((ULONG)torsensor_stTorSensorOut.uwTorqueLPFPu * 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 MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch; ///>灯开关 0xF0-关，0xF1-开，地址偏移14 Can_SOC_Cal(); ///>剩余电量 1%，地址偏移15 MC_RunInfo.ODO_Km = MC_RideLog.ODO_Km / 10; ///>总里程 1km，地址偏移18 Can_Trip_Cal(); if (cp_stBikeRunInfoPara.blGearStUpdate) { MC_RunInfo.PowerPerKm = *(&cp_stHistoryPara.uwG1AvgPwrConsumption + (cp_stBikeRunInfoPara.uwBikeGear - 1)) / 10; ///>平均功耗 0.01Ah/km ，地址偏移20 cp_stBikeRunInfoPara.BMSRestChargeLast = BMS_RunInfo.RC; cp_stBikeRunInfoPara.uwPowerPerKm = 0; cp_stBikeRunInfoPara.uwAvePowerPerKm = 0; cp_stBikeRunInfoPara.uwPowerPerKmSum = 0; memset(cp_stBikeRunInfoPara.uwPowerPerKmBuf, 0, sizeof(cp_stBikeRunInfoPara.uwPowerPerKmBuf)); cp_stBikeRunInfoPara.uwAvePowerCNT = 0; cp_stBikeRunInfoPara.uwCruisDis = 0; } MC_RunInfo.T_PCB = adc_stUpOut.PCBTemp + 40; ///>PCB温度 +40℃，地址偏移21 MC_RunInfo.T_Coil = adc_stUpOut.PCBTemp + 40; ///>绕组温度 +40℃，地址偏移22 MC_RunInfo.T_MCU = adc_stUpOut.PCBTemp + 40; ///>MCU温度 +40℃，地址偏移23 MC_RunInfo.Ride_Time = cp_stBikeRunInfoPara.ulRiTime >> 10; ///>开机后骑行时间 1s，地址偏移26 if (MC_WorkMode == 1) { SendData(ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t *)&MC_RunInfo.BikeSpeed); } } void Can_Trip_Cal(void) { if (bikespeed_stFreGetOut.blUpdateTripCntFlg == TRUE) { MC_RunInfo.Ride_Km++; cp_stHistoryPara.ulODOTrip++; // Unit: 0.1km cp_stHistoryPara.ulTripSum++; Can_RemainTrip_Cal(); bikespeed_stFreGetOut.blUpdateTripCntFlg = FALSE; } MC_RideLog.ODO_Km = cp_stHistoryPara.ulODOTrip; MC_RideLog.TRIP_Km = cp_stHistoryPara.ulTripSum; MC_RideLog.ODO_Time = cp_stHistoryPara.ulODOTime + (cp_stBikeRunInfoPara.ulRiTime >> 10) / 60; // min MC_RideLog.TRIP_Time = cp_stHistoryPara.ulTripSumTime + (cp_stBikeRunInfoPara.ulRiTime >> 10) / 60; // min } void Can_RemainTrip_Cal(void) { UWORD uwCruisCoef; //ϵQ12 cp_stBikeRunInfoPara.uwCruisDis++; // 0.1 km if (cp_stBikeRunInfoPara.uwCruisDis >= 5) // 5 = 0.5km { cp_stBikeRunInfoPara.uwCruisDis = 0; cp_stBikeRunInfoPara.BMSRestChargeNow = BMS_RunInfo.RC; cp_stBikeRunInfoPara.uwPowerPerKm = (cp_stBikeRunInfoPara.BMSRestChargeLast - cp_stBikeRunInfoPara.BMSRestChargeNow) << 1; // BMS_RunInfo.RC (BMSRestChargeLast - BMSRestChargeNow) /0.5 km cp_stBikeRunInfoPara.BMSRestChargeLast = cp_stBikeRunInfoPara.BMSRestChargeNow; cp_stBikeRunInfoPara.uwPowerPerKmSum -= cp_stBikeRunInfoPara.uwPowerPerKmBuf[cp_stBikeRunInfoPara.uwAvePowerCNT]; cp_stBikeRunInfoPara.uwPowerPerKmBuf[cp_stBikeRunInfoPara.uwAvePowerCNT] = cp_stBikeRunInfoPara.uwPowerPerKm; cp_stBikeRunInfoPara.uwPowerPerKmSum += cp_stBikeRunInfoPara.uwPowerPerKmBuf[cp_stBikeRunInfoPara.uwAvePowerCNT]; if (cp_stBikeRunInfoPara.uwPowerPerKmBuf[31] == 0) { cp_stBikeRunInfoPara.uwAvePowerPerKm = cp_stBikeRunInfoPara.uwPowerPerKmSum / (cp_stBikeRunInfoPara.uwAvePowerCNT + 1); } else { cp_stBikeRunInfoPara.uwAvePowerPerKm = cp_stBikeRunInfoPara.uwPowerPerKmSum >> 5; } cp_stBikeRunInfoPara.uwAvePowerCNT++; if (cp_stBikeRunInfoPara.uwAvePowerCNT >= 32) { cp_stBikeRunInfoPara.uwAvePowerCNT = 0; } if (cp_stBikeRunInfoPara.uwBikeGear == 1) { uwCruisCoef = ((ULONG)cp_stBikeRunInfoPara.uwAvePowerPerKm << 12) / cp_stHistoryPara.uwG1AvgPwrConsumption; cp_stHistoryPara.uwG1AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG1AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG2AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG2AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG3AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG3AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG4AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG4AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG5AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG5AvgPwrConsumption * uwCruisCoef >> 12; MC_RunInfo.PowerPerKm = cp_stHistoryPara.uwG1AvgPwrConsumption / 10; } else if (cp_stBikeRunInfoPara.uwBikeGear == 2) { uwCruisCoef = ((ULONG)cp_stBikeRunInfoPara.uwAvePowerPerKm << 12) / cp_stHistoryPara.uwG2AvgPwrConsumption; cp_stHistoryPara.uwG1AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG1AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG2AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG2AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG3AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG3AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG4AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG4AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG5AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG5AvgPwrConsumption * uwCruisCoef >> 12; MC_RunInfo.PowerPerKm = cp_stHistoryPara.uwG2AvgPwrConsumption / 10; } else if (cp_stBikeRunInfoPara.uwBikeGear == 3) { uwCruisCoef = ((ULONG)cp_stBikeRunInfoPara.uwAvePowerPerKm << 12) / cp_stHistoryPara.uwG3AvgPwrConsumption; cp_stHistoryPara.uwG1AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG1AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG2AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG2AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG3AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG3AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG4AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG4AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG5AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG5AvgPwrConsumption * uwCruisCoef >> 12; MC_RunInfo.PowerPerKm = cp_stHistoryPara.uwG3AvgPwrConsumption / 10; } else if (cp_stBikeRunInfoPara.uwBikeGear == 4) { uwCruisCoef = ((ULONG)cp_stBikeRunInfoPara.uwAvePowerPerKm << 12) / cp_stHistoryPara.uwG4AvgPwrConsumption; cp_stHistoryPara.uwG1AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG1AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG2AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG2AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG3AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG3AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG4AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG4AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG5AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG5AvgPwrConsumption * uwCruisCoef >> 12; MC_RunInfo.PowerPerKm = cp_stHistoryPara.uwG4AvgPwrConsumption / 10; } else if (cp_stBikeRunInfoPara.uwBikeGear == 5) { uwCruisCoef = ((ULONG)cp_stBikeRunInfoPara.uwAvePowerPerKm << 12) / cp_stHistoryPara.uwG5AvgPwrConsumption; cp_stHistoryPara.uwG1AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG1AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG2AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG2AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG3AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG3AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG4AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG4AvgPwrConsumption * uwCruisCoef >> 12; cp_stHistoryPara.uwG5AvgPwrConsumption = (ULONG)cp_stHistoryPara.uwG5AvgPwrConsumption * uwCruisCoef >> 12; MC_RunInfo.PowerPerKm = cp_stHistoryPara.uwG5AvgPwrConsumption / 10; } else { uwCruisCoef = 4096; } MC_RunInfo.RemainDistance = BMS_RunInfo.RC / MC_RunInfo.PowerPerKm; } } #if ((MOTOR_ID_SEL == MOTOR_WELLING_CITY_36V) || (MOTOR_ID_SEL == MOTOR_WELLING_MTB_36V)) SLONG slBMSMaxVol = 42000; SLONG slBMSMinVol = 32000; #elif ((MOTOR_ID_SEL == MOTOR_WELLING_CITY_48V) || (MOTOR_ID_SEL == MOTOR_WELLING_MTB_48V)) SLONG slBMSMaxVol = 54600; SLONG slBMSMinVol = 41600; #endif SWORD SOC_Cnt, SOC_Value, SOC_MIN; SLONG SOC_Sum; BOOL blSOCfirstSet = FALSE; void Can_SOC_Cal(void) { UWORD templenght; if (blSOCfirstSet == FALSE) { SOC_Value = ((SLONG)MC_RunInfo.BusVoltage - (SLONG)slBMSMinVol) * 100 / ((SLONG)slBMSMaxVol - (SLONG)slBMSMinVol); SOC_MIN = SOC_Value; if (SOC_MIN > 100) { SOC_MIN = 100; } blSOCfirstSet = TRUE; } else { templenght = 60000 / 200; // 60s in 200ms time task SOC_Cnt++; SOC_Sum += ((SLONG)MC_RunInfo.BusVoltage - (SLONG)slBMSMinVol) * 100 / ((SLONG)slBMSMaxVol - (SLONG)slBMSMinVol); if (SOC_Cnt >= templenght) // 60s { SOC_Value = SOC_Sum / templenght; if (SOC_Value < SOC_MIN) { SOC_MIN = SOC_Value; } else {} SOC_Cnt = 0; SOC_Sum = 0; } } if (SOC_Value > SOC_MIN) { SOC_Value = SOC_MIN; } else if (SOC_Value < 0) { SOC_Value = 0; } else {} MC_RunInfo.SOC = SOC_Value; } void Can_GearSt_switch(void) { cp_stBikeRunInfoPara.uwBikeGearLast = cp_stBikeRunInfoPara.uwBikeGear; if(MC_WorkMode == 1)//ģʽԶر { ulOBC_ComTimeOutCount = cp_ulSystickCnt; } if((cp_ulSystickCnt - ulOBC_ComTimeOutCount) < 3000) //DZͨжϳ3sر { if (MC_ControlCode.GearSt <= 0x05) { cp_stBikeRunInfoPara.uwBikeGear = MC_ControlCode.GearSt; } else if (MC_ControlCode.GearSt == 0x33) { cp_stBikeRunInfoPara.uwBikeGear = 5; } else if (MC_ControlCode.GearSt == 0x22) { cp_stBikeRunInfoPara.uwBikeGear = 0x22; } } else { MC_ControlCode.GearSt = MC_GearSt_OFF; MC_RunInfo.GearSt = 0x00; cp_stBikeRunInfoPara.uwBikeGear = 0x00; } if (cp_stBikeRunInfoPara.uwBikeGear != cp_stBikeRunInfoPara.uwBikeGearLast) { cp_stBikeRunInfoPara.blGearStUpdate = TRUE; } else { cp_stBikeRunInfoPara.blGearStUpdate = FALSE; } } void Can_Light_switch(void) { /* light switch*/ if (MC_ControlCode.LightSwitch == 0xF1) { cp_stBikeRunInfoPara.uwLightSwitch = 1; } else if (MC_ControlCode.LightSwitch == 0xF0) { cp_stBikeRunInfoPara.uwLightSwitch = 0; } } void Can_AssistCoef_Read(UPC_CurveOrderInfo_Struct_t *order) { MC_UpcInfo.stAssistInfo.stCurveOrderInfo = *order; memcpy(&MC_UpcInfo.stAssistInfo.slTorquePolyA, &flash_stPara.slTorqAssGain[order->swTorqueCurveNum - 1], sizeof(POLY_COEF)); memcpy(&MC_UpcInfo.stAssistInfo.slCadencePolyA, &flash_stPara.slCadAssGain[order->swCadenceCurveNum - 1], sizeof(POLY_COEF)); } void Can_AssistCoef_Write(UPC_CurveOrderInfo_Struct_t *order) { memcpy(&flash_stPara.slTorqAssGain[order->swTorqueCurveNum - 1], &MC_UpcInfo.stAssistInfo.slTorquePolyA, sizeof(POLY_COEF)); memcpy(&flash_stPara.slCadAssGain[order->swCadenceCurveNum - 1], &MC_UpcInfo.stAssistInfo.slCadencePolyA, sizeof(POLY_COEF)); }