FuelProcess.c

/*
* gui_LED.c
*
*  Created on: Aug 11, 2014
*      Author: QTC
*/

#define GLOBALS_FUEL_PROCESS
#include "defines.h"
#include "g_includes.h"
#include "app_Service.h"
extern DIAG_2E_DATA Diag2eData;

/*--------------------------------------------------------------------------
* Function Name  : App_CalFuelBoard
* Description    :
* Input          : None
* Output         : None
* Return         : None
* onther         : qitiancun
--------------------------------------------------------------------------*/
void App_CalFuelBoard(void)
{
                /*	INT32U  temp2;    //江淮N721平台化24V表，
                  INT32U  temp1;
                  INT16U  RScale;
                  INT16U  TempR1;
                  INT16U  TempR2;	  
                  INT32U  VR1;
                  INT32U  VR2;
                  INT32U  g_Vcc;
                  INT32U  g_Vcpu;
                  INT32U  RL;
                  
                  TempR1 = 33;      //是PIN23脚向内接入的  33K与27K
                  TempR2 = 27;
                  
                  VR1 = 33000;      //KL15_AD  单片机15电AD采集端配置的电阻，24V表配 33欧姆与4.7欧姆
                  VR2 = 4700;
                  
                  RScale= (TempR1+TempR2)*10/TempR2;
                  temp2 = (g_adcResult.FuelEven[3] + g_adcResult.FuelEven[4] + g_adcResult.FuelEven[5])*10/3;  	
                  temp1 = (g_adcResult.BatLevel[3] + g_adcResult.BatLevel[4] + g_adcResult.BatLevel[5])*10/3;
                  temp1 = (temp1*5*(VR1+VR2))/(1024*VR2);
                  g_Vcc = temp1;
                  g_FuelVCC = g_Vcc;
                  g_Vcpu = temp2 * 5 / 1024;
                  if((g_Vcpu*RScale) < (g_Vcc*10))
                  {
                      RL = ((RScale*5*temp2)*824)/(10240*g_Vcc-(RScale*5*temp2));              //图纸上是880欧姆(2.2K6个并联，再串5个并联)，实际上是824欧姆，是PIN23脚向内接入的
                      RL = RL * 10; 
                  } 
                  
                  if(RL > 3600)
                  {
                      RL = 3600;
                  }
                  
                  g_fuelMeter.CurBoardVal = RL;    
                  */
                  
                  
                  
                  
    INT32U  temp2;           //江淮N721平台化12V表，
    INT32U  temp1;
    INT16U  RScale;
	  INT16U  TempR1;
	  INT16U  TempR2;	  
	  INT32U  VR1;
	  INT32U  VR2;
    INT32U  g_Vcc;
    INT32U  g_Vcpu;
    INT32U  RL;
    
    TempR1 = 33;            //是PIN23脚向内接入的  33K与27K
    TempR2 = 27;
    
    VR1 = 33000;            //KL15_AD  单片机15电AD采集端配置的电阻，12V表配 33欧姆与10欧姆
    VR2 = 10000;
    
    RScale= (TempR1+TempR2)*10/TempR2;
    temp2 = (g_adcResult.FuelEven[3] + g_adcResult.FuelEven[4] + g_adcResult.FuelEven[5])*10/3;  	
    temp1 = (g_adcResult.BatLevel[3] + g_adcResult.BatLevel[4] + g_adcResult.BatLevel[5])*10/3;
    temp1 = (temp1*5*(VR1+VR2))/(1024*VR2);
    g_Vcc = temp1;
    g_FuelVCC = (INT16U)g_Vcc;
    g_Vcpu = temp2 * 5 / 1024;
    if((g_Vcpu*RScale) < (g_Vcc*10))
    {
        RL = ((RScale*5*temp2)*200)/(10240*g_Vcc-(RScale*5*temp2));     ////图纸上是200欧姆(1.2K的6个并联)，是PIN23脚向内接入的
        RL = RL * 10; 
    } 
    
    if(RL > 3600)
    {
        RL = 3600;
    }
    
    g_fuelMeter.CurBoardVal = (INT16U)RL;   
}
/*-------------------------------------------------------------------------
*	Function Name	 : App_CalFuelEconomy
*	Description		 :
*	Input					 : None
*	Output				 : None
*	Return				 : None
*	onther				 :
--------------------------------------------------------------------------*/
void App_CalFuelEconomy(void)
{
    if((g_FuelState == FuelSensorNormal)&&(g_canClock.signal.Exist65266))
    {
        if(g_fuelEco.VehNullTime <= T_1_0min)
        {
            if(g_revMeter.CurBoardVal > null)
            {
                if((FuelConsumption/100000)>=1) //100mL
                {
                    g_fuelEco.FuelSum += 1;
                    g_fuelEco.FuelSum1+= 1;
                    FuelConsumption = FuelConsumption%100000;
                }
            }
        }
        
        //平均油耗
        if((g_fuelEco.AveFuelTime >= T_5_0s) || (g_fuelEco.DispAveFuel == null))
        {
            g_fuelEco.AveFuelTime = null;
            
            if(g_fuelEco.Dis100Km >= 1)//清零后行驶里程100m显示
            {
                //大于500km，累计 S 或油耗累计 L除2
                if((g_fuelEco.Dis100Km >= 5000))
                {
                    g_fuelEco.FuelSum  /= 2;
                    g_fuelEco.Dis100Km /= 2;
                }
                
                //公式：（燃油消耗+修正因子） /（行驶距离+5km）
                g_fuelEco.CalAveFuel = (INT16U)((g_fuelEco.FuelSum+ConfigItem.FuelCosumConfig)*1000 /(g_fuelEco.Dis100Km+50));
                
                if(g_fuelEco.DispAveFuel == null)
                {
                    g_fuelEco.DispAveFuel = g_fuelEco.CalAveFuel;
                }
                
                if(g_fuelEco.CalAveFuel > g_fuelEco.DispAveFuel)
                {
                    g_fuelEco.DispAveFuel ++;
                }
                else if(g_fuelEco.DispAveFuel > g_fuelEco.CalAveFuel)
                {
                    g_fuelEco.DispAveFuel --;
                }
                
                if(g_fuelEco.DispAveFuel > 699) //最大限制69.9L/100km
                {
                    g_fuelEco.DispAveFuel = 699;
                }
                if(g_fuelEco.DispAveFuel < 60) //最低限制6.0L/100km
                {
                    g_fuelEco.DispAveFuel = 60;
                }
            }
            else
            {
                g_fuelEco.DispAveFuel = null;
            }
        }
        
        //短程油耗
        if((g_fuelEco.SRFCTime >= T_5_0s) || (g_fuelEco.DispSRFC == null))
        {
            g_fuelEco.SRFCTime = null;
            
            if(g_fuelEco.Dis100Km1 >= 1)//清零后行驶里程100m显示
            {
                //大于500km，累计 S 或油耗累计 L除2
                if((g_fuelEco.Dis100Km1 >= 5000))
                {
                    g_fuelEco.FuelSum1  /= 2;
                    g_fuelEco.Dis100Km1 /= 2;
                }
                
                //公式：（燃油消耗+修正因子） /（行驶距离+5km）
                g_fuelEco.CalSRFC = (INT16U)((g_fuelEco.FuelSum1+ConfigItem.FuelCosumConfig) * 1000/(g_fuelEco.Dis100Km1+50));
                
                if(g_fuelEco.DispSRFC == null)
                {
                    g_fuelEco.DispSRFC = g_fuelEco.CalSRFC;
                }
                
                if(g_fuelEco.CalSRFC > g_fuelEco.DispSRFC)
                {
                    g_fuelEco.DispSRFC ++;
                }
                else if(g_fuelEco.DispSRFC > g_fuelEco.CalSRFC)
                {
                    g_fuelEco.DispSRFC --;
                }
                
                if(g_fuelEco.DispSRFC > 699) //最大限制69.9L/100km
                {
                    g_fuelEco.DispSRFC = 699;
                }
                if(g_fuelEco.DispSRFC < 60)  //最大限制6.0L/100km
                {
                    g_fuelEco.DispSRFC = 60;
                }
            }
            else
            {
                g_fuelEco.DispSRFC = null;
            }
        }
    }
    else
    {      
        g_fuelEco.AveFuelTime = null;
        g_fuelEco.FuelSum = null;
        g_fuelEco.Dis100Km = null;
        g_fuelEco.DispAveFuel = null;
        g_fuelEco.CalAveFuel = null;
        AveFuel_Updeta;
        
        g_fuelEco.SRFCTime = null;
        g_fuelEco.FuelSum1 = null;
        g_fuelEco.Dis100Km1 = null;
        g_fuelEco.DispSRFC = null;
        g_fuelEco.CalSRFC = null;
        InstFuel_Updeta;       	                                   
    }
}
/*-------------------------------------------------------------------------
*	Function Name	 : App_CalFuelInit
*	Description		 :
*	Input					 : None
*	Output				 : None
*	Return				 : None
*	onther				 :
--------------------------------------------------------------------------*/
void App_CalFuelInit(void)
{
    if(ConfigItem.FuelConfig == 0)
    {
        FuelInitPara.FuelShortCircuitR = 10; //短路电阻--1欧
        FuelInitPara.FuelOpenCircuitR = 3500;//断路电阻--350欧
        
        FuelInitPara.DisplayZoneBoundary[0] = 1050;
        FuelInitPara.DisplayZoneBoundary[1] = 1050;//E(0格末)  --10steps
        FuelInitPara.DisplayZoneBoundary[2] = 880; //1格末     --20steps
        FuelInitPara.DisplayZoneBoundary[3] = 700; //2格末     --30steps
        FuelInitPara.DisplayZoneBoundary[4] = 510; //3格末     --40steps
        FuelInitPara.DisplayZoneBoundary[5] = 325; //4格末     --50steps
        FuelInitPara.DisplayZoneBoundary[6] = 250; //5格末     --60steps
        FuelInitPara.DisplayZoneBoundary[7] = 180; //6格末     --70steps
        FuelInitPara.DisplayZoneBoundary[8] = 80;  //7格末     --80steps
        FuelInitPara.DisplayZoneBoundary[9] = 30;  //8格末     --90steps
        FuelInitPara.DisplayZoneBoundary[10] = FuelInitPara.FuelShortCircuitR;
        
        //-- no use --//
        FuelInitPara.FuelCapacityBoundary[0] = 0;
        FuelInitPara.FuelCapacityBoundary[1] = 0;
        FuelInitPara.FuelCapacityBoundary[2] = 100;
        FuelInitPara.FuelCapacityBoundary[3] = 160;
        FuelInitPara.FuelCapacityBoundary[4] = 230;
        FuelInitPara.FuelCapacityBoundary[5] = 300;
        FuelInitPara.FuelCapacityBoundary[6] = 360;
        FuelInitPara.FuelCapacityBoundary[7] = 420;
        FuelInitPara.FuelCapacityBoundary[8] = 490;
        FuelInitPara.FuelCapacityBoundary[9] = 520;
        FuelInitPara.FuelCapacityBoundary[10] = 520;
    }
    else if(ConfigItem.FuelConfig == 3)
    {
        FuelInitPara.FuelShortCircuitR = 10; //短路电阻--1欧
        FuelInitPara.FuelOpenCircuitR = 3500;//断路电阻--350欧
        
        FuelInitPara.DisplayZoneBoundary[0] = 1460;
        FuelInitPara.DisplayZoneBoundary[1] = 1460;//E(0格末)  --10steps
        FuelInitPara.DisplayZoneBoundary[2] = 1250;//1格末     --20steps
        FuelInitPara.DisplayZoneBoundary[3] = 820; //2格末     --30steps
        FuelInitPara.DisplayZoneBoundary[4] = 670; //3格末     --40steps
        FuelInitPara.DisplayZoneBoundary[5] = 520; //4格末     --50steps
        FuelInitPara.DisplayZoneBoundary[6] = 400; //5格末     --60steps
        FuelInitPara.DisplayZoneBoundary[7] = 280; //6格末     --70steps
        FuelInitPara.DisplayZoneBoundary[8] = 110; //7格末     --80steps
        FuelInitPara.DisplayZoneBoundary[9] = 50;  //8格末     --90steps
        FuelInitPara.DisplayZoneBoundary[10] = FuelInitPara.FuelShortCircuitR;
        
        //-- no use --//
        FuelInitPara.FuelCapacityBoundary[0] = 0;
        FuelInitPara.FuelCapacityBoundary[1] = 0;
        FuelInitPara.FuelCapacityBoundary[2] = 100;
        FuelInitPara.FuelCapacityBoundary[3] = 160;
        FuelInitPara.FuelCapacityBoundary[4] = 230;
        FuelInitPara.FuelCapacityBoundary[5] = 300;
        FuelInitPara.FuelCapacityBoundary[6] = 360;
        FuelInitPara.FuelCapacityBoundary[7] = 420;
        FuelInitPara.FuelCapacityBoundary[8] = 490;
        FuelInitPara.FuelCapacityBoundary[9] = 520;
        FuelInitPara.FuelCapacityBoundary[10] = 520;
    }
    else  //default config 1
    {
        FuelInitPara.FuelShortCircuitR = 10; //短路电阻--1欧
        FuelInitPara.FuelOpenCircuitR = 3500;//断路电阻--350欧
        
        FuelInitPara.DisplayZoneBoundary[0] = 1950;
        FuelInitPara.DisplayZoneBoundary[1] = 1950;//E(0格末)  --10steps
        FuelInitPara.DisplayZoneBoundary[2] = 1720;//1格末     --20steps
        FuelInitPara.DisplayZoneBoundary[3] = 1420;//2格末     --30steps
        FuelInitPara.DisplayZoneBoundary[4] = 1170;//3格末     --40steps
        FuelInitPara.DisplayZoneBoundary[5] = 890; //4格末     --50steps
        FuelInitPara.DisplayZoneBoundary[6] = 700; //5格末     --60steps
        FuelInitPara.DisplayZoneBoundary[7] = 580; //6格末     --70steps
        FuelInitPara.DisplayZoneBoundary[8] = 310; //7格末     --80steps
        FuelInitPara.DisplayZoneBoundary[9] = 100; //8格末     --90steps
        FuelInitPara.DisplayZoneBoundary[10] = FuelInitPara.FuelShortCircuitR;
        
        //-- no use --//
        FuelInitPara.FuelCapacityBoundary[0] = 0;
        FuelInitPara.FuelCapacityBoundary[1] = 0;
        FuelInitPara.FuelCapacityBoundary[2] = 100;
        FuelInitPara.FuelCapacityBoundary[3] = 160;
        FuelInitPara.FuelCapacityBoundary[4] = 230;
        FuelInitPara.FuelCapacityBoundary[5] = 300;
        FuelInitPara.FuelCapacityBoundary[6] = 360;
        FuelInitPara.FuelCapacityBoundary[7] = 420;
        FuelInitPara.FuelCapacityBoundary[8] = 490;
        FuelInitPara.FuelCapacityBoundary[9] = 520;
        FuelInitPara.FuelCapacityBoundary[10] = 520;
    }
    
    InitFuelParamter(&FuelInitPara);
    
    g_AFC_INIT.CalcAFCMaxNum = 50;	//max 100km,default 50
    g_AFC_INIT.AFCMin = 40;	//unit:L,accuracy:0.1
    g_AFC_INIT.AFCMax = 199;	//unit:L,accuracy:0.1
    g_AFC_INIT.AFCPreinstall = 75;	//unit:L,accuracy:0.1
    g_AFC_INIT.CurODO = g_accKm.LongAccKm * 100;		// unit:m,accuracy:1
    g_AFC_INIT.MaxDRMileage = 70000;	//unit:km,accuracy:0.01
    InitAFC( &g_AFC_INIT);
    SetFuelSensorRecoverGroupCnt(40);
    SetFuelSensorOpenCircuitGroupCnt(40);
    SetFuelSensorShortCircuitGroupCnt(10); //5s
}
/*-------------------------------------------------------------------------
*	Function Name	 : App_FuelManage
*	Description		 :
*	Input					 : None
*	Output				 : None
*	Return				 : None
*	onther				 :
--------------------------------------------------------------------------*/
void App_FuelManage(void)
{
    SetPowerSt(1);
    AFCPara.CurODO = g_accKm.LongAccKm * 100;
    AFCPara.FuleConsume = (INT16U)Sum_FuelConsumption;
    Sum_FuelConsumption = 0;
    AFCPara.RPM = g_revMeter.CurBoardVal;
    AFCPara.Speed = (INT8U)g_vehMeter.CurBoardVal;
    SetAFCPara(&AFCPara);
    if(g_fuelMeter.CurBoardVal == 0)
    {
        g_fuelMeter.CurBoardVal = 1;
    }
    SaveSampleVal(g_fuelMeter.CurBoardVal);
    FuelFSM();
    g_fuelMeter.BoardVal = GetFuelResistance();
    g_FuelState = GetFuelSensorState();
    if(CheckStep==2)
    {
        if(DIDFlag.Bits.DID1006Valid == Enable)//所有表
        {
            if(IOCTL_DID1006.FF_Byte == 1)
            {
               g_fuelMeter.DispPosition = 8;
            }
            else if(IOCTL_DID1006.FF_Byte == 2)
            {
               g_fuelMeter.DestPosition = 4;
            }        
            else
            {
               g_fuelMeter.DestPosition = 0;
            } 
        }
        else if(DIDFlag.Bits.DID1004Valid == Enable)
        {
            if(IOCTL_DID1003.FF_Byte == 1)
            {
               g_fuelMeter.DispPosition = 8;
            }
            else if(IOCTL_DID1003.FF_Byte == 2)
            {
               g_fuelMeter.DestPosition = 4;
            }        
            else
            {
               g_fuelMeter.DestPosition = 0;
            }            
        }
        else if((g_FuelState == FuelSensorShortCircuit) || (g_FuelState == FuelSensorOpenCircuit))
        {
            if(g_FuelState == FuelSensorShortCircuit) //短路
            {
                g_fuelMeter.DispPosition = 8;
            }
            else if(g_FuelState == FuelSensorOpenCircuit) //开路
            {
                g_fuelMeter.DispPosition = 0;
            }
            
            g_FuelAlarm = Enable;
        }
        else if ((g_fuelMeter.BoardVal)&&(g_FuelState == FuelSensorNormal))
        {
            g_fuelMeter.DispPosition = GetFuelSeg();
            g_fuelMeter.CurPosition = GetFuelStep();
            g_FuelAlarm = Disable;
        }
        else
        {
            ;
        }
    }
}