#include "uksi_main.h"
#include "adc.h"
#include "tim.h"
UKSI_Calc_t uksi_calc;
UKSI_DC_t uksi_dc;
float iso_result;
int dbg_dc = 0;
int dbg_dc_delay = 5000;
void UKSI_Init()
{
  DC_Init(&uksi_dc, &htim1, TIM_OCMODE_INACTIVE, TIM_OCMODE_ACTIVE);
  UKSI_Calc_Init(&uksi_calc, &hadc1);
}



void UKSI_prewhile()
{
}


void UKSI_while()
{
  static uint32_t prev_dc_tick = 0;
  static uint32_t start_measure_tick = 0;
  float curr_iso = 0;
  DC_Enable(&uksi_dc, dbg_dc);
  
  if(dbg_dc)
  {
    curr_iso = UKSI_Calc_Isolation(&uksi_calc);
    if(uwTick - prev_dc_tick > dbg_dc_delay) // подаем импульс минимум на секунду
    {
      if(!foster_check(&uksi_calc.adc.foster)) // если стабильный уровень найден - отключаем на секунду источник
      {
        if(start_measure_tick == 0)
        {
          start_measure_tick = uwTick; // измеряем еще 5 секунд и выключаем источник
        }
        else
        {
          if(uwTick - start_measure_tick > dbg_dc_delay)
          {
            dbg_dc = 0;
            start_measure_tick = 0;
            prev_dc_tick = uwTick;
            iso_result = curr_iso;
          }
        }
      }
    }
  }
  else
  {
    if(uwTick - prev_dc_tick > dbg_dc_delay) // подаем импульс минимум на секунду
    {
      dbg_dc = 1;
      prev_dc_tick = uwTick;
    }
  }
}