//------------------------------------------------------------------------------
void Check_State_LED()
{
unsigned long i_c,i_b;
//
i_c = Seconds_Between(&cool_pack_recv, &CT);
i_b = Seconds_Between(&bad_pack_recv, &CT);
//
if ((i_c==0) && (i_b==0))
return;
//
if (i_c > i_b)
{
if (i_b>5)
GPS_LED=0;
else
GPS_LED=1;
}
else
{
if (i_c>5)
GPS_LED=0;
else
GPS_LED=2;
}
}
//------------------------------------------------------------------------------
// Save Last Error Time
static void Check_LET(void)
{
SYSTEMTIME cur_time;
DS1390_TIME time;
//
if (reboot_tryes==0)
return;
///////
GetTime_DS1390(&time);
//
cur_time.tm_hour = time.hour;
cur_time.tm_mday = time.date;
cur_time.tm_min = time.min;
cur_time.tm_sec = time.sec;
cur_time.tm_mon = time.month;
cur_time.tm_year = time.year;
///////////////
int i_sec = Seconds_Between(&L_ERR_TIME, &cur_time);
if (i_sec > PROJ[CUR_DK].guard.time_clear*60)
reboot_tryes=0;
}
/*loop cycle*/
static void task_light_func(void* param)
{
//unsigned short light;
bool b_ch;//, b_err;
unsigned int fpattern;
//int i_sec;
SYSTEMTIME cur_time;
DS1390_TIME time;
CUR_DK=0;
SIGNAL_OFF();
POWER_SET(true);
SIGNAL_OFF();
pin_off(OPIN_ERR_LED); // error enabled
//
tn_task_sleep(500);
SIGNAL_OFF();
pin_off(OPIN_TR_EN);//включить выходные регистры
//
Event_Push_Str("СТАРТ");// запись в журнал старт
light_time_out=1;
for (;;)
{
//считать время
GetTime_DS1390(&time);
// обновить
cur_time.tm_hour = time.hour;
cur_time.tm_mday = time.date;
cur_time.tm_min = time.min;
cur_time.tm_sec = time.sec;
cur_time.tm_mon = time.month;
cur_time.tm_year = time.year;
//
if (Next_Try_wait)
if (Seconds_Between(&L_ERR_TIME, &cur_time) >
PROJ[CUR_DK].guard.restart_interval){
for (int i_dk=0; i_dk<dk_num; i_dk++)
{
DK[i_dk].REQ.req[ALARM].presence = false;
}
light_machine.work=true;
//
if (chan_faults!=FT_RED_CONFL){
SIGNAL_OFF();
POWER_SET(true);
SIGNAL_OFF();
}
//
Next_Try_wait = false;
}
// test mode
if(DK[0].test)
{
if(!DK[0].test_init){
SIGNAL_OFF();
DK[0].test_init=true;
}
//
Clear_UDC_Arrays();
tn_task_sleep(500);
//
Check_Channels();
continue;
}
// last time error
Check_LET();
// work mode
if (!light_machine.work){
tn_task_sleep(500);
continue;
}
//machine stat
switch (LIGHT_STA)
{
case LIGHT_WORK:
{
tn_event_wait(&g_light_evt, EVENT_SINHRO_TIME, TN_EVENT_WCOND_OR, &fpattern, TN_WAIT_INFINITE);
//синхронизация времени GPS&RTC
Synk_TIME();
//проверка конфликтов каналов
b_ch = Check_Chan();
if(b_ch){
Next_Try(b_ch);break;}
// основная логика работы
DK_MAIN();
tn_task_sleep(500);// delay 0.5S
//проверка конфликтов каналов
b_ch = Check_Chan();
if(b_ch){
Next_Try(b_ch);break;}
// здесь организовано миганине силовых выходов вот так!(в проетке его нет)
/*for (int i_dk=0; i_dk<dk_num; i_dk++)
{
CUR_DK = i_dk; // тукущий ДК
Update_STATES(true);
} */
SET_OUTPUTS();
break;
}
case LIGHT_FAULT:
{
tn_task_sleep(500);
break;
}
}// end switch
}// end for
}
/*----------------------------------------------------------------------------*/
static void task_light_func(void* param)
{
bool b_ch;
unsigned int fpattern;
WORD TimeErrorGPS;
BYTE fStat=false;
SYSTEMTIME cur_time;
DS1390_TIME time;
CUR_DK=0;
SIGNAL_OFF();
POWER_SET(true);
SIGNAL_OFF();
pin_off(OPIN_ERR_LED); // error enabled
//
tn_task_sleep(500);
SIGNAL_OFF();
pin_off(OPIN_TR_EN);//включить выходные регистры
//
Event_Push_Str("СТАРТ");// запись в журнал старт
light_time_out=1;
for (;;)
{
//считать время
GetTime_DS1390(&time);
// обновить
cur_time.tm_hour = time.hour;
cur_time.tm_mday = time.date;
cur_time.tm_min = time.min;
cur_time.tm_sec = time.sec;
cur_time.tm_mon = time.month;
cur_time.tm_year = time.year;
//
if (Next_Try_wait)
if (Seconds_Between(&L_ERR_TIME, &cur_time) >
PROJ[CUR_DK].guard.restart_interval){
for (int i_dk=0; i_dk<dk_num; i_dk++)
{
DK[i_dk].REQ.req[ALARM].presence = false;
}
light_machine.work=true;
//
if (chan_faults!=FT_RED_CONFL){
SIGNAL_OFF();
POWER_SET(true);
SIGNAL_OFF();
}
//
Next_Try_wait = false;
}
// test mode
if(DK[0].test)
{
if(!DK[0].test_init){
SIGNAL_OFF();
DK[0].test_init=true;
}
//
Clear_UDC_Arrays();
tn_task_sleep(500);
//
Check_Channels();
continue;
}
// last time error
Check_LET();
// work mode
if (!light_machine.work){
tn_task_sleep(500);
continue;
}
// ждем данных от GPS
if((DK[0].PROJ->guard.gpsON)&&(LIGHT_STA==LIGHT_WORK)){ // работаем только с GPS DK_Service_undo();
GPS_INFO gps;
Get_gps_info(&gps);
switch(fStat)
{
case Null: // первый старт time_valid
if(gps.time_valid==false){// выходим с аварией gps.fix_valid
tn_task_sleep(2000);
DK_ALARM_OC();
break;}
DK_ALARM_undo();// включаем режим
TimeErrorGPS = 0;
fStat=One;
break;
case One:// нет данных GPS
if(!gps.time_valid){TimeErrorGPS = 0;fStat=Two;} // gps.fix_valid
break;
case Two:// задерка на выключение 5 мин
if(++TimeErrorGPS>300){DK_ALARM_OC();fStat=Three;}
if(gps.time_valid)fStat=One; //gps.fix_valid
break;
case Three://ждем GPS данные
if(gps.time_valid){TimeErrorGPS =0;fStat=Five;} // gps.fix_valid
break;
case Five:// задерка на включение 2 мин
if(++TimeErrorGPS>120){DK_ALARM_undo();fStat=One;}
if(!gps.time_valid)fStat=Three; // gps.fix_valid
break;
default:fStat=One;break;
}
}
//machine stat
switch (LIGHT_STA)
{
case LIGHT_WORK:
{
tn_event_wait(&g_light_evt, EVENT_SINHRO_TIME, TN_EVENT_WCOND_OR, &fpattern, TN_WAIT_INFINITE);
//синхронизация времени GPS&RTC
Synk_TIME();
//проверка конфликтов каналов
b_ch = Check_Chan();
if(b_ch){
Next_Try(b_ch);break;}
// основная логика работы
DK_MAIN();
tn_task_sleep(500);// delay 0.5S
//проверка конфликтов каналов
b_ch = Check_Chan();
if(b_ch){
Next_Try(b_ch);break;}
// провка проекта, он слетает
checksumProject();
// здесь организовано миганине силовых выходов вот так!(в проетке его нет)
/*for (int i_dk=0; i_dk<dk_num; i_dk++)
{
CUR_DK = i_dk; // тукущий ДК
Update_STATES(true);
} */
SET_OUTPUTS();
break;
}
case LIGHT_FAULT:
{
tn_task_sleep(500);
break;
}
}// end switch
}// end for
}
