//------------------------------------------------------------------------------
static void task_leds_func(void* param)
{
bool b_err;
//
Clear_DS_COUNTS();
//
for (;;)
{
if (DK[CUR_DK].CUR.source==ALARM)
{
//tn_task_sleep(50);
if (b_err)
pin_on(OPIN_ERR_LED);
else
pin_off(OPIN_ERR_LED);
///
b_err=!b_err;
}
else
{
pin_on(OPIN_ERR_LED);
}
///////////////////////////
hw_watchdog_clear();
tn_task_sleep(900);
pin_off(OPIN_CPU_LED);
tn_task_sleep(100);
pin_on(OPIN_CPU_LED);
//////////////////////
WAIT_1S_COUNT++;
if (WAIT_1S_COUNT > DS_COUNT)
Check_DS();
}
}
//------------------------------------------------------------------------------
void POWER_SET(const BOOL stat)
{
if (stat)
{
if (!power_flag)
{
SIGNAL_OFF();
pin_on(OPIN_POWER);
SIGNAL_OFF();
SysCtlDelay( (SysCtlClockGet()/(3*1000))) ;
SIGNAL_OFF();
light_time_out=2;
}
}
else
{
if (power_flag)
{
pin_off(OPIN_POWER);
light_time_out=2;
}
}
power_flag=stat;
}
on_timer( ) {
static uint8_t windowCounter = 0;
if ( windowCounter >= pgm_read_byte(gammaTable + channelA) ) {
pin_off( LED_A );
} else {
pin_on( LED_A );
}
if ( windowCounter >= pgm_read_byte(gammaTable + channelB) ) {
pin_off( LED_B );
} else {
pin_on( LED_B );
}
windowCounter = (windowCounter + 1) % PWM_WINDOW;
}
void emu_sheave(void) {
if (emu_tooth <= 57) pin_on(&b6);
_delay_us(600);
pin_off(&b6);
_delay_us(600);
if (emu_tooth <= 58) emu_tooth++;
else {
emu_tooth = 0;
}
}
/* Error LED blink------------------------------------------------------------*/
static void Err_led(unsigned char err)
{
bool b_err;
while (1)
{
MAP_WatchdogIntClear(WATCHDOG0_BASE);
if (b_err)
pin_on(OPIN_ERR_LED);
else
pin_off(OPIN_ERR_LED);
b_err=!b_err;
hw_delay(700000);
}
}
/*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
}
/**
* Устанавливает низкий уровень на шине 1-wire.
* @param ow Шина 1-wire
*/
ALWAYS_INLINE static void one_wire_out_set_lo(one_wire_t* ow)
{
pin_off(&ow->pin);
}
void coil23_off(void) {
pin_off(&b5);
}
void coil14_off(void) {
pin_off(&b4);
}
void test_off(void) { // test/mark
pin_off(&b7);
}
/*----------------------------------------------------------------------------*/
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
}
//------------------------------------------------------------------------------
static void task_GPS_func(void* param)
{
unsigned char time_valid = gps_info.time_valid = 0;
unsigned char fix_valid = gps_info.fix_valid = 0;
unsigned char health = gps_info.health = 0;
static unsigned char count_time=0;
GPS_synk_flag=false;
//
pin_on(OPIN_TEST1);
for (;;)
{
tn_task_sleep(GPS_REFRESH_INTERVAL);
//
Check_State_LED();
//
if (GPS_LED==1)
{
pin_off(OPIN_TEST1);
tn_task_sleep(100);
pin_on(OPIN_TEST1);
}
//упрвление светодиодом
if (GPS_LED==2)
{
if (count_time % 2)
{
pin_off(OPIN_TEST1);
}
else
{
pin_on(OPIN_TEST1);
}
}
//разрешить обновление времени.
if ((++count_time % 5)==0)
GPS_synk_flag=true;
//
if (health_count > 4)
{
gps_info.health = FALSE;
//PPS_INT_ENABLE(); //PPS_INT_DISABLE();
pin_on(OPIN_GPS_RESET); // Пробуем сбросить модуль GPS
health_count = 1;
}
else
{
pin_off(OPIN_GPS_RESET);
if (!health_count++)
gps_info.health = TRUE;
}
//if (health != gps_info.health)
{
health = gps_info.health;
if (health){
dbg_puts("GPS/GLONASS module found");
WrateEventStr(ST_M_OK);
}
else{
dbg_puts("GPS/GLONASS module lost");
WrateEventStr(ST_M_NO);
}
}
if (fix_valid != gps_info.fix_valid)
{
fix_valid = gps_info.fix_valid;
if (fix_valid){
dbg_puts("GPS/GLONASS FIX valid");
WrateEventStr(ST_F_OK);
}
else{
dbg_puts("GPS/GLONASS FIX invalid");
WrateEventStr(ST_F_NO);
}
}
if (time_valid != gps_info.time_valid)
{
time_valid = gps_info.time_valid;
if (time_valid)
{
dbg_puts("GPS/GLONASS time valid");
PPS_INT_ENABLE();
WrateEventStr(ST_T_OK);
}
else{
dbg_puts("GPS/GLONASS time invalid");
WrateEventStr(ST_T_NO);
}
}
}
}
