61 lines
1.4 KiB
C
61 lines
1.4 KiB
C
#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;
|
|
}
|
|
}
|
|
} |