motor_ctl-4/User project/3.BasicFunction/Source/canAppl.c

/**
 * @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"
#include "FSM_2nd.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_20230607.", 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;
        }
    }
    UWORD TempPower;
    if(FSM2nd_Run_state.state == Exit)
    {
        TempPower = 0;
    }
    else
    {
        TempPower = scm_stMotoPwrInLpf.slY.sw.hi;
    }
    BMS_VoltEstimat.swIdcPu = (((ULONG)TempPower << 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)
{
   
    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

    MC_RunInfo.BusCurrent = (ULONG)BMS_VoltEstimat.swIdcPu * 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
    MC_RunInfo.SOC = 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 Voltage_Sum;
BOOL  blSOCfirstSet = FALSE;
UWORD  Can_SOC_Cal(void)
{
    UWORD templenght, VoltageAvg = 0;
    //����1s�ȴ���ѹ�ȶ����ʼ������
    if(cp_ulSystickCnt < 1000)
    {
        return 0;
    }
    //������ʼ��һ�ε���
    if (blSOCfirstSet == FALSE)
    {
        if(MC_RunInfo.BusVoltage >= slBMSMaxVol)
        {
            SOC_Value = 100;
        }
        else if(MC_RunInfo.BusVoltage <= slBMSMinVol)
        {
            SOC_Value = 0;
        }
        else
        {
            SOC_Value = ((SLONG)MC_RunInfo.BusVoltage - (SLONG)slBMSMinVol) * 100 / ((SLONG)slBMSMaxVol - (SLONG)slBMSMinVol);
        }
        SOC_MIN = SOC_Value;
        blSOCfirstSet = TRUE;
    }
    //1min����һ�ε���
    else
    {
        templenght = 300; // 60s in 200ms time task
        SOC_Cnt++;
        Voltage_Sum += MC_RunInfo.BusVoltage;
        if (SOC_Cnt >= templenght) // 60s
        {
            VoltageAvg = Voltage_Sum / templenght;
            if(VoltageAvg <= slBMSMinVol)
            {
                SOC_Value = 0;
            }
            else
            {
                SOC_Value = ((SLONG)VoltageAvg - (SLONG)slBMSMinVol) * 100 / ((SLONG)slBMSMaxVol - (SLONG)slBMSMinVol);
            }
            
            if (SOC_Value < SOC_MIN)
            {
                SOC_MIN = SOC_Value;
            }
            else
            {}
            SOC_Cnt = 0;
            Voltage_Sum = 0;
        }
    }
    //�������ݼ�
    if (SOC_Value > SOC_MIN)
    {
        SOC_Value = SOC_MIN;
    }
    else if (SOC_Value < 0)
    {
        SOC_Value = 0;
    }
    else
    {}
    return 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));
}