4G/code/app/bms/SFM.c

#include "SFM.h"
#define FltArrLen 200
#define FltDispArrLen 20

DiagThrstruct DiagThr;
DiagTimestruct DiagTime;

void SFM_Init(void)
{
    sfmd_flg_firstRun = true;
}

void SFM(void)
{
    static uint8_T sfmn_num_Cnt;
    boolean_T sfmn_flg_interComFlt;
    boolean_T sfmn_flg_authFlt;
    boolean_T sfmn_flg_HVILFlt;
    boolean_T sfmn_flg_chrgMosClosFlt;
    boolean_T sfmn_flg_disChrgMosClosFlt;

    static uint16_T Time0Cnt;
    static uint16_T modTMaxArr[10];
    static uint16_T SumT0;
    static uint16_T Time1Cnt;
    static uint16_T heatT1Arr[10];
    static uint16_T SumT1;
    static uint16_T Time2Cnt;
    static uint16_T heatT2Arr[10];
    static uint16_T SumT2;

    static uint16_T CellUArry[4][cmnc_num_cellUNumMax];
    static uint8_T ErrNr[cmnc_num_cellUNumMax];
    static uint8_T RecNr[cmnc_num_cellUNumMax];
    static boolean_T sfmv_flg_cellUOpenFlt[cmnc_num_cellUNumMax];
    static boolean_T ErrUFlg[cmnc_num_cellUNumMax];
    uint32_T SumU;
    uint16_T UNum;
    boolean_T sfmd_flg_volFlt;
    boolean_T Enable1;
    boolean_T Enable2;

    static uint8_T modTOpenNr[cmnc_num_modTNumMax];
    boolean_T sfmd_flg_modTOpenFlt;
    boolean_T sfmv_flg_modTOpenFlt[cmnc_num_modTNumMax];
    boolean_T sfmd_flg_chrgMosTOpenFlt;
    boolean_T sfmd_flg_DCPlugTOpenFlt;
    boolean_T sfmd_flg_ACPlugTOpenFlt;
    boolean_T sfmd_flg_heatPanT1OpenFlt;
    boolean_T sfmd_flg_heatPanT2OpenFlt;

    static uint16_T modTArr[cmnc_num_modTNumMax];
    uint16_T Tnum;
    uint32_T SumT;

    static uint8_T modTRatNr[cmnc_num_modTNumMax];
    boolean_T sfmd_flg_modTRatFlt;
    boolean_T sfmv_flg_modTRatFlt[cmnc_num_modTNumMax];
    boolean_T sfmd_flg_chrgMosTRatFlt;
    boolean_T sfmd_flg_DCPlugTRatFlt;
    boolean_T sfmd_flg_ACPlugTRatFlt;
    boolean_T sfmd_flg_heatPanT1RatFlt;
    boolean_T sfmd_flg_heatPanT2RatFlt;
    boolean_T sfmn_flg_chrgMosTRatFltOnce;
    boolean_T sfmn_flg_DCPlugTRatFltOnce;
    boolean_T sfmn_flg_ACPlugTRatFltOnce;
    boolean_T sfmn_flg_heatPanT1RatFltOnce;
    boolean_T sfmn_flg_heatPanT2RatFltOnce;
    static uint16_T sfmn_T_mosT_Delay;
    static uint16_T sfmn_T_DCPlugT_Delay;
    static uint16_T sfmn_T_ACPlugT_Delay;
    static uint16_T sfmn_T_heatPanT1_Delay;
    static uint16_T sfmn_T_heatPanT2_Delay;
    static uint16_T sfmn_T_heatPanT1_Delay1;
    static uint16_T sfmn_T_heatPanT2_Delay1;
    boolean_T sfmd_flg_modTAllFlt;
    boolean_T sfmd_flg_heatPanTAllFlt;
    boolean_T sfmd_flg_currOpenFlt;
    uint16_T sfmn_I_currAbs;
    static boolean_T sfmd_flg_cellUOverFlt2;
    static boolean_T sfmd_flg_cellUOverFlt1;
    static boolean_T sfmd_flg_cellULowFlt2;
    static boolean_T sfmd_flg_cellULowFlt1;
    static boolean_T sfmd_flg_cellUDiffFlt2;
    static boolean_T sfmd_flg_cellUDiffFlt1;
    static boolean_T sfmd_flg_battUOverFlt2;
    static boolean_T sfmd_flg_battUOverFlt1;
    static boolean_T sfmd_flg_battULowFlt2;
    static boolean_T sfmd_flg_battULowFlt1;

    boolean_T chrgFlg;
    boolean_T disChrgFlg;
    static boolean_T sfmd_flg_chrgModTOverFlt2;
    static boolean_T sfmd_flg_chrgModTOverFlt1;
    static boolean_T sfmd_flg_chrgModTLowFlt2;
    static boolean_T sfmd_flg_chrgModTLowFlt1;
    static boolean_T sfmd_flg_disChrgModTOverFlt2;
    static boolean_T sfmd_flg_disChrgModTOverFlt1;
    static boolean_T sfmd_flg_disChrgModTLowFlt2;
    static boolean_T sfmd_flg_disChrgModTLowFlt1;
    static boolean_T sfmd_flg_modTDiffFlt2;
    static boolean_T sfmd_flg_modTDiffFlt1;
    static boolean_T sfmd_flg_chrgMosTOverFlt2;
    static boolean_T sfmd_flg_chrgMosTOverFlt1;
    static boolean_T sfmd_flg_disChrgMosTOverFlt2;
    static boolean_T sfmd_flg_disChrgMosTOverFlt1;
    static boolean_T sfmd_flg_DCPlugTOverFlt2;
    static boolean_T sfmd_flg_DCPlugTOverFlt1;
    static boolean_T sfmd_flg_ACPlugTOverFlt2;
    static boolean_T sfmd_flg_ACPlugTOverFlt1;
    static boolean_T sfmd_flg_heatPanTOverFlt2_1;
    static boolean_T sfmd_flg_heatPanTOverFlt2_2;
    boolean_T sfmd_flg_heatPanTOverFlt2;
    static boolean_T sfmd_flg_heatPanTOverFlt1_1;
    static boolean_T sfmd_flg_heatPanTOverFlt1_2;
    boolean_T sfmd_flg_heatPanTOverFlt1;
    static boolean_T sfmd_flg_chrgCurrOverFlt;
    static boolean_T sfmd_flg_disChrgCurrOverFlt;

    boolean_T sfmd_flg_chrgCurrOverMisFlt;
    boolean_T sfmd_flg_disChrgCurrOverMisFlt;
    boolean_T sfmd_flg_battULowMisFlt;
    boolean_T sfmd_flg_battUOverMisFlt;
    boolean_T sfmd_flg_cellULowMisFlt;
    boolean_T sfmd_flg_cellUOverMisFlt;
    boolean_T sfmd_flg_chrgModTOverMisFlt;
    boolean_T sfmd_flg_chrgModTLowMisFlt;
    boolean_T sfmd_flg_disChrgModTOverMisFlt;
    boolean_T sfmd_flg_disChrgModTLowMisFlt;
    boolean_T sfmd_flg_chrgMosTOverMisFlt;
    boolean_T sfmd_flg_disChrgMosTOverMisFlt;
    boolean_T sfmd_flg_socMisFlt;
    boolean_T sfmd_flg_sohMisFlt;
    boolean_T sfmd_flg_socJumpFlt;
    boolean_T sfmd_flg_EEsaveFlt;
    static uint16_T sfmn_pct_bcuSoc_Delay;

    static uint16_T noDisChrgCnt;
    static int16_T sfmd_I_curr_Delay;
    static boolean_T sfmn_flg_Udrop;
    static boolean_T sfmd_flg_heatclear;
    static boolean_T sfmn_flg_volFlt_keep;
    static uint16_T CntA;
    static uint16_T ModTStor[4][cmnc_num_modTNumMax];
    static boolean_T sfmn_flg_Tup;
    static boolean_T sfmn_flg_modTOpenFlt_keep;
    static uint16_T CntB;
    static boolean_T sfmn_flg_urtRecFlt_Delay = false;

    int32_T SumR;
    int32_T SumRR;
    boolean_T sfmd_flg_deltRFlt;
    static uint8_T deltRFltNr[cmnc_num_cellUNumMax];

    boolean_T FltFlg[FltArrLen];
    uint16_T FltLevel[FltArrLen];
    uint8_T FltAct[FltArrLen];
    uint16_T FltCodeArr[FltDispArrLen];
    uint16_T FltLevelArr[FltDispArrLen];
    uint8_T FltActArr[FltDispArrLen];
    uint16_T i;
    uint16_T j;
    uint16_T k;

    if (sfmn_flg_urtRecFlt_Delay)
    {
        sfmd_flg_firstRun = true;
    }
    sfmn_flg_urtRecFlt_Delay = ihd_flg_urtRecFlt;
    //初值
    if (sfmd_flg_firstRun)
    {
        sfmn_num_Cnt = 10;
        memset(&DiagThr, 0, sizeof(DiagThr));
        memset(&DiagTime, 0, sizeof(DiagTime));
        memset(heatT1Arr, 0, sizeof(heatT1Arr));
        memset(heatT2Arr, 0, sizeof(heatT2Arr));
        memset(ErrNr, 0, sizeof(ErrNr));
        memset(sfmv_flg_cellUOpenFlt, 0, sizeof(sfmv_flg_cellUOpenFlt));
        memset(ErrUFlg, 0, sizeof(ErrUFlg));
        memset(RecNr, 0, sizeof(RecNr));
        memset(modTOpenNr, 0, sizeof(modTOpenNr));
        memset(modTRatNr, 0, sizeof(modTRatNr));
        memset(deltRFltNr, 0, sizeof(deltRFltNr));
        sfmd_flg_cellUOverFlt2 = false;
        sfmd_flg_cellUOverFlt1 = false;
        sfmd_flg_cellULowFlt2 = false;
        sfmd_flg_cellULowFlt1 = false;
        sfmd_flg_cellUDiffFlt2 = false;
        sfmd_flg_cellUDiffFlt1 = false;
        sfmd_flg_battUOverFlt2 = false;
        sfmd_flg_battUOverFlt1 = false;
        sfmd_flg_battULowFlt2 = false;
        sfmd_flg_battULowFlt1 = false;
        sfmd_flg_chrgModTOverFlt2 = false;
        sfmd_flg_chrgModTOverFlt1 = false;
        sfmd_flg_chrgModTLowFlt2 = false;
        sfmd_flg_chrgModTLowFlt1 = false;
        sfmd_flg_disChrgModTOverFlt2 = false;
        sfmd_flg_disChrgModTOverFlt1 = false;
        sfmd_flg_disChrgModTLowFlt2 = false;
        sfmd_flg_disChrgModTLowFlt1 = false;
        sfmd_flg_modTDiffFlt2 = false;
        sfmd_flg_modTDiffFlt1 = false;
        sfmd_flg_chrgMosTOverFlt2 = false;
        sfmd_flg_chrgMosTOverFlt1 = false;
        sfmd_flg_disChrgMosTOverFlt2 = false;
        sfmd_flg_disChrgMosTOverFlt1 = false;
        sfmd_flg_DCPlugTOverFlt2 = false;
        sfmd_flg_DCPlugTOverFlt1 = false;
        sfmd_flg_ACPlugTOverFlt2 = false;
        sfmd_flg_ACPlugTOverFlt1 = false;
        sfmd_flg_heatPanTOverFlt2_1 = false;
        sfmd_flg_heatPanTOverFlt2_2 = false;
        sfmd_flg_heatPanTOverFlt1_1 = false;
        sfmd_flg_heatPanTOverFlt1_2 = false;
        sfmd_flg_chrgCurrOverFlt = false;
        sfmd_flg_disChrgCurrOverFlt = false;

        noDisChrgCnt = 0;
        sfmd_I_curr_Delay = ihd_I_curr;
        sfmn_flg_Udrop = false;
        sfmd_flg_heatclear = false;
        sfmn_flg_volFlt_keep = false;
        CntA = 10;
        sfmn_flg_Tup = false;
        sfmn_flg_modTOpenFlt_keep = false;
        CntB = 0;

        sfmn_T_mosT_Delay = ihd_T_mosT;
        sfmn_T_DCPlugT_Delay = ihd_T_DCPlugT;
        sfmn_T_ACPlugT_Delay = ihd_T_ACPlugT;
        sfmn_T_heatPanT1_Delay = ihd_T_heatPanT1;
        sfmn_T_heatPanT2_Delay = ihd_T_heatPanT2;
        sfmn_T_heatPanT1_Delay1 = ihd_T_heatPanT1;
        sfmn_T_heatPanT2_Delay1 = ihd_T_heatPanT2;
        sfmn_pct_bcuSoc_Delay = socd_pct_bcuSoc;
    }

    // 故障清楚指令
    if (ihd_flg_DTCClear)
    {
        sfmd_flg_mainCirClosFltEi = false;
        sfmd_flg_mainCirClosFltEo = false;
        sfmd_flg_heatCirOpenFltEi = false;
        sfmd_flg_heatCirOpenFltEo = false;
        sfmd_flg_heatCirClosFltEi = false;
        sfmd_flg_heatCirClosFltEo = false;
        sfmd_flg_heatRunFltEi = false;
        sfmd_flg_heatRunFltEo = false;
        sfmd_flg_iscFltEi = false;
        sfmd_flg_iscFltEo = false;
    }

    //=======================================================================================
    //====================================故障诊断    =======================================
    //=======================================================================================
    //=======================================================================================
    // 1 内网通信故障
    if (ihd_flg_urtRecFlt)
    {
        sfmn_flg_interComFlt = true;
    }
    else
    {
        sfmn_flg_interComFlt = false;
    }

    // 5 认证失败故障
    sfmn_flg_authFlt = (ihd_st_authFaild == 1) && (!sfmn_flg_interComFlt);

    // 11 高压互锁故障
    if (ihd_flg_HVILFlt)
    {
        sfmn_flg_HVILFlt = true;
    }
    else
    {
        sfmn_flg_HVILFlt = false;
    }
    // 16
    sfmd_flg_iscFltEo = iscd_flg_flt[0] || iscd_flg_flt[1] || iscd_flg_flt[2] || sfmd_flg_iscFltEi || sfmd_flg_iscFltEo;

    // 22 充电Mos失效故障
    sfmn_flg_chrgMosClosFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_flg_chrgMosClosFlt, &DiagTime.N22, 2);

    // 24 放电Mos失效故障
    sfmn_flg_disChrgMosClosFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_flg_disChrgMosClosFlt, &DiagTime.N24, 2);

    // 34 主回路常闭故障   //(充电MOS及放电MOS，主继电器断开  使能)
    sfmd_flg_mainCirClosFltEo = JudgeTimeSystem(!ihd_st_chrgMosControl && !ihd_st_disChrgMosControl && !ihd_st_relayControl, sfmd_I_curr > 5 || sfmd_I_curr < -5, &DiagTime.N34, 5) || sfmd_flg_mainCirClosFltEo || sfmd_flg_mainCirClosFltEi;

    // 52 电压开路故障
    sfmn_num_Cnt = sfmn_num_Cnt + 1;
    if (!sfmn_flg_interComFlt && sfmn_num_Cnt >= 0)
    {
        sfmn_num_Cnt = 0;
        // 矩阵更新
        for (j = 0; j < 4 && sfmd_flg_firstRun; j++)
        {
            for (i = 0; i < cmnc_num_cellUNum; i++)
            {
                CellUArry[j][i] = ihv_V_cellU[i];
            }
        }
        for (j = 0; j < 3; j++)
        {
            for (i = 0; i < cmnc_num_cellUNum; i++)
            {
                CellUArry[j][i] = CellUArry[j + 1][i];
            }
        }
        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            CellUArry[j][i] = ihv_V_cellU[i];
        }
        // 故障判断
        for (i = 0; i < cmnc_num_cellUNum - 1; i++)
        {
            if ((int16_T)(CellUArry[3][i] - CellUArry[1][i]) < -50 && (int16_T)(CellUArry[3][i + 1] - CellUArry[1][i + 1]) > 50)
            {
                ErrNr[i] = ErrNr[i] + 1;
            }
            else
            {
                ErrNr[i] = 0;
            }
            if (ErrNr[i] >= 2 || ((int16_T)(CellUArry[3][i] - CellUArry[2][i]) < -1000 && (int16_T)(CellUArry[3][i + 1] - CellUArry[2][i + 1]) > 1000))
            {
                sfmv_flg_cellUOpenFlt[i] = true;
                ErrUFlg[i] = true;
                ErrUFlg[i + 1] = true;
            }
            if (sfmv_flg_cellUOpenFlt[i])
            {
                for (k = 0; k < i; k++)
                {
                    if ((int16_T)(CellUArry[3][i - k] - CellUArry[2][i - k]) < -200)
                    {
                        sfmv_flg_cellUOpenFlt[i - k] = true;
                        ErrUFlg[i - k] = true;
                    }
                }
            }
        }
    }
    //
    if (!sfmn_flg_interComFlt)
    {
        sfmd_V_cellUMax = 0;
        sfmd_V_cellUMin = 10000;
        SumU = 0;
        UNum = 0;
        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if (!ErrUFlg[i])
            {
                SumU = SumU + ihv_V_cellU[i];
                UNum = UNum + 1;
                if (sfmd_V_cellUMax < ihv_V_cellU[i])
                {
                    sfmd_V_cellUMax = ihv_V_cellU[i];
                    sfmd_idx_cellUMax = i;
                }
                if (sfmd_V_cellUMin > ihv_V_cellU[i])
                {
                    sfmd_V_cellUMin = ihv_V_cellU[i];
                    sfmd_idx_cellUMin = i;
                }
            }
        }
        if (sfmd_V_cellUMax - sfmd_V_cellUMin > 5000) // 2021 10.24
        {
            sfmd_V_cellUAvrg = (SumU - sfmd_V_cellUMax - sfmd_V_cellUMin) / (UNum - 2);
            for (i = 0; i < cmnc_num_cellUNum; i++)
            {
                if (!ErrUFlg[i] && (int16_T)(ihv_V_cellU[i] - sfmd_V_cellUAvrg) > 1500)
                {
                    ErrUFlg[i] = true;
                }
                if (!ErrUFlg[i] && (int16_T)(ihv_V_cellU[i] - sfmd_V_cellUAvrg) < -1500)
                {
                    ErrUFlg[i] = true;
                    sfmv_flg_cellUOpenFlt[i] = true;
                }
            }
        }
        else
        {
            sfmd_V_cellUAvrg = (SumU - sfmd_V_cellUMax - sfmd_V_cellUMin) / (UNum - 2);
        }

        // 恢复
        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if (ErrUFlg[i])
            {
                if ((int16_T)(ihv_V_cellU[i] - sfmd_V_cellUAvrg) < 200 && (int16_T)(ihv_V_cellU[i] - sfmd_V_cellUAvrg) > -200)
                {
                    RecNr[i] = (RecNr[i] + 1) > 200 ? 200 : (RecNr[i] + 1);
                }
                else
                {
                    RecNr[i] = 0;
                }
                if (RecNr[i] >= 2)
                {
                    sfmv_flg_cellUOpenFlt[i] = false;
                    ErrUFlg[i] = false;
                }
            }
        }
    }
    //=======================电压处理======================================
    SumU = 0;
    sfmd_flg_volFlt = false;
    for (i = 0; i < cmnc_num_cellUNum; i++)
    {
        if (ErrUFlg[i] && !sfmn_flg_interComFlt)
        {
            sfmv_V_cellU[i] = sfmd_V_cellUAvrg;
        }
        else
        {
            sfmv_flg_cellUOpenFlt[i] = false;
            sfmv_V_cellU[i] = ihv_V_cellU[i];
        }
        SumU = SumU + sfmv_V_cellU[i];
        sfmd_flg_volFlt = sfmd_flg_volFlt || sfmv_flg_cellUOpenFlt[i];
    }
    sfmd_V_battU = (uint16_T)(SumU * 0.01);

    // 53 模组温度开路故障
    sfmd_flg_modTOpenFlt = false;
    for (i = 0; i < cmnc_num_modTNum; i++)
    {
        if (ihv_T_modT[i] == 10 && !sfmn_flg_interComFlt) //-30℃
        {
            modTOpenNr[i] = (modTOpenNr[i] + 1) > 200 ? 200 : (modTOpenNr[i] + 1);
        }
        else
        {
            modTOpenNr[i] = 0;
        }
        if (modTOpenNr[i] >= 2)
        {
            sfmv_flg_modTOpenFlt[i] = true;
        }
        else
        {
            sfmv_flg_modTOpenFlt[i] = false;
        }

        sfmd_flg_modTOpenFlt = sfmd_flg_modTOpenFlt || sfmv_flg_modTOpenFlt[i];
    }

    // 54 Mos温度开路故障
    sfmd_flg_chrgMosTOpenFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_T_mosT == 10, &DiagTime.N54, 2);

    // 56 快充插头温度开路故障
    sfmd_flg_DCPlugTOpenFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_T_DCPlugT == 0, &DiagTime.N56, 2);
    // 57 慢充插头温度开路故障
    sfmd_flg_ACPlugTOpenFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_T_ACPlugT == 0, &DiagTime.N57, 2);
    // 58 加热板#1温度开路故障
    sfmd_flg_heatPanT1OpenFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_T_heatPanT1 == 0, &DiagTime.N58, 2);
    // 59 加热板#2温度开路故障
    sfmd_flg_heatPanT2OpenFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, ihd_T_heatPanT2 == 0, &DiagTime.N59, 2);

    // 61 模组温度合理性故障
    sfmd_flg_modTRatFlt = false;
    for (i = 0; i < cmnc_num_modTNum && sfmd_flg_firstRun; i++)
    {
        modTArr[i] = ihv_T_modT[i];
    }
    for (i = 0; i < cmnc_num_modTNum; i++)
    {
        if (!sfmv_flg_modTOpenFlt[i] && ((int16_T)(modTArr[i] - ihv_T_modT[i]) > 10 || (int16_T)(modTArr[i] - ihv_T_modT[i]) < -20) && !sfmn_flg_interComFlt)
        {
            modTRatNr[i] = (modTRatNr[i] + 1) > 200 ? 200 : (modTRatNr[i] + 1);
        }
        else
        {
            modTRatNr[i] = 0;
            modTArr[i] = ihv_T_modT[i];
        }
        if (modTRatNr[i] >= 2)
        {
            sfmv_flg_modTRatFlt[i] = true;
        }
        else
        {
            sfmv_flg_modTRatFlt[i] = false;
        }

        sfmd_flg_modTRatFlt = sfmd_flg_modTRatFlt || sfmv_flg_modTRatFlt[i];
    }

    // printf("%d,%d,%d,%d\n",sfmn_T_mosT_Delay,ihd_T_mosT,FirstRun_SFM,ihd_flg_urtRecFlt);
    // 62 充电Mos 温度合理性故障
    sfmn_flg_chrgMosTRatFltOnce = !sfmn_flg_interComFlt && !sfmd_flg_chrgMosTOpenFlt && ((int16_T)(ihd_T_mosT - sfmn_T_mosT_Delay) < -10 || (int16_T)(ihd_T_mosT - sfmn_T_mosT_Delay) > 20);
    if (!sfmn_flg_chrgMosTRatFltOnce)
    {
        sfmn_T_mosT_Delay = ihd_T_mosT;
    }
    sfmd_flg_chrgMosTRatFlt = JudgeTimeSystem(1, sfmn_flg_chrgMosTRatFltOnce, &DiagTime.N62, 2);

    // 64 快充插头温度合理性故障
    sfmn_flg_DCPlugTRatFltOnce = !sfmn_flg_interComFlt && !sfmd_flg_DCPlugTOpenFlt && ((int16_T)(ihd_T_DCPlugT - sfmn_T_DCPlugT_Delay) < -10 || (int16_T)(ihd_T_DCPlugT - sfmn_T_DCPlugT_Delay) > 20);
    if (!sfmn_flg_chrgMosTRatFltOnce)
    {
        sfmn_T_DCPlugT_Delay = ihd_T_DCPlugT;
    }
    sfmd_flg_DCPlugTRatFlt = JudgeTimeSystem(1, sfmn_flg_DCPlugTRatFltOnce, &DiagTime.N64, 2);

    // 65 慢插头温度合理性故障
    sfmn_flg_ACPlugTRatFltOnce = !sfmn_flg_interComFlt && !sfmd_flg_ACPlugTOpenFlt && ((int16_T)(ihd_T_ACPlugT - sfmn_T_ACPlugT_Delay) < -10 || (int16_T)(ihd_T_ACPlugT - sfmn_T_ACPlugT_Delay) > 20);
    if (!sfmn_flg_ACPlugTRatFltOnce)
    {
        sfmn_T_ACPlugT_Delay = ihd_T_ACPlugT;
    }
    sfmd_flg_ACPlugTRatFlt = JudgeTimeSystem(1, sfmn_flg_ACPlugTRatFltOnce, &DiagTime.N65, 2);

    // 66 加热板#1 温度合理性故障
    sfmn_flg_heatPanT1RatFltOnce = !sfmn_flg_interComFlt && !sfmd_flg_heatPanT1OpenFlt && ((int16_T)(ihd_T_heatPanT1 - sfmn_T_heatPanT1_Delay) < -10 || (int16_T)(ihd_T_heatPanT1 - sfmn_T_heatPanT1_Delay) > 20);
    if (!sfmn_flg_heatPanT1RatFltOnce)
    {
        sfmn_T_heatPanT1_Delay = ihd_T_heatPanT1;
    }
    sfmd_flg_heatPanT1RatFlt = JudgeTimeSystem(1, sfmn_flg_heatPanT1RatFltOnce, &DiagTime.N66, 2);

    // 67 加热板#2 温度合理性故障
    sfmn_flg_heatPanT2RatFltOnce = !sfmn_flg_interComFlt && !sfmd_flg_heatPanT2OpenFlt && ((int16_T)(ihd_T_heatPanT2 - sfmn_T_heatPanT2_Delay) < -10 || (int16_T)(ihd_T_heatPanT2 - sfmn_T_heatPanT2_Delay) > 20);
    if (!sfmn_flg_heatPanT2RatFltOnce)
    {
        sfmn_T_heatPanT2_Delay = ihd_T_heatPanT2;
    }
    sfmd_flg_heatPanT2RatFlt = JudgeTimeSystem(1, sfmn_flg_heatPanT2RatFltOnce, &DiagTime.N67, 2);

    // 68 模组温度全部不可用
    sfmd_flg_modTAllFlt = true;
    for (i = 0; i < cmnc_num_modTNum; i++)
    {
        sfmd_flg_modTAllFlt = sfmd_flg_modTAllFlt && (sfmv_flg_modTOpenFlt[i] || sfmv_flg_modTRatFlt[i]);
    }

    // 温度处理
    sfmd_T_modTMax = 0;
    sfmd_T_modTMin = 200;
    Tnum = 0;
    SumT = 0;
    if (!sfmd_flg_modTAllFlt)
    {
        for (i = 0; i < cmnc_num_modTNum; i++)
        {
            if (!sfmv_flg_modTRatFlt[i] && !sfmv_flg_modTOpenFlt[i])
            {
                SumT = SumT + ihv_T_modT[i];
                Tnum = Tnum + 1;
                if (sfmd_T_modTMax < ihv_T_modT[i])
                {
                    sfmd_T_modTMax = ihv_T_modT[i];
                    sfmd_idx_modTMax = i;
                }
                if (sfmd_T_modTMin > ihv_T_modT[i])
                {
                    sfmd_T_modTMin = ihv_T_modT[i];
                    sfmd_idx_modTMin = i;
                }
            }
        }
        for (i = 0; i < cmnc_num_modTNum; i++)
        {
            if (!sfmv_flg_modTRatFlt[i] && !sfmv_flg_modTOpenFlt[i])
            {
                sfmv_T_modT[i] = ihv_T_modT[i];
            }
            else
            {
                sfmv_T_modT[i] = SumT / Tnum;
            }
        }
    }

    // 69 加热板温度全部开路故障
    sfmd_flg_heatPanTAllFlt = (sfmd_flg_heatPanT1OpenFlt || sfmd_flg_heatPanT1RatFlt) && (sfmd_flg_heatPanT2OpenFlt || sfmd_flg_heatPanT2RatFlt);

    // 71 电流传感器故障
    sfmd_flg_currOpenFlt = false;
    sfmd_I_curr = ihd_I_curr;
    // 81 单体过压故障2级
    sfmd_flg_cellUOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt, sfmd_V_cellUMax, sfmc_V_cellUOverThrFlt2, sfmc_V_cellUOverThrRec2, 2, 2, &DiagThr.fltNum81, &DiagThr.recNum81, &sfmd_flg_cellUOverFlt2);
    // 82 单体过压故障1级
    sfmd_flg_cellUOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt, sfmd_V_cellUMax, sfmc_V_cellUOverThrFlt1, sfmc_V_cellUOverThrRec1, 2, 2, &DiagThr.fltNum82, &DiagThr.recNum82, &sfmd_flg_cellUOverFlt1) && !sfmd_flg_cellUOverFlt2;

    // 83 单体欠压故障2级
    sfmd_flg_cellULowFlt2 = DiagThrSystem2(1, !sfmn_flg_interComFlt, sfmd_V_cellUMin, sfmc_V_cellULowThrFlt2, sfmc_V_cellULowThrRec2, 2, 2, &DiagThr.fltNum83, &DiagThr.recNum83, &sfmd_flg_cellULowFlt2);
    // 84 单体欠压故障1级
    sfmd_flg_cellULowFlt1 = DiagThrSystem2(0, !sfmn_flg_interComFlt, sfmd_V_cellUMin, sfmc_V_cellULowThrFlt1, sfmc_V_cellULowThrRec1, 2, 2, &DiagThr.fltNum84, &DiagThr.recNum84, &sfmd_flg_cellULowFlt1) && !sfmd_flg_cellULowFlt2;

    // 85 压差过大2级
    sfmd_flg_cellUDiffFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && socd_pct_battSoc > 200, sfmd_V_cellUMax - sfmd_V_cellUMin, sfmc_flg_cellUDiffThrFlt2, sfmc_flg_cellUDiffThrRec2, 2, 2, &DiagThr.fltNum85, &DiagThr.recNum85, &sfmd_flg_cellUDiffFlt2);
    // 86 压差过大1级
    sfmd_flg_cellUDiffFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && socd_pct_battSoc > 200, sfmd_V_cellUMax - sfmd_V_cellUMin, sfmc_flg_cellUDiffThrFlt1, sfmc_flg_cellUDiffThrRec1, 2, 2, &DiagThr.fltNum86, &DiagThr.recNum86, &sfmd_flg_cellUDiffFlt1) && !sfmd_flg_cellUDiffFlt2;

    // 87 总压过压2级
    sfmd_flg_battUOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt, sfmd_V_battU, sfmc_V_battUOverThrFlt2, sfmc_V_battUOverThrRec2, 2, 2, &DiagThr.fltNum87, &DiagThr.recNum87, &sfmd_flg_battUOverFlt2);
    // 88 总压过压1级
    sfmd_flg_battUOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt, sfmd_V_battU, sfmc_V_battUOverThrFlt1, sfmc_V_battUOverThrRec1, 2, 2, &DiagThr.fltNum88, &DiagThr.recNum88, &sfmd_flg_battUOverFlt1) && !sfmd_flg_battUOverFlt2;

    // 89 总压欠压2级
    sfmd_flg_battULowFlt2 = DiagThrSystem2(1, !sfmn_flg_interComFlt, sfmd_V_battU, sfmc_V_battULowThrFlt2, sfmc_V_battULowThrRec2, 2, 2, &DiagThr.fltNum89, &DiagThr.recNum89, &sfmd_flg_battULowFlt2);
    // 90 总压欠压1级
    sfmd_flg_battULowFlt1 = DiagThrSystem2(0, !sfmn_flg_interComFlt, sfmd_V_battU, sfmc_V_battULowThrFlt1, sfmc_V_battULowThrRec1, 2, 2, &DiagThr.fltNum90, &DiagThr.recNum90, &sfmd_flg_battULowFlt1) && !sfmd_flg_battULowFlt2;

    chrgFlg = ihd_st_workStat == 2;
    disChrgFlg = ihd_st_workStat != 2;

    // 97 模组充电温度过高2级故障
    sfmd_flg_chrgModTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && chrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMax, sfmc_T_chrgModTOverThrFlt2, sfmc_T_chrgModTOverThrRec2, 3, 3, &DiagThr.fltNum97, &DiagThr.recNum97, &sfmd_flg_chrgModTOverFlt2);
    // 98 模组充电温度过高1级故障
    sfmd_flg_chrgModTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && chrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMax, sfmc_T_chrgModTOverThrFlt1, sfmc_T_chrgModTOverThrRec1, 3, 3, &DiagThr.fltNum98, &DiagThr.recNum98, &sfmd_flg_chrgModTOverFlt1) && !sfmd_flg_chrgModTOverFlt2;
    // 99 模组充电温度过低2级故障
    sfmd_flg_chrgModTLowFlt2 = DiagThrSystem2(0, !sfmn_flg_interComFlt && chrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMin, sfmc_T_chrgModTLowThrFlt2, sfmc_T_chrgModTLowThrRec2, 3, 3, &DiagThr.fltNum99, &DiagThr.recNum99, &sfmd_flg_chrgModTLowFlt2);
    // 100 模组充电温度过低1级故障
    sfmd_flg_chrgModTLowFlt1 = DiagThrSystem2(0, !sfmn_flg_interComFlt && chrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMin, sfmc_T_chrgModTLowThrFlt1, sfmc_T_chrgModTLowThrRec1, 3, 3, &DiagThr.fltNum100, &DiagThr.recNum100, &sfmd_flg_chrgModTLowFlt1) && !sfmd_flg_chrgModTLowFlt2;

    // 101 模组放电温度过高2级故障
    sfmd_flg_disChrgModTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && disChrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMax, sfmc_T_disChrgModTOverThrFlt2, sfmc_T_disChrgModTOverThrRec2, 3, 3, &DiagThr.fltNum101, &DiagThr.recNum101, &sfmd_flg_disChrgModTOverFlt2);
    // 102 模组放电温度过高1级故障
    sfmd_flg_disChrgModTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && disChrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMax, sfmc_T_disChrgModTOverThrFlt1, sfmc_T_disChrgModTOverThrRec1, 3, 3, &DiagThr.fltNum102, &DiagThr.recNum102, &sfmd_flg_disChrgModTOverFlt1) && !sfmd_flg_disChrgModTOverFlt2;
    // 103 模组放电温度过低2级故障
    sfmd_flg_disChrgModTLowFlt2 = DiagThrSystem2(0, !sfmn_flg_interComFlt && disChrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMin, sfmc_T_disChrgModTLowThrFlt2, sfmc_T_disChrgModTLowThrRec2, 3, 3, &DiagThr.fltNum103, &DiagThr.recNum103, &sfmd_flg_disChrgModTLowFlt2);
    // 104 模组放电温度过低1级故障
    sfmd_flg_disChrgModTLowFlt1 = DiagThrSystem2(0, !sfmn_flg_interComFlt && disChrgFlg && !sfmd_flg_modTAllFlt, sfmd_T_modTMin, sfmc_T_disChrgModTLowThrFlt1, sfmc_T_disChrgModTLowThrRec1, 3, 3, &DiagThr.fltNum104, &DiagThr.recNum104, &sfmd_flg_disChrgModTLowFlt1) && !sfmd_flg_disChrgModTLowFlt2;

    //
    // 105 模组温差2级故障
    sfmd_flg_modTDiffFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && !sfmd_flg_modTAllFlt, sfmd_T_modTMax - sfmd_T_modTMin, sfmc_T_modTDiffThrFlt2, sfmc_T_modTDiffThrRec2, 3, 3, &DiagThr.fltNum105, &DiagThr.recNum105, &sfmd_flg_modTDiffFlt2);
    // 106 模组温差1级故障
    sfmd_flg_modTDiffFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && !sfmd_flg_modTAllFlt, sfmd_T_modTMax - sfmd_T_modTMin, sfmc_T_modTDiffThrFlt1, sfmc_T_modTDiffThrRec1, 3, 3, &DiagThr.fltNum106, &DiagThr.recNum106, &sfmd_flg_modTDiffFlt1) && !sfmd_flg_modTDiffFlt2;

    // 107 充电Mos温度过高2级故障
    sfmd_flg_chrgMosTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && chrgFlg && sfmd_flg_chrgMosTRatFlt && sfmd_flg_chrgMosTOpenFlt, ihd_T_mosT, sfmc_T_chrgMosTOverThrFlt2, sfmc_T_chrgMosTOverThrRec2, 3, 3, &DiagThr.fltNum107, &DiagThr.recNum107, &sfmd_flg_chrgMosTOverFlt2);
    // 108 充电Mos温度过高1级故障
    sfmd_flg_chrgMosTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && chrgFlg && sfmd_flg_chrgMosTRatFlt && sfmd_flg_chrgMosTOpenFlt, ihd_T_mosT, sfmc_T_chrgMosTOverThrFlt1, sfmc_T_chrgMosTOverThrRec1, 3, 3, &DiagThr.fltNum108, &DiagThr.recNum108, &sfmd_flg_chrgMosTOverFlt1) && !sfmd_flg_chrgMosTOverFlt2;
    // 109 放电Mos温度过高2级故障
    sfmd_flg_disChrgMosTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && disChrgFlg && sfmd_flg_chrgMosTRatFlt && sfmd_flg_chrgMosTOpenFlt, ihd_T_mosT, sfmc_T_disChrgMosTOverThrFlt2, sfmc_T_disChrgMosTOverThrRec2, 3, 3, &DiagThr.fltNum109, &DiagThr.recNum109, &sfmd_flg_disChrgMosTOverFlt2);
    // 110 放电Mos温度过高1级故障
    sfmd_flg_disChrgMosTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && disChrgFlg && sfmd_flg_chrgMosTRatFlt && sfmd_flg_chrgMosTOpenFlt, ihd_T_mosT, sfmc_T_disChrgMosTOverThrFlt1, sfmc_T_disChrgMosTOverThrRec1, 3, 3, &DiagThr.fltNum110, &DiagThr.recNum110, &sfmd_flg_disChrgMosTOverFlt1) && !sfmd_flg_disChrgMosTOverFlt2;

    // 111 快充插头温度过高2级故障
    sfmd_flg_DCPlugTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && sfmd_flg_DCPlugTRatFlt && sfmd_flg_DCPlugTOpenFlt, ihd_T_DCPlugT, sfmc_T_DCPlugTOverThrFlt2, sfmc_T_DCPlugTOverThrRec2, 3, 3, &DiagThr.fltNum111, &DiagThr.recNum111, &sfmd_flg_DCPlugTOverFlt2);
    // 112 快充插头温度过高1级故障
    sfmd_flg_DCPlugTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && sfmd_flg_DCPlugTRatFlt && sfmd_flg_DCPlugTOpenFlt, ihd_T_DCPlugT, sfmc_T_DCPlugTOverThrFlt1, sfmc_T_DCPlugTOverThrRec1, 3, 3, &DiagThr.fltNum112, &DiagThr.recNum112, &sfmd_flg_DCPlugTOverFlt1) && !sfmd_flg_DCPlugTOverFlt2;
    // 113 慢充插头温度过高2级故障
    sfmd_flg_ACPlugTOverFlt2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && sfmd_flg_ACPlugTRatFlt && sfmd_flg_ACPlugTOpenFlt, ihd_T_ACPlugT, sfmc_T_ACPlugTOverThrFlt2, sfmc_T_ACPlugTOverThrRec2, 3, 3, &DiagThr.fltNum113, &DiagThr.recNum113, &sfmd_flg_ACPlugTOverFlt2);
    // 114 慢充插头温度过高1级故障
    sfmd_flg_ACPlugTOverFlt1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && sfmd_flg_ACPlugTRatFlt && sfmd_flg_ACPlugTOpenFlt, ihd_T_ACPlugT, sfmc_T_ACPlugTOverThrFlt1, sfmc_T_ACPlugTOverThrRec1, 3, 3, &DiagThr.fltNum114, &DiagThr.recNum114, &sfmd_flg_ACPlugTOverFlt1) && !sfmd_flg_ACPlugTOverFlt2;

    // 115 加热板温度过高2级故障
    sfmd_flg_heatPanTOverFlt2_1 = DiagThrSystem1(1, !sfmn_flg_interComFlt && sfmd_flg_heatPanT1RatFlt && sfmd_flg_heatPanT1OpenFlt, ihd_T_heatPanT1, sfmc_T_heatPanTOverThrFlt2, sfmc_T_heatPanTOverThrRec2, 3, 3, &DiagThr.fltNum115_1, &DiagThr.recNum115_1, &sfmd_flg_heatPanTOverFlt2_1);
    sfmd_flg_heatPanTOverFlt2_2 = DiagThrSystem1(1, !sfmn_flg_interComFlt && sfmd_flg_heatPanT2RatFlt && sfmd_flg_heatPanT2OpenFlt, ihd_T_heatPanT2, sfmc_T_heatPanTOverThrFlt2, sfmc_T_heatPanTOverThrRec2, 3, 3, &DiagThr.fltNum115_2, &DiagThr.recNum115_2, &sfmd_flg_heatPanTOverFlt2_2);
    sfmd_flg_heatPanTOverFlt2 = sfmd_flg_heatPanTOverFlt2_1 || sfmd_flg_heatPanTOverFlt2_2;
    // 116 加热板温度过高1级故障
    sfmd_flg_heatPanTOverFlt1_1 = DiagThrSystem1(0, !sfmn_flg_interComFlt && sfmd_flg_heatPanT1RatFlt && sfmd_flg_heatPanT1OpenFlt, ihd_T_heatPanT1, sfmc_T_heatPanTOverThrFlt1, sfmc_T_heatPanTOverThrRec1, 3, 3, &DiagThr.fltNum116_1, &DiagThr.recNum116_1, &sfmd_flg_heatPanTOverFlt1_1) && !sfmd_flg_heatPanTOverFlt2;
    sfmd_flg_heatPanTOverFlt1_2 = DiagThrSystem1(0, !sfmn_flg_interComFlt && sfmd_flg_heatPanT2RatFlt && sfmd_flg_heatPanT2OpenFlt, ihd_T_heatPanT2, sfmc_T_heatPanTOverThrFlt1, sfmc_T_heatPanTOverThrRec1, 3, 3, &DiagThr.fltNum116_2, &DiagThr.recNum116_2, &sfmd_flg_heatPanTOverFlt1_2) && !sfmd_flg_heatPanTOverFlt2;
    sfmd_flg_heatPanTOverFlt1 = sfmd_flg_heatPanTOverFlt1_1 || sfmd_flg_heatPanTOverFlt1_2;

    sfmd_I_curr = ihd_I_curr;
    sfmn_I_currAbs = (uint16_T)(sfmd_I_curr > 0 ? sfmd_I_curr : -sfmd_I_curr);
    // 131 充电电流过高
    sfmd_flg_chrgCurrOverFlt = DiagThrSystem1(1, !sfmn_flg_interComFlt && chrgFlg && !sfmd_flg_currOpenFlt, sfmn_I_currAbs, sfmc_I_chrgCurrOverThr, sfmc_I_chrgCurrOverThr, 2, 2, &DiagThr.fltNum131, &DiagThr.recNum131, &sfmd_flg_chrgCurrOverFlt);
    // 132 放电电流过高
    sfmd_flg_disChrgCurrOverFlt = DiagThrSystem1(1, !sfmn_flg_interComFlt && disChrgFlg && !sfmd_flg_currOpenFlt, sfmn_I_currAbs, sfmc_I_disChrgCurrOverThr, sfmc_I_disChrgCurrOverThr, 2, 2, &DiagThr.fltNum132, &DiagThr.recNum132, &sfmd_flg_disChrgCurrOverFlt);

    // 151 充电过流故障不匹配
    sfmd_flg_chrgCurrOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_chrgCurrOverFlt != ihd_flg_chrgCurrOverFlt, &DiagTime.N151, 2);
    // 152 放电过流故障不匹配
    sfmd_flg_disChrgCurrOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_disChrgCurrOverFlt != ihd_flg_disChrgCurrOverFlt, &DiagTime.N152, 2);
    // 153 总压欠压不匹配
    sfmd_flg_battULowMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_battULowFlt2 != ihd_flg_battULowFlt, &DiagTime.N153, 2);
    // 154 总压过压不匹配
    sfmd_flg_battUOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_battUOverFlt2 != ihd_flg_battUOverFlt, &DiagTime.N154, 2);

    // 155 单体欠压故障不匹配
    sfmd_flg_cellULowMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_cellULowFlt2 != ihd_flg_cellULowFlt, &DiagTime.N155, 2);
    // 156 单体过压故障不匹配
    sfmd_flg_cellUOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_cellUOverFlt2 != ihd_flg_cellUOverFlt, &DiagTime.N156, 2);

    // 157 充电模组过温故障不匹配
    sfmd_flg_chrgModTOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_chrgModTOverFlt2 != ihd_flg_chrgModTOverFlt, &DiagTime.N157, 2);
    // 158 充电模组低温故障不匹配
    sfmd_flg_chrgModTLowMisFlt = JudgeTimeSystem(0 && !sfmn_flg_interComFlt, sfmd_flg_chrgModTLowFlt2 != ihd_flg_chrgModTLowFlt, &DiagTime.N158, 2);
    // 159 放电模组过温故障不匹配
    sfmd_flg_disChrgModTOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_disChrgModTOverFlt2 != ihd_flg_disChrgModTOverFlt, &DiagTime.N159, 2);
    // 160 放电模组低温故障不匹配
    sfmd_flg_disChrgModTLowMisFlt = JudgeTimeSystem(0 && !sfmn_flg_interComFlt, sfmd_flg_disChrgModTLowFlt2 != ihd_flg_disChrgModTLowFlt, &DiagTime.N160, 2);

    // 161 充电Mos过温故障不匹配
    sfmd_flg_chrgMosTOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_chrgMosTOverFlt2 != ihd_flg_chrgMosTOverFlt, &DiagTime.N161, 2);
    // 162 放电Mos过温故障不匹配
    sfmd_flg_disChrgMosTOverMisFlt = JudgeTimeSystem(!sfmn_flg_interComFlt, sfmd_flg_disChrgMosTOverFlt2 != ihd_flg_disChrgMosTOverFlt, &DiagTime.N162, 2);

    // 163 soc不匹配
    sfmd_flg_socMisFlt = 0 && !sfmd_flg_firstRun && (!sfmn_flg_interComFlt) && ((int16_T)(socd_pct_vcuSoc - ihd_pct_soc) > 100 || (int16_T)(socd_pct_vcuSoc - ihd_pct_soc) < -100);
    // 164 SOH 不匹配
    sfmd_flg_sohMisFlt = 0 && !sfmd_flg_firstRun && (!sfmn_flg_interComFlt) && ((int16_T)(sohd_pct_bcuSoh - ihd_pct_soh) > 50 || (int16_T)(sohd_pct_bcuSoh - ihd_pct_soh) < -50);

    // 178
    sfmd_flg_deltRFlt = false;
    if (!sfmn_flg_interComFlt)
    {
        SumR = 0;
        SumRR = 0;
        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if (!cdmv_flg_inval[i])
            {
                SumR = SumR + cdmv_R_deltOhm[i];
                SumRR = SumRR + cdmv_R_deltOhm[i] * cdmv_R_deltOhm[i];
            }
        }

        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if (!cdmv_flg_inval[i] && (cdmv_R_deltOhm[i] - SumR / cmnc_num_cellUNum) / (sqrt(SumRR / cmnc_num_cellUNum)) > 3 && (cdmv_R_deltOhm[i] - SumR / cmnc_num_cellUNum) > 500)
            {
                deltRFltNr[i] = (deltRFltNr[i] + 1) > 200 ? 200 : (deltRFltNr[i] + 1);
            }
            else
            {
                deltRFltNr[i] = 0;
            }
        }

        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if (deltRFltNr[i] > 60)
            {
                sfmd_flg_deltRFlt = true;
            }
        }
    }

    // 179 soc跳变
    sfmd_flg_socJumpFlt = ((int16_T)(socd_pct_bcuSoc - sfmn_pct_bcuSoc_Delay) > 50 || (int16_T)(socd_pct_bcuSoc - sfmn_pct_bcuSoc_Delay) < -50) && JudgeTimeSystem(1, 1, &DiagTime.N179, 2);
    sfmn_pct_bcuSoc_Delay = socd_pct_bcuSoc;
    // 180 EE失效
    sfmd_flg_EEsaveFlt = ihd_flg_EESaveFlt;

    // 21 热失控故障
    if (sfmd_I_curr > -2 && (sfmd_I_curr_Delay - sfmd_I_curr) > -2 && (sfmd_I_curr_Delay - sfmd_I_curr) < 2)
    {
        noDisChrgCnt = (noDisChrgCnt + 1) > 200 ? 200 : (noDisChrgCnt + 1);
    }
    else
    {
        noDisChrgCnt = 0;
    }
    sfmd_I_curr_Delay = sfmd_I_curr;

    if (noDisChrgCnt > 60)
    {
        for (i = 0; i < cmnc_num_cellUNum; i++)
        {
            if ((int16_T)(CellUArry[3][i] - CellUArry[0][i]) < -100)
            {
                sfmn_flg_Udrop = true;
            }
        }
        if (sfmd_flg_heatclear)
        {
            sfmn_flg_Udrop = false;
        }
    }
    ////
    if (sfmd_flg_volFlt)
    {
        sfmn_flg_volFlt_keep = true;
    }
    if (sfmd_flg_heatclear)
    {
        sfmn_flg_volFlt_keep = false;
    }
    //
    CntA = CntA + 1;
    if (CntA >= 0)
    {
        CntA = 0;
        for (j = 0; j < 4 && sfmd_flg_firstRun; j++)
        {
            for (i = 0; i < cmnc_num_modTNum; i++)
            {
                ModTStor[j][i] = sfmv_T_modT[i];
            }
        }
        for (j = 0; j < 3; j++)
        {
            for (i = 0; i < cmnc_num_modTNum; i++)
            {
                ModTStor[j][i] = ModTStor[j + 1][i];
            }
        }
        for (i = 0; i < cmnc_num_modTNum; i++)
        {
            ModTStor[j][i] = sfmv_T_modT[i];
        }
        for (i = 0; i < cmnc_num_modTNum; i++)
        {
            if ((int16_T)(ModTStor[3][i] - ModTStor[2][i]) > 2 && (int16_T)(ModTStor[2][i] - ModTStor[1][i]) > 2 && (int16_T)(ModTStor[1][i] - ModTStor[0][i]) > 2)
            {
                sfmn_flg_Tup = true;
            }
        }
        if (sfmd_flg_heatclear)
        {
            sfmn_flg_Tup = false;
        }
    }

    //
    if (sfmd_flg_modTOpenFlt)
    {
        sfmn_flg_modTOpenFlt_keep = true;
    }
    if (sfmd_flg_heatclear)
    {
        sfmn_flg_modTOpenFlt_keep = false;
    }
    //////
    if (sfmn_flg_Udrop || sfmn_flg_volFlt_keep || sfmn_flg_Tup || sfmn_flg_modTOpenFlt_keep)
    {
        CntB = (CntB + 1) > 200 ? 200 : (CntB + 1);
    }
    if ((((sfmn_flg_Udrop && sfmn_flg_Tup) || (sfmn_flg_Udrop && sfmn_flg_modTOpenFlt_keep) || (sfmn_flg_volFlt_keep && sfmn_flg_Tup)) && CntB <= 180) || sfmd_flg_heatRunFltEi)
    {
        sfmd_flg_heatRunFltEo = true;
    }
    if (!sfmd_flg_heatRunFltEo && CntB > 180)
    {
        sfmd_flg_heatclear = true;
        CntB = 0;
    }
    else
    {
        sfmd_flg_heatclear = false;
    }

    ////32 加热回路常闭故障
    if (!sfmd_flg_modTAllFlt)
    {
        if (sfmd_flg_firstRun)
        {
            for (i = 0; i < 10; i++)
            {
                modTMaxArr[i] = sfmd_T_modTMax;
            }
            Time0Cnt = 0;
            SumT0 = 0;
        }
        Time0Cnt++;
        SumT0 = SumT0 + sfmd_T_modTMax;
        if (Time0Cnt >= 60)
        {
            for (i = 0; i < 9; i++)
            {
                modTMaxArr[i] = modTMaxArr[i + 1];
            }
            modTMaxArr[9] = SumT0 / Time0Cnt;
            Time0Cnt = 0;
            SumT0 = 0;
        }
    }

    if (!sfmd_flg_heatPanT1OpenFlt && !sfmd_flg_heatPanT1RatFlt && (int16_T)(ihd_T_heatPanT1 - sfmn_T_heatPanT1_Delay1) > -10 && (int16_T)(ihd_T_heatPanT1 - sfmn_T_heatPanT1_Delay1) < 20)
    {
        if (sfmd_flg_firstRun)
        {
            for (i = 0; i < 10; i++)
            {
                heatT1Arr[i] = ihd_T_heatPanT1;
            }
            Time1Cnt = 0;
            SumT1 = 0;
        }
        Time1Cnt++;
        SumT1 = SumT1 + ihd_T_heatPanT1;
        if (Time1Cnt >= 60)
        {
            for (i = 0; i < 9; i++)
            {
                heatT1Arr[i] = heatT1Arr[i + 1];
            }
            heatT1Arr[9] = SumT1 / Time1Cnt;
            Time1Cnt = 0;
            SumT1 = 0;
        }
    }
    sfmn_T_heatPanT1_Delay1 = ihd_T_heatPanT1;

    if (!sfmd_flg_heatPanT2OpenFlt && !sfmd_flg_heatPanT2RatFlt && (int16_T)(ihd_T_heatPanT2 - sfmn_T_heatPanT2_Delay1) > -10 && (int16_T)(ihd_T_heatPanT2 - sfmn_T_heatPanT2_Delay1) < 20)
    {
        if (sfmd_flg_firstRun)
        {
            for (i = 0; i < 10; i++)
            {
                heatT2Arr[i] = ihd_T_heatPanT2;
            }
            Time2Cnt = 0;
            SumT2 = 0;
        }
        Time2Cnt++;
        SumT2 = SumT2 + ihd_T_heatPanT2;
        if (Time2Cnt >= 60)
        {
            for (i = 0; i < 9; i++)
            {
                heatT2Arr[i] = heatT2Arr[i + 1];
            }
            heatT2Arr[9] = SumT2 / Time2Cnt;
            Time2Cnt = 0;
            SumT2 = 0;
        }
    }
    sfmn_T_heatPanT2_Delay1 = ihd_T_heatPanT2;

    // 32 加热回路常闭故障
    Enable1 = JudgeTimeSystem(1, tmsd_st_heatAct == 0, &DiagTime.N32, 600);
    sfmd_flg_heatCirClosFltEo = (((int16_T)(heatT2Arr[9] - heatT2Arr[0]) > 5 || (int16_T)(heatT1Arr[9] - heatT1Arr[0]) > 5) && (modTMaxArr[9] > modTMaxArr[0] + 4) && Enable1) || sfmd_flg_heatCirClosFltEo || sfmd_flg_heatCirClosFltEi;

    // 33 加热回路常开故障
    Enable2 = JudgeTimeSystem(1, tmsd_st_heatAct == 1, &DiagTime.N33, 600);
    Enable2 = (DiagTime.N33 == 600);
    sfmd_flg_heatCirOpenFltEo = (((int16_T)(heatT2Arr[9] - heatT2Arr[0]) < 5 && (int16_T)(heatT1Arr[9] - heatT1Arr[0]) < 5) && (modTMaxArr[9] < modTMaxArr[0] + 4) && Enable2) || sfmd_flg_heatCirOpenFltEo || sfmd_flg_heatCirOpenFltEi;

    //================================================================================================================================================================
    //================================================================================================================================================================
    //===========故障码                                  故障等级                           禁止状态===================================================================
    //================================================================================================================================================================
    memset(FltFlg, 0, sizeof(FltFlg));
    memset(FltLevel, 0, sizeof(FltLevel));
    memset(FltAct, 0, sizeof(FltAct));

    FltFlg[0] = sfmn_flg_interComFlt;
    FltLevel[0] = 2;
    FltAct[0] = 2; // 1 内网通讯故障

    FltFlg[1] = 0;
    FltLevel[1] = 0;
    FltAct[1] = 0; // 2 外部通讯故障

    FltFlg[2] = 0;
    FltLevel[2] = 0;
    FltAct[2] = 0; // 3 通讯模块故障

    FltFlg[3] = 0;
    FltLevel[3] = 0;
    FltAct[3] = 0; // 4 通讯天线故障

    FltFlg[4] = sfmn_flg_authFlt;
    FltLevel[4] = 4;
    FltAct[4] = 34; // 5 认证失败

    FltFlg[5] = 0;
    FltLevel[5] = 0;
    FltAct[5] = 0; // 6 预留#5

    FltFlg[6] = 0;
    FltLevel[6] = 0;
    FltAct[6] = 0; // 7 预留#4

    FltFlg[7] = 0;
    FltLevel[7] = 0;
    FltAct[7] = 0; // 8 预留#3

    FltFlg[8] = 0;
    FltLevel[8] = 0;
    FltAct[8] = 0; // 9  预留#2

    FltFlg[9] = 0;
    FltLevel[9] = 0;
    FltAct[9] = 0; // 10 预留#1

    FltFlg[10] = sfmn_flg_HVILFlt;
    FltLevel[10] = 0;
    FltAct[10] = 0; // 11 高压互锁

    FltFlg[11] = 0;
    FltLevel[11] = 0;
    FltAct[11] = 0; // 12 硬件短路保护

    FltFlg[12] = 0;
    FltLevel[12] = 0;
    FltAct[12] = 0; // 13 绝缘模块故障

    FltFlg[13] = 0;
    FltLevel[13] = 0;
    FltAct[13] = 0; // 14 绝缘故障

    FltFlg[14] = 0;
    FltLevel[14] = 0;
    FltAct[14] = 0; // 15 绝缘告警

    FltFlg[15] = sfmd_flg_iscFltEo;
    FltLevel[15] = 4;
    FltAct[15] = 250; // 16

    FltFlg[16] = 0;
    FltLevel[16] = 0;
    FltAct[16] = 0; // 17 预留4

    FltFlg[17] = 0;
    FltLevel[17] = 0;
    FltAct[17] = 0; // 18 预留3

    FltFlg[18] = 0;
    FltLevel[18] = 0;
    FltAct[18] = 0; // 19 预留2

    FltFlg[19] = 0;
    FltLevel[19] = 0;
    FltAct[19] = 0; // 20 预留1

    FltFlg[20] = sfmd_flg_heatRunFltEo;
    FltLevel[20] = 5;
    FltAct[20] = 255; // 21 热失控；

    FltFlg[21] = sfmn_flg_chrgMosClosFlt;
    FltLevel[21] = 4;
    FltAct[21] = 106; // 22充电MOS常闭故障

    FltFlg[22] = 0;
    FltLevel[22] = 0;
    FltAct[22] = 0; // 23充电MOS常开故障

    FltFlg[23] = sfmn_flg_disChrgMosClosFlt;
    FltLevel[23] = 4;
    FltAct[23] = 106; // 24 放电Mos常闭故障

    FltFlg[24] = 0;
    FltLevel[24] = 0;
    FltAct[24] = 0; // 25 放电Mos常开故障

    FltFlg[25] = 0;
    FltLevel[25] = 0;
    FltAct[25] = 0;

    FltFlg[26] = 0;
    FltLevel[26] = 0;
    FltAct[26] = 0;

    FltFlg[27] = 0;
    FltLevel[27] = 0;
    FltAct[27] = 0;

    FltFlg[28] = 0;
    FltLevel[28] = 0;
    FltAct[28] = 0;

    FltFlg[29] = 0;
    FltLevel[29] = 0;
    FltAct[29] = 0;

    FltFlg[30] = 0;
    FltLevel[30] = 0;
    FltAct[30] = 0;

    FltFlg[31] = sfmd_flg_heatCirClosFltEo;
    FltLevel[31] = 4;
    FltAct[31] = 250; // 32 加热回路常闭故障

    FltFlg[32] = sfmd_flg_heatCirOpenFltEo;
    FltLevel[32] = 1;
    FltAct[32] = 0; // 33 加热回路常开故障

    FltFlg[33] = sfmd_flg_mainCirClosFltEo;
    FltLevel[33] = 4;
    FltAct[33] = 250; // 34 主回路常闭故障

    FltFlg[34] = 0;
    FltLevel[34] = 0;
    FltAct[34] = 0;

    FltFlg[35] = 0;
    FltLevel[35] = 0;
    FltAct[35] = 0;

    FltFlg[36] = 0;
    FltLevel[36] = 0;
    FltAct[36] = 0;

    FltFlg[37] = 0;
    FltLevel[37] = 0;
    FltAct[37] = 0;

    FltFlg[38] = 0;
    FltLevel[38] = 0;
    FltAct[38] = 0;

    FltFlg[39] = 0;
    FltLevel[39] = 0;
    FltAct[39] = 0;

    FltFlg[40] = 0;
    FltLevel[40] = 0;
    FltAct[40] = 0;

    FltFlg[41] = 0;
    FltLevel[41] = 0;
    FltAct[41] = 0;

    FltFlg[42] = 0;
    FltLevel[42] = 0;
    FltAct[42] = 0;

    FltFlg[43] = 0;
    FltLevel[43] = 0;
    FltAct[43] = 0;

    FltFlg[44] = 0;
    FltLevel[44] = 0;
    FltAct[44] = 0;

    FltFlg[45] = 0;
    FltLevel[45] = 0;
    FltAct[45] = 0;

    FltFlg[46] = 0;
    FltLevel[46] = 0;
    FltAct[46] = 0;

    FltFlg[47] = 0;
    FltLevel[47] = 0;
    FltAct[47] = 0;

    FltFlg[48] = 0;
    FltLevel[48] = 0;
    FltAct[48] = 0;

    FltFlg[49] = 0;
    FltLevel[49] = 0;
    FltAct[49] = 0;

    FltFlg[50] = 0;
    FltLevel[50] = 0;
    FltAct[50] = 0; // 51均衡失效（合一） 暂缺

    FltFlg[51] = sfmd_flg_volFlt;
    FltLevel[51] = 4;
    FltAct[51] = 234; // 52电压开路故障（合一）

    FltFlg[52] = sfmd_flg_modTOpenFlt;
    FltLevel[52] = 2;
    FltAct[52] = 2; // 53温度开路故障（合一）

    FltFlg[53] = sfmd_flg_chrgMosTOpenFlt;
    FltLevel[53] = 2;
    FltAct[53] = 130; // 54 Mos温度开路故障

    FltFlg[54] = 0;
    FltLevel[54] = 0;
    FltAct[54] = 0;

    FltFlg[55] = sfmd_flg_DCPlugTOpenFlt;
    FltLevel[55] = 2;
    FltAct[55] = 2; // 56 快充插头温度开路故障

    FltFlg[56] = sfmd_flg_ACPlugTOpenFlt;
    FltLevel[56] = 2;
    FltAct[56] = 2; // 57  慢充插头温度开路故障

    FltFlg[57] = sfmd_flg_heatPanT1OpenFlt;
    FltLevel[57] = 2;
    FltAct[57] = 2; // 58加热板#1温度开路故障

    FltFlg[58] = sfmd_flg_heatPanT2OpenFlt;
    FltLevel[58] = 2;
    FltAct[58] = 2; // 59加热板#2温度开路故障

    FltFlg[59] = 0;
    FltLevel[59] = 0;
    FltAct[59] = 0;

    FltFlg[60] = sfmd_flg_modTRatFlt;
    FltLevel[60] = 2;
    FltAct[60] = 2; // 61模组温度合理性故障

    FltFlg[61] = sfmd_flg_chrgMosTRatFlt;
    FltLevel[61] = 2;
    FltAct[61] = 130; // 62mos温度合理性故障

    FltFlg[62] = 0;
    FltLevel[62] = 0;
    FltAct[62] = 0;

    FltFlg[63] = sfmd_flg_DCPlugTRatFlt;
    FltLevel[63] = 2;
    FltAct[63] = 2; // 64快充插头温度合理性故障

    FltFlg[64] = sfmd_flg_ACPlugTRatFlt;
    FltLevel[64] = 2;
    FltAct[64] = 2; // 65慢充插头温度合理性故障

    FltFlg[65] = sfmd_flg_heatPanT1RatFlt;
    FltLevel[65] = 2;
    FltAct[65] = 2; // 66加热板#1温度合理性故障

    FltFlg[66] = sfmd_flg_heatPanT2RatFlt;
    FltLevel[66] = 2;
    FltAct[66] = 2; // 67加热板#2温度合理性故障

    FltFlg[67] = sfmd_flg_modTAllFlt;
    FltLevel[67] = 4;
    FltAct[67] = 250; // 模组温度全不可信

    FltFlg[68] = sfmd_flg_heatPanTAllFlt;
    FltLevel[68] = 3;
    FltAct[68] = 18; // 加热板温度全不可信

    FltFlg[69] = 0;
    FltLevel[69] = 0;
    FltAct[69] = 0;

    FltFlg[70] = 0;
    FltLevel[70] = 0;
    FltAct[70] = 0; // 71 电流传感器故障 暂缺

    FltFlg[71] = 0;
    FltLevel[71] = 0;
    FltAct[71] = 0;

    FltFlg[72] = 0;
    FltLevel[72] = 0;
    FltAct[72] = 0;

    FltFlg[73] = 0;
    FltLevel[73] = 0;
    FltAct[73] = 0;

    FltFlg[74] = 0;
    FltLevel[74] = 0;
    FltAct[74] = 0;

    FltFlg[75] = 0;
    FltLevel[75] = 0;
    FltAct[75] = 0;

    FltFlg[76] = 0;
    FltLevel[76] = 0;
    FltAct[76] = 0;

    FltFlg[77] = 0;
    FltLevel[77] = 0;
    FltAct[77] = 0;

    FltFlg[78] = 0;
    FltLevel[78] = 0;
    FltAct[78] = 0;

    FltFlg[79] = 0;
    FltLevel[79] = 0;
    FltAct[79] = 0;

    FltFlg[80] = sfmd_flg_cellUOverFlt2;
    FltLevel[80] = 4;
    FltAct[80] = 66; // 81单体过压2级故障

    FltFlg[81] = sfmd_flg_cellUOverFlt1;
    FltLevel[81] = 4;
    FltAct[81] = 66; // 82单体过压1级故障

    FltFlg[82] = sfmd_flg_cellULowFlt2;
    FltLevel[82] = 4;
    FltAct[82] = 162; // 83单体欠压2级故障

    FltFlg[83] = sfmd_flg_cellULowFlt1;
    FltLevel[83] = 3;
    FltAct[83] = 131; // 84单体欠压1级故障

    FltFlg[84] = sfmd_flg_cellUDiffFlt2;
    FltLevel[84] = 3;
    FltAct[84] = 3; // 85压差过大2级故障

    FltFlg[85] = sfmd_flg_cellUDiffFlt1;
    FltLevel[85] = 2;
    FltAct[85] = 2; // 86压差过大1级故障

    FltFlg[86] = sfmd_flg_battUOverFlt2;
    FltLevel[86] = 4;
    FltAct[86] = 66; // 87总压过压2级故障

    FltFlg[87] = sfmd_flg_battUOverFlt1;
    FltLevel[87] = 4;
    FltAct[87] = 66; // 88总压过压1级故障

    FltFlg[88] = sfmd_flg_battULowFlt2;
    FltLevel[88] = 4;
    FltAct[88] = 162; // 89总压欠压2级故障

    FltFlg[89] = sfmd_flg_battULowFlt1;
    FltLevel[89] = 3;
    FltAct[89] = 131; // 90总压欠压1级故障

    FltFlg[90] = 0;
    FltLevel[90] = 0;
    FltAct[90] = 0;

    FltFlg[91] = 0;
    FltLevel[91] = 0;
    FltAct[91] = 0;

    FltFlg[92] = 0;
    FltLevel[92] = 0;
    FltAct[92] = 0;

    FltFlg[93] = 0;
    FltLevel[93] = 0;
    FltAct[93] = 0;

    FltFlg[94] = 0;
    FltLevel[94] = 0;
    FltAct[94] = 0;

    FltFlg[95] = 0;
    FltLevel[95] = 0;
    FltAct[95] = 0;

    FltFlg[96] = sfmd_flg_chrgModTOverFlt2;
    FltLevel[96] = 4;
    FltAct[96] = 250; // 97模组充电温度过高2级故障

    FltFlg[97] = sfmd_flg_chrgModTOverFlt1;
    FltLevel[97] = 3;
    FltAct[97] = 145; // 98模组充电温度过高1级故障

    FltFlg[98] = sfmd_flg_chrgModTLowFlt2;
    FltLevel[98] = 0;
    FltAct[98] = 0; // 99模组充电温度过低2级故障   =======

    FltFlg[99] = sfmd_flg_chrgModTLowFlt1;
    FltLevel[99] = 0;
    FltAct[99] = 0; // 100模组充电温度过低1级故障  =======

    FltFlg[100] = sfmd_flg_disChrgModTOverFlt2;
    FltLevel[100] = 4;
    FltAct[100] = 250; // 101模组充电温度过高2级故障

    FltFlg[101] = sfmd_flg_disChrgModTOverFlt1;
    FltLevel[101] = 3;
    FltAct[101] = 145; // 102模组充电温度过高1级故障

    FltFlg[102] = sfmd_flg_disChrgModTLowFlt2;
    FltLevel[102] = 0;
    FltAct[102] = 0; // 103模组充电温度过低2级故障  ==========

    FltFlg[103] = sfmd_flg_disChrgModTLowFlt1;
    FltLevel[103] = 0;
    FltAct[103] = 0; // 104模组充电温度过低1级故障  ==========

    FltFlg[104] = sfmd_flg_modTDiffFlt2;
    FltLevel[104] = 3;
    FltAct[104] = 19; // 105模组温差过大2级故障

    FltFlg[105] = sfmd_flg_modTDiffFlt1;
    FltLevel[105] = 1;
    FltAct[105] = 0; // 106模组温差过大1级故障

    FltFlg[106] = sfmd_flg_chrgMosTOverFlt2;
    FltLevel[106] = 4;
    FltAct[106] = 250; // 107 充电Mos温度过高2级故障

    FltFlg[107] = sfmd_flg_chrgMosTOverFlt1;
    FltLevel[107] = 3;
    FltAct[107] = 19; // 108 充电Mos温度过高1级故障

    FltFlg[108] = sfmd_flg_disChrgMosTOverFlt2;
    FltLevel[108] = 4;
    FltAct[108] = 250; // 109 放电Mos温度过高2级故障

    FltFlg[109] = sfmd_flg_disChrgMosTOverFlt1;
    FltLevel[109] = 3;
    FltAct[109] = 19; // 110 放电Mos温度过高1级故障

    FltFlg[110] = sfmd_flg_DCPlugTOverFlt2;
    FltLevel[110] = 1;
    FltAct[110] = 0; // 111 快充插头温度过高2级故障

    FltFlg[111] = sfmd_flg_DCPlugTOverFlt1;
    FltLevel[111] = 1;
    FltAct[111] = 0; // 112 快充插头温度过高1级故障

    FltFlg[112] = sfmd_flg_ACPlugTOverFlt1;
    FltLevel[112] = 1;
    FltAct[112] = 0; // 113 慢充插头温度过高2级故障

    FltFlg[113] = sfmd_flg_ACPlugTOverFlt1;
    FltLevel[113] = 1;
    FltAct[113] = 0; // 114 慢充插头温度过高1级故障

    FltFlg[114] = sfmd_flg_heatPanTOverFlt2;
    FltLevel[114] = 3;
    FltAct[114] = 18; // 115 加热板温度过高2级故障

    FltFlg[115] = sfmd_flg_heatPanTOverFlt1;
    FltLevel[115] = 1;
    FltAct[115] = 0; // 116 加热板温度过高1级故障

    FltFlg[116] = 0;
    FltLevel[116] = 0;
    FltAct[116] = 0;

    FltFlg[117] = 0;
    FltLevel[117] = 0;
    FltAct[117] = 0;

    FltFlg[118] = 0;
    FltLevel[118] = 0;
    FltAct[118] = 0;

    FltFlg[119] = 0;
    FltLevel[119] = 0;
    FltAct[119] = 0;

    FltFlg[120] = 0;
    FltLevel[120] = 0;
    FltAct[120] = 0;

    FltFlg[121] = 0;
    FltLevel[121] = 0;
    FltAct[121] = 0;

    FltFlg[122] = 0;
    FltLevel[122] = 0;
    FltAct[122] = 0;

    FltFlg[123] = 0;
    FltLevel[123] = 0;
    FltAct[123] = 0;

    FltFlg[124] = 0;
    FltLevel[124] = 0;
    FltAct[124] = 0;

    FltFlg[125] = 0;
    FltLevel[125] = 0;
    FltAct[125] = 0;

    FltFlg[126] = 0;
    FltLevel[126] = 0;
    FltAct[126] = 0;

    FltFlg[127] = 0;
    FltLevel[127] = 0;
    FltAct[127] = 0;

    FltFlg[128] = 0;
    FltLevel[128] = 0;
    FltAct[128] = 0;

    FltFlg[129] = 0;
    FltLevel[129] = 0;
    FltAct[129] = 0;

    FltFlg[130] = sfmd_flg_chrgCurrOverFlt;
    FltLevel[130] = 4;
    FltAct[130] = 66; // 131 充电电流过高

    FltFlg[131] = sfmd_flg_disChrgCurrOverFlt;
    FltLevel[131] = 4;
    FltAct[131] = 34; // 132 放电电流过高

    FltFlg[132] = 0;
    FltLevel[132] = 0;
    FltAct[132] = 0;

    FltFlg[133] = 0;
    FltLevel[133] = 0;
    FltAct[133] = 0;

    FltFlg[134] = 0;
    FltLevel[134] = 0;
    FltAct[134] = 0;

    FltFlg[135] = 0;
    FltLevel[135] = 0;
    FltAct[135] = 0;

    FltFlg[136] = 0;
    FltLevel[136] = 0;
    FltAct[136] = 0;

    FltFlg[137] = 0;
    FltLevel[137] = 0;
    FltAct[137] = 0;

    FltFlg[138] = 0;
    FltLevel[138] = 0;
    FltAct[138] = 0;

    FltFlg[139] = 0;
    FltLevel[139] = 0;
    FltAct[139] = 0;

    FltFlg[140] = 0;
    FltLevel[140] = 0;
    FltAct[140] = 0;

    FltFlg[141] = 0;
    FltLevel[141] = 0;
    FltAct[141] = 0;

    FltFlg[142] = 0;
    FltLevel[142] = 0;
    FltAct[142] = 0;

    FltFlg[143] = 0;
    FltLevel[143] = 0;
    FltAct[143] = 0;

    FltFlg[144] = 0;
    FltLevel[144] = 0;
    FltAct[144] = 0;

    FltFlg[145] = 0;
    FltLevel[145] = 0;
    FltAct[145] = 0;

    FltFlg[146] = 0;
    FltLevel[146] = 0;
    FltAct[146] = 0;

    FltFlg[147] = 0;
    FltLevel[147] = 0;
    FltAct[147] = 0;

    FltFlg[148] = 0;
    FltLevel[148] = 0;
    FltAct[148] = 0;

    FltFlg[149] = 0;
    FltLevel[149] = 0;
    FltAct[149] = 0;

    FltFlg[150] = sfmd_flg_chrgCurrOverMisFlt;
    FltLevel[150] = 1;
    FltAct[150] = 0; // 151 充电过流故障不匹配

    FltFlg[151] = sfmd_flg_disChrgCurrOverMisFlt;
    FltLevel[151] = 1;
    FltAct[151] = 0; // 152 放电过流故障不匹配

    FltFlg[152] = sfmd_flg_battULowMisFlt;
    FltLevel[152] = 1;
    FltAct[152] = 0; // 153 总压欠压不匹配

    FltFlg[153] = sfmd_flg_battUOverMisFlt;
    FltLevel[153] = 1;
    FltAct[153] = 0; // 154 总压过压不匹配

    FltFlg[154] = sfmd_flg_cellULowMisFlt;
    FltLevel[154] = 1;
    FltAct[154] = 0; // 155 单体欠压故障不匹配

    FltFlg[155] = sfmd_flg_cellUOverMisFlt;
    FltLevel[155] = 1;
    FltAct[155] = 0; // 156 单体过压故障不匹配

    FltFlg[156] = sfmd_flg_chrgModTOverMisFlt;
    FltLevel[156] = 1;
    FltAct[156] = 0; // 157 充电模组过温故障不匹配

    FltFlg[157] = sfmd_flg_chrgModTLowMisFlt;
    FltLevel[157] = 1;
    FltAct[157] = 0; // 158 充电模组低温故障不匹配

    FltFlg[158] = sfmd_flg_disChrgModTOverMisFlt;
    FltLevel[158] = 1;
    FltAct[158] = 0; // 159 放电模组过温故障不匹配

    FltFlg[159] = sfmd_flg_disChrgModTLowMisFlt;
    FltLevel[159] = 1;
    FltAct[159] = 0; // 160 放电模组低温故障不匹配

    FltFlg[160] = sfmd_flg_chrgMosTOverMisFlt;
    FltLevel[160] = 1;
    FltAct[160] = 0; // 161 充电Mos过温故障不匹配

    FltFlg[161] = sfmd_flg_disChrgMosTOverMisFlt;
    FltLevel[161] = 1;
    FltAct[161] = 0; // 162 放电Mos过温故障不匹配

    FltFlg[162] = sfmd_flg_socMisFlt;
    FltLevel[162] = 1;
    FltAct[162] = 0; // 163 soc不匹配

    FltFlg[163] = sfmd_flg_sohMisFlt;
    FltLevel[163] = 1;
    FltAct[163] = 0; // 164 SOH 不匹配

    FltFlg[164] = 0;
    FltLevel[164] = 0;
    FltAct[164] = 0;

    FltFlg[165] = 0;
    FltLevel[165] = 0;
    FltAct[165] = 0;

    FltFlg[166] = 0;
    FltLevel[166] = 0;
    FltAct[166] = 0;

    FltFlg[167] = 0;
    FltLevel[167] = 0;
    FltAct[167] = 0;

    FltFlg[168] = 0;
    FltLevel[168] = 0;
    FltAct[168] = 0;

    FltFlg[169] = 0;
    FltLevel[169] = 0;
    FltAct[169] = 0;

    FltFlg[170] = 0;
    FltLevel[170] = 0;
    FltAct[170] = 0;

    FltFlg[171] = 0;
    FltLevel[171] = 0;
    FltAct[171] = 0;

    FltFlg[172] = 0;
    FltLevel[172] = 0;
    FltAct[172] = 0;

    FltFlg[173] = 0;
    FltLevel[173] = 0;
    FltAct[173] = 0;

    FltFlg[174] = 0;
    FltLevel[174] = 0;
    FltAct[174] = 0;

    FltFlg[175] = 0;
    FltLevel[175] = 0;
    FltAct[175] = 0;

    FltFlg[176] = 0;
    FltLevel[176] = 0;
    FltAct[176] = 0;

    FltFlg[177] = sfmd_flg_deltRFlt;
    FltLevel[177] = 1;
    FltAct[177] = 0;

    FltFlg[178] = sfmd_flg_socJumpFlt;
    FltLevel[178] = 1;
    FltAct[178] = 0; // 179 soc跳变

    FltFlg[179] = sfmd_flg_EEsaveFlt;
    FltLevel[179] = 1;
    FltAct[179] = 0; // 180 EE失效

    //==========================================================================================================================================================
    memset(FltCodeArr, 0, sizeof(FltCodeArr));
    memset(FltLevelArr, 0, sizeof(FltLevelArr));
    memset(FltActArr, 0, sizeof(FltActArr));
    sfmd_num_fltNum = 0;

    for (i = 0; i < FltArrLen && sfmd_num_fltNum < FltDispArrLen; i++)
    {
        if (FltFlg[i])
        {
            FltCodeArr[sfmd_num_fltNum] = i + 1;
            FltLevelArr[sfmd_num_fltNum] = FltLevel[i];
            FltActArr[sfmd_num_fltNum] = FltAct[i];
            sfmd_num_fltNum = sfmd_num_fltNum + 1;

            if (i == 50)
            {
                for (j = 0; j < cmnc_num_cellUNum; j++)
                {

                    FltCodeArr[sfmd_num_fltNum] = 1001 + j;
                    FltLevelArr[sfmd_num_fltNum] = FltLevel[i];
                    FltActArr[sfmd_num_fltNum] = FltAct[i];
                    sfmd_num_fltNum = sfmd_num_fltNum + 1;
                }
            }
            if (i == 51)
            {
                for (j = 0; j < cmnc_num_cellUNum; j++)
                {
                    if (sfmv_flg_cellUOpenFlt[j])
                    {
                        FltCodeArr[sfmd_num_fltNum] = 2001 + j;
                        FltLevelArr[sfmd_num_fltNum] = FltLevel[i];
                        FltActArr[sfmd_num_fltNum] = FltAct[i];
                        sfmd_num_fltNum = sfmd_num_fltNum + 1;
                    }
                }
            }
            if (i == 52)
            {
                for (j = 0; j < cmnc_num_modTNum; j++)
                {
                    if (sfmv_flg_modTOpenFlt[j])
                    {

                        FltCodeArr[sfmd_num_fltNum] = 3001 + j;
                        FltLevelArr[sfmd_num_fltNum] = FltLevel[i];
                        FltActArr[sfmd_num_fltNum] = FltAct[i];
                        sfmd_num_fltNum = sfmd_num_fltNum + 1;
                    }
                }
            }
            if (i == 60)
            {
                for (j = 0; j < cmnc_num_modTNum; j++)
                {
                    if (sfmv_flg_modTRatFlt[j])
                    {
                        FltCodeArr[sfmd_num_fltNum] = 3201 + j;
                        FltLevelArr[sfmd_num_fltNum] = FltLevel[i];
                        FltActArr[sfmd_num_fltNum] = FltAct[i];
                        sfmd_num_fltNum = sfmd_num_fltNum + 1;
                    }
                }
            }
        }
    }

    memset(sfmv_idx_fltCode, 0, sizeof(sfmv_idx_fltCode));
    sfmd_st_fltAct = 0;
    sfmd_st_fltLevel = 0;
    for (i = 0; i < sfmd_num_fltNum; i++)
    {
        sfmv_idx_fltCode[i] = FltLevelArr[i] * 10000 + FltCodeArr[i];

        if (sfmd_st_fltLevel < FltLevelArr[i])
        {
            sfmd_st_fltLevel = FltLevelArr[i];
        }
        sfmd_st_fltAct = sfmd_st_fltAct | FltActArr[i];
    }

    /*
     for(i=0;i < 20;i++)
     {
         printf("%d  ",sfmv_idx_fltCode[i]);
     }
     printf("\n");
    */

    ///=====================================================================
    //======================================================================

    sfmd_flg_cellUInval = sfmn_flg_interComFlt || sfmd_flg_volFlt;
    sfmd_flg_currInval = sfmn_flg_interComFlt || sfmd_flg_currOpenFlt;
    sfmd_flg_modTInval = sfmn_flg_interComFlt || sfmd_flg_modTOpenFlt || sfmd_flg_modTRatFlt;
    sfmd_flg_firstRun = false;
}

//===============================================================================