|
|
@ -192,7 +192,6 @@ int CYSFGateway::run()
|
|
|
|
return 1;
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
CTimer watchdogTimer(1000U, 0U, 500U);
|
|
|
|
|
|
|
|
CTimer lostTimer(1000U, 120U);
|
|
|
|
CTimer lostTimer(1000U, 120U);
|
|
|
|
CTimer pollTimer(1000U, 5U);
|
|
|
|
CTimer pollTimer(1000U, 5U);
|
|
|
|
|
|
|
|
|
|
|
@ -244,8 +243,6 @@ int CYSFGateway::run()
|
|
|
|
unsigned char buffer[200U];
|
|
|
|
unsigned char buffer[200U];
|
|
|
|
|
|
|
|
|
|
|
|
while (rptNetwork.read(buffer) > 0U) {
|
|
|
|
while (rptNetwork.read(buffer) > 0U) {
|
|
|
|
watchdogTimer.start();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
CYSFFICH fich;
|
|
|
|
CYSFFICH fich;
|
|
|
|
bool valid = fich.decode(buffer + 35U);
|
|
|
|
bool valid = fich.decode(buffer + 35U);
|
|
|
|
if (valid) {
|
|
|
|
if (valid) {
|
|
|
@ -297,7 +294,6 @@ int CYSFGateway::run()
|
|
|
|
if ((buffer[34U] & 0x01U) == 0x01U) {
|
|
|
|
if ((buffer[34U] & 0x01U) == 0x01U) {
|
|
|
|
if (m_gps != NULL)
|
|
|
|
if (m_gps != NULL)
|
|
|
|
m_gps->reset();
|
|
|
|
m_gps->reset();
|
|
|
|
watchdogTimer.stop();
|
|
|
|
|
|
|
|
m_exclude = false;
|
|
|
|
m_exclude = false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -337,15 +333,6 @@ int CYSFGateway::run()
|
|
|
|
pollTimer.start();
|
|
|
|
pollTimer.start();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
watchdogTimer.clock(ms);
|
|
|
|
|
|
|
|
if (watchdogTimer.isRunning() && watchdogTimer.hasExpired()) {
|
|
|
|
|
|
|
|
LogMessage("Network watchdog has expired");
|
|
|
|
|
|
|
|
if (m_gps != NULL)
|
|
|
|
|
|
|
|
m_gps->reset();
|
|
|
|
|
|
|
|
watchdogTimer.stop();
|
|
|
|
|
|
|
|
m_exclude = false;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (ms < 5U)
|
|
|
|
if (ms < 5U)
|
|
|
|
CThread::sleep(5U);
|
|
|
|
CThread::sleep(5U);
|
|
|
|
}
|
|
|
|
}
|
|
|
|