NB_APP_Code/src/EmbeddedCoder_src/SOH.c

#include "SOH.h"
#include "look1_iu16lu16n16tu16_binlcase.h"

boolean_T FirstRun_SOH;

void SOH_Init(void)
{
    FirstRun_SOH = true ;
}

void SOH(void)
{
    uint16_T i;
    uint16_T cellCapArr_Min;
    uint16_T cellCapArr_Max;
    uint16_T packCapArr_Min;
    uint16_T packCapArr_Max;
    static uint16_T sohn_V_chrgStartStatEE[cmnc_num_cellUNumMax];
    static uint16_T sohn_Q_cellCapArrEE[cmnc_num_cellUNumMax];
    static uint16_T sohn_Q_packCapArrEE[10];
    static uint16_T sohn_Q_chrgEE;
    static uint16_T sohn_tm_chrgStartStatEE;
    static uint16_T sohn_flg_chrgEndEE;
    //
    boolean_T sohn_flg_countEn;
    uint16_T soc1[cmnc_num_cellUNumMax];
    uint16_T soc2[cmnc_num_cellUNumMax];
    uint16_T deltSoc[cmnc_num_cellUNumMax];
    uint16_T temp[cmnc_num_cellUNumMax];
    uint16_T chrgCellCapArr[cmnc_num_cellUNumMax];
    uint16_T disChrgCellCapArr[cmnc_num_cellUNumMax];
    boolean_T sohn_flg_update;
    uint16_T chrgCap_Min;
    uint16_T disChrgCap_Min;
    uint16_T SumQ;
    //
    static uint16_T sohn_V_chrgStartStat[cmnc_num_cellUNumMax];
    static uint8_T sohn_st_workStat_Delay;
    static boolean_T sohn_flg_chrgEnd_Delay;
    boolean_T sohn_flg_chrgEnd;
    //
    static real_T Ahincr;
    int32_T  tmp_0; 
    static boolean_T sfmn_flg_currFlt_keep;
    static boolean_T sohn_flg_currFlt;
    boolean_T DisEn;
    
    if(FirstRun_SOH)
    {   
        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(FirstRun_SOH)
    {
        //=======================================================================================
        //--------------------------EE校验-------------------------------------------------------
        //=======================================================================================
        cellCapArr_Min = ArrMin((&(sohv_Q_cellCapArrEi[0])) , cmnc_num_cellUNum);
        cellCapArr_Max = ArrMax((&(sohv_Q_cellCapArrEi[0])) , cmnc_num_cellUNum);
        packCapArr_Min = ArrMin((&(sohv_Q_packCapArrEi[0])) , 10);
        packCapArr_Max = ArrMax((&(sohv_Q_packCapArrEi[0])) , 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;
			}
   
            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));
            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_cellUDisable && sfmd_I_curr < 10 && sfmd_I_curr > -10)
        {
            sohn_flg_countEn = true;
        }
        else
        {
            sohn_flg_countEn = false;
        }
        test_countEn = sohn_flg_countEn;
		//=======================================================================================
        //------------------------SOH 计算-------------------------------------------------------
        //=======================================================================================
        if(sohn_flg_countEn)
        {
            sohn_flg_update = true;
            for(i = 0;i < cmnc_num_cellUNum;i++)
            {
                soc2[i] =  look1_iu16lu16n16tu16_binlcase(sfmv_V_cellU[i],(&(cmnm_V_ocv[0])), (&(cmnm_pct_soc[0])), 12U);
                soc1[i] =  look1_iu16lu16n16tu16_binlcase(sohn_V_chrgStartStatEE[i],(&(cmnm_V_ocv[0])), (&(cmnm_pct_soc[0])), 12U);
                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);
				test_cellCap[i] = sohv_Q_cellCapArrEo[i];
                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[0])) , cmnc_num_cellUNum) > sohc_pct_low &&   ArrMin((&(soc2[0])) , cmnc_num_cellUNum) < sohc_pct_up) 
                  ||(ArrMax((&(soc2[0])) , cmnc_num_cellUNum) > sohc_pct_low &&   ArrMax((&(soc2[0])) , cmnc_num_cellUNum) < sohc_pct_up)
                  ||(ArrMin((&(soc1[0])) , cmnc_num_cellUNum) > sohc_pct_low &&   ArrMin((&(soc1[0])) , cmnc_num_cellUNum) < sohc_pct_up)
                  ||(ArrMax((&(soc1[0])) , cmnc_num_cellUNum) > sohc_pct_low &&   ArrMax((&(soc1[0])) , cmnc_num_cellUNum) < sohc_pct_up);
			//===================
            if(sohn_flg_update && !DisEn)
            {   
				for(i = 0;i < cmnc_num_cellUNum;i++)
 				{
 				     temp[i] = (real_T) (soc2[i] * 0.1) /100;
                     chrgCellCapArr[i] =    (uint16_T)( (real_T)(sohv_Q_cellCapArrEo[i] * 0.1)*(1 - temp[i]) * 10);
                     disChrgCellCapArr[i] = (uint16_T)( (real_T)(sohv_Q_cellCapArrEo[i] * 0.1)*(    temp[i]) * 10);
 				} 
                 chrgCap_Min = ArrMin((&(chrgCellCapArr[0])) , cmnc_num_cellUNum);
                 disChrgCap_Min = ArrMin((&(disChrgCellCapArr[0])) , 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 (FirstRun_SOH)
     {
     	memcpy(sohn_V_chrgStartStat,appv_V_cellU, sizeof(appv_V_cellU));
     }
     
     if(sfmd_I_curr < 10 && sfmd_I_curr > -10 && !sfmd_flg_cellUDisable)
     {
         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]);
    //=======================================================================================
    //----------------------充电中信息-------------------------------------------------------
    //=======================================================================================
    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_currDisable)
        {
            sfmn_flg_currFlt_keep = true;
        }
        sohn_flg_currFlt = sfmn_flg_currFlt_keep;   
    }
    else
    {
        sfmn_flg_currFlt_keep = false;
        Ahincr = 0;
    }
	//printf("sohd_Q_chrgEo:%d\n",sohd_Q_chrgEo);
	 //=======================================================================================
    //----------------------充电结速信息------------------------------------------------------
    //=======================================================================================
    if((ihd_st_workStat != 2) && (sohn_st_workStat_Delay == 2))
    {
       sohd_flg_chrgEndEo = true; 
    }
    else
    {
      sohd_flg_chrgEndEo = ( sfmd_I_curr < 10 && sfmd_I_curr > -10) && sohd_flg_chrgEndEo;
    }
    sohd_flg_chrgEndEo =  !sohn_flg_currFlt && sohd_flg_chrgEndEo;

    //
    sohn_st_workStat_Delay = ihd_st_workStat;
	FirstRun_SOH = false;	
	
}

////////////////////////////////////////////////////////////////
uint16_T  ArrMax(uint16_T *Data, uint16_T m)
{
    uint16_T i;
	uint16_T DataMax;
    DataMax = Data[0];
    for(i = 0; i < m; i++)
    {
        if (DataMax < Data[i])
        {
            DataMax = Data[i];
        }
    }
	return DataMax;
}

///////////////////////////////////////////////////////////////////
uint16_T  ArrMin(uint16_T *Data, uint16_T m)
{
    uint16_T i;
	uint16_T DataMin;
    DataMin = Data[0];
    for(i = 0; i < m; i++)
    {
        if (DataMin > Data[i])
        {
            DataMin = Data[i];
        }
    }
	return DataMin;
}