#include "../main/SystemInclude.h"
//==============================================================================

u16 batteryTestPeriod, batteryTestPeriodSet;  

//******************************************************************************
void CheckSystemVoltageInit(void)
{
}

//******************************************************************************
void CheckBatteryVoltageInit(void)
{
  //BATOP_POWER_OUTPUT();
  //TURN_ON_BATOP_POWER(); 
  
  //==============================================================================
#ifndef ENABLE_BAT_SEL_PIN
#pragma message("[undefined] ENABLE_BAT_SEL_PIN")
#elif(ENABLE_BAT_SEL_PIN)
  BATOP_SEL_OUTPUT();
  SELECT_MAIN_BAT();	 
#endif
  //==============================================================================
}

//******************************************************************************
u16 ComputeVoltage(u16 codeVol)
{
  tmpLA  = (u32)codeVol;
  tmpLA *= 400;                                                                 //for vref=2.0V
  tmpLA >>= 10;
  
  return (u16)tmpLA;
}

//******************************************************************************
u16 ReadAndComputeVoltage(void)
{
  return ComputeVoltage(1);
}

//******************************************************************************
void CheckEndIntoLowPower(void)
{
  //TURN_OFF_BATOP_POWER(); 
  
  //============================================================================
#ifndef ENABLE_BAT_SEL_PIN
#pragma message("[undefined] ENABLE_BAT_SEL_PIN")
#elif(ENABLE_BAT_SEL_PIN)
  BATOP_SEL_OUTPUT();
  SELECT_RF_BAT();	 
#endif   

}

//******************************************************************************
void JudgeSystemVolState(void)
{
//  systemVoltage = 271;    //FY
//  batteryVoltage = 278;
  
	
  #ifndef DISABLE_BAT_ALARM
  #pragma message("[undefined] DISABLE_BAT_ALARM")
  #elif(DISABLE_BAT_ALARM)  
  systemAlarm.Bit.BatteryAlarm = 0;   
  systemAlarm.Bit.BatteryOff = 0; 
  #else
  //判断各工作状态
  systemAlarm.Bit.BatteryAlarm = 0;   
  systemAlarm.Bit.BatteryOff = 0;
  
  batteryGrid = 0;
  if(batteryVoltage >= VOLTAGE_315)      batteryGrid = 4;
  else if(batteryVoltage >= VOLTAGE_310) batteryGrid = 3;
  else if(batteryVoltage >= VOLTAGE_305) batteryGrid = 2;
  else if(batteryVoltage >= VOLTAGE_300) batteryGrid = 1;

  if(batteryGrid > 0) return;
  batteryGrid       = 0;
  systemAlarm.Bit.BatteryAlarm = 1;  
  HWState.EnableCheck     = 1; 
  sampleState.EnableRoughTest = 0;
  roughTestCounter  = 0;     

//  if(batteryVoltage < systemVoltage )
//  {
//    HWState.EnableCheck     = 1;
//    sampleState.EnableRoughTest = 0;
//    roughTestCounter  = 0;   
//  }
  
  currentMode.Bit.TurnOffSystem = 0;
  if(systemVoltage  < TURN_OFF_SYSTEM) 
  {
     SysVolErrorCount++;
     if(SysVolErrorCount < 16) return;
     
     SysVolErrorCount = 16;
     currentMode.Bit.TurnOffSystem = 1; 
     systemAlarm.Bit.BatteryAlarm = 1;   
     systemAlarm.Bit.BatteryOff   = 1;  
     HWState.EnableCheck = 0; 		 
  }
  else  SysVolErrorCount = 0;

  #endif  
}

//******************************************************************************
void CheckSystemAndBatteryVoltage(void)
{
  batteryTestPeriodSet = 0;
  batteryTestPeriod = (u16)ReadParameterFromMemory(BATTEST_PERIOD, BATTEST_PERIOD_WIDTH, BATTEST_PERIOD_DEFAULT);
  
  //BATOP_POWER_OUTPUT();
  //TURN_ON_BATOP_POWER(); 
  
  //==============================================================================
#ifndef ENABLE_BAT_SEL_PIN
#pragma message("[undefined] ENABLE_BAT_SEL_PIN")
#elif(ENABLE_BAT_SEL_PIN)
  BATOP_SEL_OUTPUT();
  SELECT_MAIN_BAT();	 
#endif
  //==============================================================================
  
  //测量系统工作电压 3V
  CheckSystemVoltageInit();
  systemVoltage = ReadAndComputeVoltage();
  
  //测量电池工作电压
  CheckBatteryVoltageInit();
  batteryVoltage = ReadAndComputeVoltage();
  //batteryVoltage = MovingAverage(batteryVoltage, 100, BATT);
  
  //测量完毕进入低功耗模式
  CheckEndIntoLowPower();
  
  //判断电池工作状态
  JudgeSystemVolState();
}