#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; } //===============================================================================