|
|
@@ -2,7 +2,7 @@
|
|
|
|
|
|
void SOH_Init(void)
|
|
|
{
|
|
|
- sohd_flg_firstRun = true ;
|
|
|
+ sohd_flg_firstRun = true;
|
|
|
}
|
|
|
|
|
|
void SOH(void)
|
|
|
@@ -35,177 +35,171 @@ void SOH(void)
|
|
|
static uint8_T sohn_st_workStat_Delay;
|
|
|
//
|
|
|
static real_T Ahincr;
|
|
|
- int16_T tmp_0;
|
|
|
+ int16_T tmp_0;
|
|
|
static boolean_T sfmn_flg_currFlt_keep;
|
|
|
static boolean_T sohn_flg_currFlt;
|
|
|
boolean_T DisEn;
|
|
|
|
|
|
-
|
|
|
- //初值
|
|
|
- if(sohd_flg_firstRun)
|
|
|
- {
|
|
|
+ //初值
|
|
|
+ if (sohd_flg_firstRun)
|
|
|
+ {
|
|
|
sohn_flg_update = true;
|
|
|
sfmn_flg_currFlt_keep = false;
|
|
|
sohn_flg_currFlt = false;
|
|
|
Ahincr = 0;
|
|
|
sohn_st_workStat_Delay = 0;
|
|
|
- if(ihd_st_reSet == 1)
|
|
|
- {
|
|
|
- memcpy(sohv_V_chrgStartStatEo,sohv_V_chrgStartStatEi, sizeof(sohv_V_chrgStartStatEo));
|
|
|
- sohd_Q_chrgEo = sohd_Q_chrgEi;
|
|
|
- sohd_flg_chrgEndEo = sohd_flg_chrgEndEi;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- memset(sohv_V_chrgStartStatEo,0, sizeof(sohv_V_chrgStartStatEo));
|
|
|
- sohd_Q_chrgEo = 0 ;
|
|
|
- sohd_flg_chrgEndEo = 0;
|
|
|
- }
|
|
|
+ if (ihd_st_reSet == 1)
|
|
|
+ {
|
|
|
+ memcpy(sohv_V_chrgStartStatEo, sohv_V_chrgStartStatEi, sizeof(sohv_V_chrgStartStatEo));
|
|
|
+ sohd_Q_chrgEo = sohd_Q_chrgEi;
|
|
|
+ sohd_flg_chrgEndEo = sohd_flg_chrgEndEi;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ memset(sohv_V_chrgStartStatEo, 0, sizeof(sohv_V_chrgStartStatEo));
|
|
|
+ sohd_Q_chrgEo = 0;
|
|
|
+ sohd_flg_chrgEndEo = 0;
|
|
|
+ }
|
|
|
}
|
|
|
-
|
|
|
|
|
|
- if(sohd_flg_firstRun)
|
|
|
+ if (sohd_flg_firstRun)
|
|
|
{
|
|
|
//=======================================================================================
|
|
|
//--------------------------EE校验-------------------------------------------------------
|
|
|
//=======================================================================================
|
|
|
- cellCapArr_Min = ArrMin(sohv_Q_cellCapArrEi , cmnc_num_cellUNum);
|
|
|
- cellCapArr_Max = ArrMax(sohv_Q_cellCapArrEi , cmnc_num_cellUNum);
|
|
|
- packCapArr_Min = ArrMin(sohv_Q_packCapArrEi , 10);
|
|
|
- packCapArr_Max = ArrMax(sohv_Q_packCapArrEi , 10);
|
|
|
- if(sohd_Q_chrgEi > cmnc_Q_ratedCp || cellCapArr_Min < 10 || cellCapArr_Max > cmnc_Q_ratedCp + 100 || packCapArr_Min < 10 || packCapArr_Max > cmnc_Q_ratedCp + 100 )
|
|
|
+ cellCapArr_Min = ArrMin(sohv_Q_cellCapArrEi, cmnc_num_cellUNum);
|
|
|
+ cellCapArr_Max = ArrMax(sohv_Q_cellCapArrEi, cmnc_num_cellUNum);
|
|
|
+ packCapArr_Min = ArrMin(sohv_Q_packCapArrEi, 10);
|
|
|
+ packCapArr_Max = ArrMax(sohv_Q_packCapArrEi, 10);
|
|
|
+ if (sohd_Q_chrgEi > cmnc_Q_ratedCp || cellCapArr_Min < 10 || cellCapArr_Max > cmnc_Q_ratedCp + 100 || packCapArr_Min < 10 || packCapArr_Max > cmnc_Q_ratedCp + 100)
|
|
|
{
|
|
|
- memset(sohn_V_chrgStartStatEE, 0 , sizeof(sohn_V_chrgStartStatEE));
|
|
|
- for(i=0 ; i < cmnc_num_cellUNum;i++)
|
|
|
- {
|
|
|
- sohn_Q_cellCapArrEE[i] = cmnc_Q_ratedCp;
|
|
|
- }
|
|
|
- for(i=0 ; i < 10;i++)
|
|
|
- {
|
|
|
- sohn_Q_packCapArrEE[i] = cmnc_Q_ratedCp;
|
|
|
- }
|
|
|
-
|
|
|
+ memset(sohn_V_chrgStartStatEE, 0, sizeof(sohn_V_chrgStartStatEE));
|
|
|
+ for (i = 0; i < cmnc_num_cellUNum; i++)
|
|
|
+ {
|
|
|
+ sohn_Q_cellCapArrEE[i] = cmnc_Q_ratedCp;
|
|
|
+ }
|
|
|
+ for (i = 0; i < 10; i++)
|
|
|
+ {
|
|
|
+ sohn_Q_packCapArrEE[i] = cmnc_Q_ratedCp;
|
|
|
+ }
|
|
|
+
|
|
|
sohn_Q_chrgEE = 0;
|
|
|
sohn_tm_chrgStartStatEE = 0;
|
|
|
sohn_flg_chrgEndEE = 0;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- memcpy(sohn_V_chrgStartStatEE,sohv_V_chrgStartStatEi, sizeof(sohv_V_chrgStartStatEi));
|
|
|
- memcpy(sohn_Q_cellCapArrEE,sohv_Q_cellCapArrEi, sizeof(sohv_Q_cellCapArrEi));
|
|
|
- memcpy(sohn_Q_packCapArrEE,sohv_Q_packCapArrEi, sizeof(sohv_Q_packCapArrEi));
|
|
|
+ memcpy(sohn_V_chrgStartStatEE, sohv_V_chrgStartStatEi, sizeof(sohv_V_chrgStartStatEi));
|
|
|
+ memcpy(sohn_Q_cellCapArrEE, sohv_Q_cellCapArrEi, sizeof(sohv_Q_cellCapArrEi));
|
|
|
+ memcpy(sohn_Q_packCapArrEE, sohv_Q_packCapArrEi, sizeof(sohv_Q_packCapArrEi));
|
|
|
sohn_Q_chrgEE = sohd_Q_chrgEi;
|
|
|
sohn_tm_chrgStartStatEE = sohd_tm_chrgStartStatEi;
|
|
|
sohn_flg_chrgEndEE = sohd_flg_chrgEndEi;
|
|
|
}
|
|
|
- //=======================================================================================
|
|
|
+ //=======================================================================================
|
|
|
//--------------------------计算使能-------------------------------------------------------
|
|
|
//=======================================================================================
|
|
|
- if(ihd_tm_parkTime >= cmnc_tm_parkTime && sohn_flg_chrgEndEE && sohn_Q_chrgEE > sohc_Q_countThr && !sfmd_flg_cellUInval && sfmd_I_curr < 10 && sfmd_I_curr > -10)
|
|
|
+ if (ihd_tm_parkTime >= cmnc_tm_parkTime && sohn_flg_chrgEndEE && sohn_Q_chrgEE > sohc_Q_countThr && !sfmd_flg_cellUInval && sfmd_I_curr < 10 && sfmd_I_curr > -10 && ArrMin(sohn_V_chrgStartStatEE, cmnc_num_cellUNum) > 3300)
|
|
|
{
|
|
|
sohn_flg_countEn = true;
|
|
|
+ sohd_flg_chrgEndEo = 0;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
sohn_flg_countEn = false;
|
|
|
}
|
|
|
-
|
|
|
- //=======================================================================================
|
|
|
+
|
|
|
+ //=======================================================================================
|
|
|
//------------------------SOH 计算-------------------------------------------------------
|
|
|
//=======================================================================================
|
|
|
- if(sohn_flg_countEn)
|
|
|
+ if (sohn_flg_countEn)
|
|
|
{
|
|
|
sohn_flg_update = true;
|
|
|
- for(i = 0;i < cmnc_num_cellUNum;i++)
|
|
|
+ for (i = 0; i < cmnc_num_cellUNum; i++)
|
|
|
{
|
|
|
- soc2[i] = look1_u16tu16(sfmv_V_cellU[i],cmnm_V_ocv, cmnm_pct_soc, 13U);
|
|
|
- soc1[i] = look1_u16tu16(sohn_V_chrgStartStatEE[i],cmnm_V_ocv, cmnm_pct_soc, 13U);
|
|
|
+ soc2[i] = look1_u16tu16(sfmv_V_cellU[i], cmnm_V_ocv, cmnm_pct_soc, 13U);
|
|
|
+ soc1[i] = look1_u16tu16(sohn_V_chrgStartStatEE[i], cmnm_V_ocv, cmnm_pct_soc, 13U);
|
|
|
deltSoc[i] = soc2[i] - soc1[i];
|
|
|
- sohv_Q_cellCapArrEo[i] = (uint16_T)( (real_T)(sohn_Q_chrgEE * 0.1) / (real_T)(deltSoc[i] * 0.1/100) * 10);
|
|
|
+ sohv_Q_cellCapArrEo[i] = (uint16_T)((real_T)(sohn_Q_chrgEE * 0.1) / (real_T)(deltSoc[i] * 0.1 / 100) * 10);
|
|
|
|
|
|
- if( (int16_T)(sohv_Q_cellCapArrEo[i]) - sohn_Q_cellCapArrEE[i] > sohc_Q_updateDeltThr || (int16_T)(sohv_Q_cellCapArrEo[i]) - sohn_Q_cellCapArrEE[i] < -sohc_Q_updateDeltThr )
|
|
|
+ if ((int16_T)(sohv_Q_cellCapArrEo[i]) - sohn_Q_cellCapArrEE[i] > sohc_Q_updateDeltThr || (int16_T)(sohv_Q_cellCapArrEo[i]) - sohn_Q_cellCapArrEE[i] < -sohc_Q_updateDeltThr)
|
|
|
{
|
|
|
sohn_flg_update = false;
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- DisEn = (ArrMin(soc2 , cmnc_num_cellUNum) > sohc_pct_low && ArrMin(soc2 , cmnc_num_cellUNum) < sohc_pct_up)
|
|
|
- ||(ArrMax(soc2 , cmnc_num_cellUNum) > sohc_pct_low && ArrMax(soc2 , cmnc_num_cellUNum) < sohc_pct_up)
|
|
|
- ||(ArrMin(soc1 , cmnc_num_cellUNum) > sohc_pct_low && ArrMin(soc1 , cmnc_num_cellUNum) < sohc_pct_up)
|
|
|
- ||(ArrMax(soc1 , cmnc_num_cellUNum) > sohc_pct_low && ArrMax(soc1 , cmnc_num_cellUNum) < sohc_pct_up);
|
|
|
- //===================
|
|
|
- if(sohn_flg_update && !DisEn)
|
|
|
- {
|
|
|
- for(i = 0;i < cmnc_num_cellUNum;i++)
|
|
|
- {
|
|
|
- chrgCellCapArr[i] = (uint16_T)((uint32_T)(sohv_Q_cellCapArrEo[i] * (1000 - soc2[i]))/1000);
|
|
|
- disChrgCellCapArr[i] = (uint16_T)((uint32_T)(sohv_Q_cellCapArrEo[i] * ( soc2[i]))/1000);
|
|
|
- }
|
|
|
- chrgCap_Min = ArrMin(chrgCellCapArr , cmnc_num_cellUNum);
|
|
|
- disChrgCap_Min = ArrMin(disChrgCellCapArr, cmnc_num_cellUNum);
|
|
|
- for(i = 0; i < 9;i++)
|
|
|
- {
|
|
|
- sohv_Q_packCapArrEo[i] = sohn_Q_packCapArrEE[i+1];
|
|
|
- }
|
|
|
- sohv_Q_packCapArrEo[9] = chrgCap_Min + disChrgCap_Min;
|
|
|
- }
|
|
|
- else //计算但结果偏差较大
|
|
|
- {
|
|
|
- memcpy(sohv_Q_packCapArrEo,sohn_Q_packCapArrEE, sizeof(sohv_Q_packCapArrEo));
|
|
|
- memcpy(sohv_Q_cellCapArrEo,sohn_Q_cellCapArrEE, sizeof(sohv_Q_cellCapArrEo));
|
|
|
- }
|
|
|
- }
|
|
|
- else // 不计算
|
|
|
- {
|
|
|
- memcpy(sohv_Q_packCapArrEo,sohn_Q_packCapArrEE, sizeof(sohv_Q_packCapArrEo));
|
|
|
- memcpy(sohv_Q_cellCapArrEo,sohn_Q_cellCapArrEE, sizeof(sohv_Q_cellCapArrEo));
|
|
|
- }
|
|
|
- memcpy(sohv_Q_cellCap,sohv_Q_cellCapArrEo, sizeof(sohv_Q_cellCapArrEo));
|
|
|
+ DisEn = (ArrMin(soc2, cmnc_num_cellUNum) > sohc_pct_low && ArrMin(soc2, cmnc_num_cellUNum) < sohc_pct_up) || (ArrMax(soc2, cmnc_num_cellUNum) > sohc_pct_low && ArrMax(soc2, cmnc_num_cellUNum) < sohc_pct_up) || (ArrMin(soc1, cmnc_num_cellUNum) > sohc_pct_low && ArrMin(soc1, cmnc_num_cellUNum) < sohc_pct_up) || (ArrMax(soc1, cmnc_num_cellUNum) > sohc_pct_low && ArrMax(soc1, cmnc_num_cellUNum) < sohc_pct_up);
|
|
|
+ //===================
|
|
|
+ if (sohn_flg_update && !DisEn)
|
|
|
+ {
|
|
|
+ for (i = 0; i < cmnc_num_cellUNum; i++)
|
|
|
+ {
|
|
|
+ chrgCellCapArr[i] = (uint16_T)((uint32_T)(sohv_Q_cellCapArrEo[i] * (1000 - soc2[i])) / 1000);
|
|
|
+ disChrgCellCapArr[i] = (uint16_T)((uint32_T)(sohv_Q_cellCapArrEo[i] * (soc2[i])) / 1000);
|
|
|
+ }
|
|
|
+ chrgCap_Min = ArrMin(chrgCellCapArr, cmnc_num_cellUNum);
|
|
|
+ disChrgCap_Min = ArrMin(disChrgCellCapArr, cmnc_num_cellUNum);
|
|
|
+ for (i = 0; i < 9; i++)
|
|
|
+ {
|
|
|
+ sohv_Q_packCapArrEo[i] = sohn_Q_packCapArrEE[i + 1];
|
|
|
+ }
|
|
|
+ sohv_Q_packCapArrEo[9] = chrgCap_Min + disChrgCap_Min;
|
|
|
+ }
|
|
|
+ else //计算但结果偏差较大
|
|
|
+ {
|
|
|
+ memcpy(sohv_Q_packCapArrEo, sohn_Q_packCapArrEE, sizeof(sohv_Q_packCapArrEo));
|
|
|
+ memcpy(sohv_Q_cellCapArrEo, sohn_Q_cellCapArrEE, sizeof(sohv_Q_cellCapArrEo));
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else // 不计算
|
|
|
+ {
|
|
|
+ memcpy(sohv_Q_packCapArrEo, sohn_Q_packCapArrEE, sizeof(sohv_Q_packCapArrEo));
|
|
|
+ memcpy(sohv_Q_cellCapArrEo, sohn_Q_cellCapArrEE, sizeof(sohv_Q_cellCapArrEo));
|
|
|
+ }
|
|
|
+ memcpy(sohv_Q_cellCap, sohv_Q_cellCapArrEo, sizeof(sohv_Q_cellCapArrEo));
|
|
|
+
|
|
|
+ SumQ = 0;
|
|
|
+ for (i = 0; i < 10; i++)
|
|
|
+ {
|
|
|
+ SumQ = SumQ + sohv_Q_packCapArrEo[i];
|
|
|
+ }
|
|
|
+ sohd_pct_bcuSoh = (uint16_T)(((real_T)(SumQ * 0.1) / 10.0 / (real_T)(cmnc_Q_ratedCp * 0.1) * 100) * 10);
|
|
|
+ sohd_pct_bcuSoh = (sohd_pct_bcuSoh > 1000 ? 1000 : sohd_pct_bcuSoh);
|
|
|
+ }
|
|
|
+
|
|
|
+ //=======================================================================================
|
|
|
+ //----------------------充电前信息-------------------------------------------------------
|
|
|
+ //=======================================================================================
|
|
|
+ if (sohd_flg_firstRun)
|
|
|
+ {
|
|
|
+ memcpy(sohn_V_chrgStartStat, appv_V_cellU, sizeof(appv_V_cellU));
|
|
|
+ }
|
|
|
|
|
|
-
|
|
|
- SumQ = 0;
|
|
|
- for(i = 0; i < 10;i++)
|
|
|
- {
|
|
|
- SumQ = SumQ + sohv_Q_packCapArrEo[i];
|
|
|
- }
|
|
|
- sohd_pct_bcuSoh = (uint16_T)(((real_T)(SumQ * 0.1)/10.0/ (real_T)(cmnc_Q_ratedCp * 0.1) * 100) * 10);
|
|
|
- sohd_pct_bcuSoh = (sohd_pct_bcuSoh > 1000 ? 1000 : sohd_pct_bcuSoh);
|
|
|
- }
|
|
|
-
|
|
|
- //=======================================================================================
|
|
|
- //----------------------充电前信息-------------------------------------------------------
|
|
|
- //=======================================================================================
|
|
|
- if (sohd_flg_firstRun)
|
|
|
- {
|
|
|
- memcpy(sohn_V_chrgStartStat,appv_V_cellU, sizeof(appv_V_cellU));
|
|
|
- }
|
|
|
-
|
|
|
- if(sfmd_I_curr < 10 && sfmd_I_curr > -10 && !sfmd_flg_cellUInval)
|
|
|
- {
|
|
|
- memcpy(sohn_V_chrgStartStat,sfmv_V_cellU, sizeof(sfmv_V_cellU));
|
|
|
- }
|
|
|
- //
|
|
|
- if((ihd_st_workStat == 2) && (sohn_st_workStat_Delay != 2))
|
|
|
- {
|
|
|
- memcpy(sohv_V_chrgStartStatEo,sohn_V_chrgStartStat, sizeof(sohv_V_chrgStartStatEo));
|
|
|
- }
|
|
|
+ if (sfmd_I_curr < 10 && sfmd_I_curr > -10 && !sfmd_flg_cellUInval)
|
|
|
+ {
|
|
|
+ memcpy(sohn_V_chrgStartStat, sfmv_V_cellU, sizeof(sfmv_V_cellU));
|
|
|
+ }
|
|
|
+ //
|
|
|
+ if ((ihd_st_workStat == 2) && (sohn_st_workStat_Delay != 2))
|
|
|
+ {
|
|
|
+ memcpy(sohv_V_chrgStartStatEo, sohn_V_chrgStartStat, sizeof(sohv_V_chrgStartStatEo));
|
|
|
+ }
|
|
|
|
|
|
-
|
|
|
- //printf("sohv_V_chrgStartStatEo[16]:%d\n",sohv_V_chrgStartStatEo[16]);
|
|
|
+ // printf("sohv_V_chrgStartStatEo[16]:%d\n",sohv_V_chrgStartStatEo[16]);
|
|
|
//=======================================================================================
|
|
|
//----------------------充电中信息-------------------------------------------------------
|
|
|
//=======================================================================================
|
|
|
- if(ihd_st_workStat == 2)
|
|
|
+ if (ihd_st_workStat == 2)
|
|
|
{
|
|
|
Ahincr = Ahincr + (real_T)sfmd_I_curr * 0.1;
|
|
|
- tmp_0 = (int16_T)(Ahincr/3600 * 10);
|
|
|
-
|
|
|
- sohd_Q_chrgEo = tmp_0 > 0 ? (uint16_T)tmp_0 : 0;
|
|
|
- if(sfmd_flg_currInval)
|
|
|
+ tmp_0 = (int16_T)(Ahincr / 3600 * 10);
|
|
|
+
|
|
|
+ sohd_Q_chrgEo = tmp_0 > 0 ? (uint16_T)tmp_0 : 0;
|
|
|
+ if (sfmd_flg_currInval)
|
|
|
{
|
|
|
sfmn_flg_currFlt_keep = true;
|
|
|
}
|
|
|
- sohn_flg_currFlt = sfmn_flg_currFlt_keep;
|
|
|
+ sohn_flg_currFlt = sfmn_flg_currFlt_keep;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
@@ -213,23 +207,20 @@ void SOH(void)
|
|
|
Ahincr = 0;
|
|
|
}
|
|
|
|
|
|
- //=======================================================================================
|
|
|
+ //=======================================================================================
|
|
|
//----------------------充电结速信息------------------------------------------------------
|
|
|
//=======================================================================================
|
|
|
- if((ihd_st_workStat != 2) && (sohn_st_workStat_Delay == 2))
|
|
|
+ if ((ihd_st_workStat != 2) && (sohn_st_workStat_Delay == 2))
|
|
|
{
|
|
|
- sohd_flg_chrgEndEo = true;
|
|
|
+ sohd_flg_chrgEndEo = true;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- sohd_flg_chrgEndEo = ( sfmd_I_curr < 10 && sfmd_I_curr > -10) && sohd_flg_chrgEndEo;
|
|
|
+ sohd_flg_chrgEndEo = (sfmd_I_curr < 10 && sfmd_I_curr > -10) && sohd_flg_chrgEndEo;
|
|
|
}
|
|
|
- sohd_flg_chrgEndEo = !sohn_flg_currFlt && sohd_flg_chrgEndEo;
|
|
|
+ sohd_flg_chrgEndEo = !sohn_flg_currFlt && sohd_flg_chrgEndEo;
|
|
|
|
|
|
//
|
|
|
sohn_st_workStat_Delay = ihd_st_workStat;
|
|
|
- sohd_flg_firstRun = false;
|
|
|
+ sohd_flg_firstRun = false;
|
|
|
}
|
|
|
-
|
|
|
-
|
|
|
-
|
