diff --git a/YSFReflector/YSFReflector.cpp b/YSFReflector/YSFReflector.cpp index 768cd2b..218c5e4 100644 --- a/YSFReflector/YSFReflector.cpp +++ b/YSFReflector/YSFReflector.cpp @@ -69,11 +69,48 @@ void CYSFReflector::run() ::fprintf(stdout, "Starting YSFReflector-%s\n", VERSION); + CTimer watchdogTimer(1000U, 0U, 1500U); + + unsigned char src[YSF_CALLSIGN_LENGTH]; + unsigned char dst[YSF_CALLSIGN_LENGTH]; + for (;;) { unsigned char buffer[200U]; unsigned int len = network.readData(buffer); if (len > 0U) { + if (!watchdogTimer.isRunning()) { + if (::memcmp(buffer + 14U, " ", YSF_CALLSIGN_LENGTH) != 0) + ::memcpy(src, buffer + 14U, YSF_CALLSIGN_LENGTH); + else + ::memcpy(src, "??????????", YSF_CALLSIGN_LENGTH); + + if (::memcmp(buffer + 24U, " ", YSF_CALLSIGN_LENGTH) != 0) + ::memcpy(dst, buffer + 24U, YSF_CALLSIGN_LENGTH); + else + ::memcpy(dst, "??????????", YSF_CALLSIGN_LENGTH); + + ::fprintf(stdout, "Received data from %10.10s to %10.10s at %10.10s\n", src, dst, buffer + 4U); + } + else { + bool changed = false; + + if (::memcmp(buffer + 14U, " ", YSF_CALLSIGN_LENGTH) != 0 && ::memcmp(src, "??????????", YSF_CALLSIGN_LENGTH) == 0) { + ::memcpy(src, buffer + 14U, YSF_CALLSIGN_LENGTH); + changed = true; + } + + if (::memcmp(buffer + 24U, " ", YSF_CALLSIGN_LENGTH) != 0 && ::memcmp(dst, "??????????", YSF_CALLSIGN_LENGTH) == 0) { + ::memcpy(dst, buffer + 24U, YSF_CALLSIGN_LENGTH); + changed = true; + } + + if (changed) + ::fprintf(stdout, "Received data from %10.10s to %10.10s at %10.10s\n", src, dst, buffer + 4U); + } + + watchdogTimer.start(); + std::string callsign = std::string((char*)(buffer + 4U), YSF_CALLSIGN_LENGTH); CYSFRepeater* rpt = findRepeater(callsign); if (rpt != NULL) { @@ -82,6 +119,11 @@ void CYSFReflector::run() network.writeData(buffer, (*it)->m_address, (*it)->m_port); } } + + if (buffer[34U] == 0x01U) { + ::fprintf(stdout, "Received end of transmission\n"); + watchdogTimer.stop(); + } } // Refresh/add repeaters based on their polls @@ -130,6 +172,12 @@ void CYSFReflector::run() } } + watchdogTimer.clock(ms); + if (watchdogTimer.isRunning() && watchdogTimer.hasExpired()) { + ::fprintf(stdout, "Watchdog has expired\n"); + watchdogTimer.stop(); + } + if (ms < 5U) { #if defined(_WIN32) || defined(_WIN64) ::Sleep(5UL); // 5ms