mirror of
https://github.com/g4klx/MMDVMHost
synced 2025-12-21 15:09:23 +08:00
More superficial NXDN work.
This commit is contained in:
146
NXDNControl.cpp
146
NXDNControl.cpp
@@ -23,17 +23,14 @@
|
|||||||
|
|
||||||
// #define DUMP_NXDN
|
// #define DUMP_NXDN
|
||||||
|
|
||||||
CNXDNControl::CNXDNControl(const std::string& callsign, bool selfOnly, CYSFNetwork* network, CDisplay* display, unsigned int timeout, bool duplex, bool lowDeviation, bool remoteGateway, CRSSIInterpolator* rssiMapper) :
|
CNXDNControl::CNXDNControl(const std::string& callsign, bool selfOnly, CYSFNetwork* network, CDisplay* display, unsigned int timeout, bool duplex, bool remoteGateway, CRSSIInterpolator* rssiMapper) :
|
||||||
m_callsign(NULL),
|
m_callsign(NULL),
|
||||||
m_selfCallsign(NULL),
|
m_selfCallsign(NULL),
|
||||||
m_selfOnly(selfOnly),
|
m_selfOnly(selfOnly),
|
||||||
m_network(network),
|
m_network(network),
|
||||||
m_display(display),
|
m_display(display),
|
||||||
m_duplex(duplex),
|
m_duplex(duplex),
|
||||||
m_lowDeviation(lowDeviation),
|
|
||||||
m_remoteGateway(remoteGateway),
|
m_remoteGateway(remoteGateway),
|
||||||
m_sqlEnabled(false),
|
|
||||||
m_sqlValue(0U),
|
|
||||||
m_queue(5000U, "NXDN Control"),
|
m_queue(5000U, "NXDN Control"),
|
||||||
m_rfState(RS_RF_LISTENING),
|
m_rfState(RS_RF_LISTENING),
|
||||||
m_netState(RS_NET_IDLE),
|
m_netState(RS_NET_IDLE),
|
||||||
@@ -99,12 +96,6 @@ CNXDNControl::~CNXDNControl()
|
|||||||
delete[] m_selfCallsign;
|
delete[] m_selfCallsign;
|
||||||
}
|
}
|
||||||
|
|
||||||
void CNXDNControl::setSQL(bool on, unsigned char value)
|
|
||||||
{
|
|
||||||
m_sqlEnabled = on;
|
|
||||||
m_sqlValue = value;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool CNXDNControl::writeModem(unsigned char *data, unsigned int len)
|
bool CNXDNControl::writeModem(unsigned char *data, unsigned int len)
|
||||||
{
|
{
|
||||||
assert(data != NULL);
|
assert(data != NULL);
|
||||||
@@ -162,25 +153,6 @@ bool CNXDNControl::writeModem(unsigned char *data, unsigned int len)
|
|||||||
if (valid)
|
if (valid)
|
||||||
m_lastFICH = fich;
|
m_lastFICH = fich;
|
||||||
|
|
||||||
// Validate the DSQ/DG-ID value if enabled
|
|
||||||
if (m_sqlEnabled) {
|
|
||||||
unsigned char cm = m_lastFICH.getCM();
|
|
||||||
if (cm == YSF_CM_GROUP2) {
|
|
||||||
// Using the DG-ID value
|
|
||||||
unsigned char value = m_lastFICH.getSQ();
|
|
||||||
|
|
||||||
if (value != m_sqlValue)
|
|
||||||
return false;
|
|
||||||
} else {
|
|
||||||
// Using the DSQ value
|
|
||||||
bool sql = m_lastFICH.getSQL();
|
|
||||||
unsigned char value = m_lastFICH.getSQ();
|
|
||||||
|
|
||||||
if (!sql || value != m_sqlValue)
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Stop repeater packets coming through, unless we're acting as a remote gateway
|
// Stop repeater packets coming through, unless we're acting as a remote gateway
|
||||||
if (m_remoteGateway) {
|
if (m_remoteGateway) {
|
||||||
unsigned char mr = m_lastFICH.getMR();
|
unsigned char mr = m_lastFICH.getMR();
|
||||||
@@ -230,7 +202,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
if (m_selfOnly) {
|
if (m_selfOnly) {
|
||||||
bool ret = checkCallsign(m_rfSource);
|
bool ret = checkCallsign(m_rfSource);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
LogMessage("YSF, invalid access attempt from %10.10s", m_rfSource);
|
LogMessage("NXDN, invalid access attempt from %10.10s", m_rfSource);
|
||||||
m_rfState = RS_RF_REJECTED;
|
m_rfState = RS_RF_REJECTED;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -257,9 +229,9 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
||||||
LogMessage("YSF, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
LogMessage("NXDN, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -278,12 +250,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -303,7 +270,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
} else if (m_rfState == RS_RF_AUDIO) {
|
} else if (m_rfState == RS_RF_AUDIO) {
|
||||||
m_rfPayload.processHeaderData(data + 2U);
|
m_rfPayload.processHeaderData(data + 2U);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -322,12 +289,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -335,9 +297,9 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
m_rfFrames++;
|
m_rfFrames++;
|
||||||
|
|
||||||
if (m_rssi != 0U)
|
if (m_rssi != 0U)
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds, BER: %.1f%%, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits), m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds, BER: %.1f%%, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits), m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
||||||
else
|
else
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds, BER: %.1f%%", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits));
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds, BER: %.1f%%", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits));
|
||||||
|
|
||||||
writeEndRF();
|
writeEndRF();
|
||||||
}
|
}
|
||||||
@@ -350,7 +312,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
m_lastFICH.setFN(0U);
|
m_lastFICH.setFN(0U);
|
||||||
}
|
}
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -363,7 +325,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
m_rfErrs += errors;
|
m_rfErrs += errors;
|
||||||
m_rfBits += 720U;
|
m_rfBits += 720U;
|
||||||
m_display->writeFusionBER(float(errors) / 7.2F);
|
m_display->writeFusionBER(float(errors) / 7.2F);
|
||||||
LogDebug("YSF, V Mode 3, seq %u, AMBE FEC %u/720 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 7.2F);
|
LogDebug("NXDN, V Mode 3, seq %u, AMBE FEC %u/720 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 7.2F);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Remove any DSQ information
|
// Remove any DSQ information
|
||||||
@@ -377,12 +339,7 @@ bool CNXDNControl::processVWData(bool valid, unsigned char *data)
|
|||||||
writeNetwork(data, m_rfFrames % 128U);
|
writeNetwork(data, m_rfFrames % 128U);
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -416,7 +373,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
if (m_selfOnly) {
|
if (m_selfOnly) {
|
||||||
bool ret = checkCallsign(m_rfSource);
|
bool ret = checkCallsign(m_rfSource);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
LogMessage("YSF, invalid access attempt from %10.10s", m_rfSource);
|
LogMessage("NXDN, invalid access attempt from %10.10s", m_rfSource);
|
||||||
m_rfState = RS_RF_REJECTED;
|
m_rfState = RS_RF_REJECTED;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -443,9 +400,9 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
||||||
LogMessage("YSF, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
LogMessage("NXDN, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -464,12 +421,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -489,7 +441,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
} else if (m_rfState == RS_RF_AUDIO) {
|
} else if (m_rfState == RS_RF_AUDIO) {
|
||||||
m_rfPayload.processHeaderData(data + 2U);
|
m_rfPayload.processHeaderData(data + 2U);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -508,12 +460,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -521,9 +468,9 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
m_rfFrames++;
|
m_rfFrames++;
|
||||||
|
|
||||||
if (m_rssi != 0U)
|
if (m_rssi != 0U)
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds, BER: %.1f%%, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits), m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds, BER: %.1f%%, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits), m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
||||||
else
|
else
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds, BER: %.1f%%", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits));
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds, BER: %.1f%%", float(m_rfFrames) / 10.0F, float(m_rfErrs * 100U) / float(m_rfBits));
|
||||||
|
|
||||||
writeEndRF();
|
writeEndRF();
|
||||||
}
|
}
|
||||||
@@ -540,7 +487,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
m_lastFICH.setFN(fn);
|
m_lastFICH.setFN(fn);
|
||||||
}
|
}
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
unsigned char fn = m_lastFICH.getFN();
|
unsigned char fn = m_lastFICH.getFN();
|
||||||
unsigned char dt = m_lastFICH.getDT();
|
unsigned char dt = m_lastFICH.getDT();
|
||||||
@@ -552,7 +499,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
m_rfErrs += errors;
|
m_rfErrs += errors;
|
||||||
m_rfBits += 235U;
|
m_rfBits += 235U;
|
||||||
m_display->writeFusionBER(float(errors) / 2.35F);
|
m_display->writeFusionBER(float(errors) / 2.35F);
|
||||||
LogDebug("YSF, V/D Mode 1, seq %u, AMBE FEC %u/235 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 2.35F);
|
LogDebug("NXDN, V/D Mode 1, seq %u, AMBE FEC %u/235 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 2.35F);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
@@ -562,7 +509,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
m_rfErrs += errors;
|
m_rfErrs += errors;
|
||||||
m_rfBits += 135U;
|
m_rfBits += 135U;
|
||||||
m_display->writeFusionBER(float(errors) / 1.35F);
|
m_display->writeFusionBER(float(errors) / 1.35F);
|
||||||
LogDebug("YSF, V/D Mode 2, seq %u, Repetition FEC %u/135 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 1.35F);
|
LogDebug("NXDN, V/D Mode 2, seq %u, Repetition FEC %u/135 (%.1f%%)", m_rfFrames % 128, errors, float(errors) / 1.35F);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
@@ -583,12 +530,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
writeNetwork(data, m_rfFrames % 128U);
|
writeNetwork(data, m_rfFrames % 128U);
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -638,7 +580,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
if (m_selfOnly) {
|
if (m_selfOnly) {
|
||||||
bool ret = checkCallsign(m_rfSource);
|
bool ret = checkCallsign(m_rfSource);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
LogMessage("YSF, invalid access attempt from %10.10s", m_rfSource);
|
LogMessage("NXDN, invalid access attempt from %10.10s", m_rfSource);
|
||||||
m_rfState = RS_RF_REJECTED;
|
m_rfState = RS_RF_REJECTED;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -661,7 +603,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
// Build a new header and transmit it
|
// Build a new header and transmit it
|
||||||
unsigned char buffer[YSF_FRAME_LENGTH_BYTES + 2U];
|
unsigned char buffer[YSF_FRAME_LENGTH_BYTES + 2U];
|
||||||
|
|
||||||
CSync::addYSFSync(buffer + 2U);
|
CSync::addNXDNSync(buffer + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
fich.setFI(YSF_FI_HEADER);
|
fich.setFI(YSF_FI_HEADER);
|
||||||
@@ -687,12 +629,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
writeNetwork(buffer, m_rfFrames % 128U);
|
writeNetwork(buffer, m_rfFrames % 128U);
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(buffer + 2U);
|
fich.encode(buffer + 2U);
|
||||||
writeQueueRF(buffer);
|
writeQueueRF(buffer);
|
||||||
}
|
}
|
||||||
@@ -702,9 +639,9 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
||||||
LogMessage("YSF, received RF late entry from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
LogMessage("NXDN, received RF late entry from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
fich = m_lastFICH;
|
fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -719,12 +656,7 @@ bool CNXDNControl::processDNData(bool valid, unsigned char *data)
|
|||||||
writeNetwork(data, m_rfFrames % 128U);
|
writeNetwork(data, m_rfFrames % 128U);
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -758,7 +690,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
if (m_selfOnly) {
|
if (m_selfOnly) {
|
||||||
bool ret = checkCallsign(m_rfSource);
|
bool ret = checkCallsign(m_rfSource);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
LogMessage("YSF, invalid access attempt from %10.10s", m_rfSource);
|
LogMessage("NXDN, invalid access attempt from %10.10s", m_rfSource);
|
||||||
m_rfState = RS_RF_REJECTED;
|
m_rfState = RS_RF_REJECTED;
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
@@ -782,9 +714,9 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
m_display->writeFusion((char*)m_rfSource, (char*)m_rfDest, "R", " ");
|
||||||
LogMessage("YSF, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
LogMessage("NXDN, received RF header from %10.10s to %10.10s", m_rfSource, m_rfDest);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -803,12 +735,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -828,7 +755,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
} else if (m_rfState == RS_RF_DATA) {
|
} else if (m_rfState == RS_RF_DATA) {
|
||||||
m_rfPayload.processHeaderData(data + 2U);
|
m_rfPayload.processHeaderData(data + 2U);
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
CYSFFICH fich = m_lastFICH;
|
CYSFFICH fich = m_lastFICH;
|
||||||
|
|
||||||
@@ -847,12 +774,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -860,9 +782,9 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
m_rfFrames++;
|
m_rfFrames++;
|
||||||
|
|
||||||
if (m_rssi != 0U)
|
if (m_rssi != 0U)
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds, RSSI: -%u/-%u/-%u dBm", float(m_rfFrames) / 10.0F, m_minRSSI, m_maxRSSI, m_aveRSSI / m_rssiCount);
|
||||||
else
|
else
|
||||||
LogMessage("YSF, received RF end of transmission, %.1f seconds", float(m_rfFrames) / 10.0F);
|
LogMessage("NXDN, received RF end of transmission, %.1f seconds", float(m_rfFrames) / 10.0F);
|
||||||
|
|
||||||
writeEndRF();
|
writeEndRF();
|
||||||
}
|
}
|
||||||
@@ -879,7 +801,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
m_lastFICH.setFN(fn);
|
m_lastFICH.setFN(fn);
|
||||||
}
|
}
|
||||||
|
|
||||||
CSync::addYSFSync(data + 2U);
|
CSync::addNXDNSync(data + 2U);
|
||||||
|
|
||||||
unsigned char fn = m_lastFICH.getFN();
|
unsigned char fn = m_lastFICH.getFN();
|
||||||
|
|
||||||
@@ -898,12 +820,7 @@ bool CNXDNControl::processFRData(bool valid, unsigned char *data)
|
|||||||
writeNetwork(data, m_rfFrames % 128U);
|
writeNetwork(data, m_rfFrames % 128U);
|
||||||
|
|
||||||
if (m_duplex) {
|
if (m_duplex) {
|
||||||
// Add the DSQ information.
|
|
||||||
fich.setSQL(m_sqlEnabled);
|
|
||||||
fich.setSQ(m_sqlValue);
|
|
||||||
|
|
||||||
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
fich.setMR(m_remoteGateway ? YSF_MR_NOT_BUSY : YSF_MR_BUSY);
|
||||||
fich.setDev(m_lowDeviation);
|
|
||||||
fich.encode(data + 2U);
|
fich.encode(data + 2U);
|
||||||
writeQueueRF(data);
|
writeQueueRF(data);
|
||||||
}
|
}
|
||||||
@@ -1237,8 +1154,3 @@ void CNXDNControl::closeFile()
|
|||||||
m_fp = NULL;
|
m_fp = NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
bool CNXDNControl::checkCallsign(const unsigned char* callsign) const
|
|
||||||
{
|
|
||||||
return ::memcmp(callsign, m_selfCallsign, ::strlen((char*)m_selfCallsign)) == 0;
|
|
||||||
}
|
|
||||||
|
|||||||
@@ -35,11 +35,9 @@
|
|||||||
|
|
||||||
class CNXDNControl {
|
class CNXDNControl {
|
||||||
public:
|
public:
|
||||||
CNXDNControl(const std::string& callsign, bool selfOnly, CYSFNetwork* network, CDisplay* display, unsigned int timeout, bool duplex, bool lowDeviation, bool remoteGateway, CRSSIInterpolator* rssiMapper);
|
CNXDNControl(const std::string& callsign, bool selfOnly, CYSFNetwork* network, CDisplay* display, unsigned int timeout, bool duplex, bool remoteGateway, CRSSIInterpolator* rssiMapper);
|
||||||
~CNXDNControl();
|
~CNXDNControl();
|
||||||
|
|
||||||
void setSQL(bool on, unsigned char value);
|
|
||||||
|
|
||||||
bool writeModem(unsigned char* data, unsigned int len);
|
bool writeModem(unsigned char* data, unsigned int len);
|
||||||
|
|
||||||
unsigned int readModem(unsigned char* data);
|
unsigned int readModem(unsigned char* data);
|
||||||
@@ -53,10 +51,7 @@ private:
|
|||||||
CYSFNetwork* m_network;
|
CYSFNetwork* m_network;
|
||||||
CDisplay* m_display;
|
CDisplay* m_display;
|
||||||
bool m_duplex;
|
bool m_duplex;
|
||||||
bool m_lowDeviation;
|
|
||||||
bool m_remoteGateway;
|
bool m_remoteGateway;
|
||||||
bool m_sqlEnabled;
|
|
||||||
unsigned char m_sqlValue;
|
|
||||||
CRingBuffer<unsigned char> m_queue;
|
CRingBuffer<unsigned char> m_queue;
|
||||||
RPT_RF_STATE m_rfState;
|
RPT_RF_STATE m_rfState;
|
||||||
RPT_NET_STATE m_netState;
|
RPT_NET_STATE m_netState;
|
||||||
@@ -103,8 +98,6 @@ private:
|
|||||||
bool openFile();
|
bool openFile();
|
||||||
bool writeFile(const unsigned char* data);
|
bool writeFile(const unsigned char* data);
|
||||||
void closeFile();
|
void closeFile();
|
||||||
|
|
||||||
bool checkCallsign(const unsigned char* callsign) const;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
11
Sync.cpp
11
Sync.cpp
@@ -1,5 +1,5 @@
|
|||||||
/*
|
/*
|
||||||
* Copyright (C) 2015,2016 by Jonathan Naylor G4KLX
|
* Copyright (C) 2015,2016,2018 by Jonathan Naylor G4KLX
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
* This program is free software; you can redistribute it and/or modify
|
||||||
* it under the terms of the GNU General Public License as published by
|
* it under the terms of the GNU General Public License as published by
|
||||||
@@ -22,6 +22,7 @@
|
|||||||
#include "DMRDefines.h"
|
#include "DMRDefines.h"
|
||||||
#include "YSFDefines.h"
|
#include "YSFDefines.h"
|
||||||
#include "P25Defines.h"
|
#include "P25Defines.h"
|
||||||
|
#include "NXDNDefines.h"
|
||||||
|
|
||||||
#include <cstdio>
|
#include <cstdio>
|
||||||
#include <cassert>
|
#include <cassert>
|
||||||
@@ -74,3 +75,11 @@ void CSync::addP25Sync(unsigned char* data)
|
|||||||
|
|
||||||
::memcpy(data, P25_SYNC_BYTES, P25_SYNC_LENGTH_BYTES);
|
::memcpy(data, P25_SYNC_BYTES, P25_SYNC_LENGTH_BYTES);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void CSync::addNXDNSync(unsigned char* data)
|
||||||
|
{
|
||||||
|
assert(data != NULL);
|
||||||
|
|
||||||
|
for (unsigned int i = 0U; i < NXDN_FSW_BYTES_LENGTH; i++)
|
||||||
|
data[i] = (data[i] & ~NXDN_FSW_BYTES_MASK[i]) | NXDN_FSW_BYTES[i];
|
||||||
|
}
|
||||||
|
|||||||
4
Sync.h
4
Sync.h
@@ -1,5 +1,5 @@
|
|||||||
/*
|
/*
|
||||||
* Copyright (C) 2015,2016 by Jonathan Naylor G4KLX
|
* Copyright (C) 2015,2016,2018 by Jonathan Naylor G4KLX
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
* This program is free software; you can redistribute it and/or modify
|
||||||
* it under the terms of the GNU General Public License as published by
|
* it under the terms of the GNU General Public License as published by
|
||||||
@@ -31,6 +31,8 @@ public:
|
|||||||
|
|
||||||
static void addP25Sync(unsigned char* data);
|
static void addP25Sync(unsigned char* data);
|
||||||
|
|
||||||
|
static void addNXDNSync(unsigned char* data);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user