Чет работает
This commit is contained in:
61
Core/UKSI/uksi_main.c
Normal file
61
Core/UKSI/uksi_main.c
Normal file
@@ -0,0 +1,61 @@
|
||||
#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;
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user