Revert some D-Star slow data changes.

This commit is contained in:
Jonathan Naylor
2025-03-27 18:27:48 +00:00
parent d9d6846751
commit 29af1f9258
4 changed files with 60 additions and 38 deletions

View File

@@ -354,7 +354,6 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
// The sync is regenerated by the modem so can do exact match // The sync is regenerated by the modem so can do exact match
if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) { if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) {
m_rfSlowData.start(); m_rfSlowData.start();
m_rfN = 0U;
m_rfState = RPT_RF_STATE::LATE_ENTRY; m_rfState = RPT_RF_STATE::LATE_ENTRY;
} }
@@ -370,7 +369,7 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
} }
if (m_rfState == RPT_RF_STATE::AUDIO) { if (m_rfState == RPT_RF_STATE::AUDIO) {
m_rfSlowData.peakSlowData(data + 1U, m_rfN); m_rfSlowData.peakSlowData(data + 1U);
unsigned char type = m_rfSlowData.getType(); unsigned char type = m_rfSlowData.getType();
if (type == DSTAR_SLOW_DATA_TYPE_FASTDATA_BEGIN) { if (type == DSTAR_SLOW_DATA_TYPE_FASTDATA_BEGIN) {
@@ -380,6 +379,12 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
} }
if (m_rfState == RPT_RF_STATE::DATA) { if (m_rfState == RPT_RF_STATE::DATA) {
// Send the RSSI data to the display
if (m_rfN == 0U) {
CSync::addDStarSync(data + 1U);
m_display->writeDStarRSSI(m_rssi);
}
LogDebug("D-Star, fast data sequence no. %u", m_rfN); LogDebug("D-Star, fast data sequence no. %u", m_rfN);
m_rfBits += 48U; m_rfBits += 48U;
@@ -391,7 +396,7 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
if (m_duplex) if (m_duplex)
writeQueueDataRF(data); writeQueueDataRF(data);
m_rfSlowData.peakSlowData(data + 1U, m_rfN); m_rfSlowData.peakSlowData(data + 1U);
bool complete = m_rfSlowData.isComplete(); bool complete = m_rfSlowData.isComplete();
if (complete) { if (complete) {
@@ -405,8 +410,10 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
m_rfN = (m_rfN + 1U) % 21U; m_rfN = (m_rfN + 1U) % 21U;
} else if (m_rfState == RPT_RF_STATE::AUDIO) { } else if (m_rfState == RPT_RF_STATE::AUDIO) {
// Send the RSSI data to the display // Send the RSSI data to the display
if (m_rfN == 0U) if (m_rfN == 0U) {
CSync::addDStarSync(data + 1U);
m_display->writeDStarRSSI(m_rssi); m_display->writeDStarRSSI(m_rssi);
}
unsigned int errors = 0U; unsigned int errors = 0U;
if (::memcmp(data + 1U, DSTAR_nullptr_AMBE_DATA_BYTES_SCRAMBLED, DSTAR_VOICE_FRAME_LENGTH_BYTES) == 0) { if (::memcmp(data + 1U, DSTAR_nullptr_AMBE_DATA_BYTES_SCRAMBLED, DSTAR_VOICE_FRAME_LENGTH_BYTES) == 0) {
@@ -422,7 +429,7 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
m_rfFrames++; m_rfFrames++;
if (m_rfN != 0U) { if (m_rfN != 0U) {
const unsigned char* text = m_rfSlowData.addText(data + 1U, m_rfN); const unsigned char* text = m_rfSlowData.addText(data + 1U);
if (text != nullptr) if (text != nullptr)
LogMessage("D-Star, RF slow data text = \"%s\"", text); LogMessage("D-Star, RF slow data text = \"%s\"", text);
} }
@@ -442,14 +449,11 @@ bool CDStarControl::writeModem(unsigned char *data, unsigned int len)
// The sync is regenerated by the modem so can do exact match // The sync is regenerated by the modem so can do exact match
if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) { if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) {
m_rfSlowData.reset(); m_rfSlowData.reset();
m_rfN = 0U;
return false; return false;
} else { } else {
CDStarHeader* header = m_rfSlowData.addHeader(data + 1U, m_rfN); CDStarHeader* header = m_rfSlowData.addHeader(data + 1U);
if (header == nullptr) { if (header == nullptr)
m_rfN = (m_rfN + 1U) % 21U;
return false; return false;
}
m_rfHeader = *header; m_rfHeader = *header;
delete header; delete header;
@@ -744,7 +748,7 @@ void CDStarControl::writeNetwork()
if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) { if (::memcmp(data + 1U + DSTAR_VOICE_FRAME_LENGTH_BYTES, DSTAR_SYNC_BYTES, DSTAR_DATA_FRAME_LENGTH_BYTES) == 0) {
m_netSlowData.start(); m_netSlowData.start();
} else { } else {
m_netSlowData.peakSlowData(data + 1U, n); m_netSlowData.peakSlowData(data + 1U);
if (m_netState == RPT_NET_STATE::AUDIO) { if (m_netState == RPT_NET_STATE::AUDIO) {
unsigned char type = m_netSlowData.getType(); unsigned char type = m_netSlowData.getType();
@@ -782,7 +786,7 @@ void CDStarControl::writeNetwork()
CSync::addDStarSync(data + 2U); CSync::addDStarSync(data + 2U);
m_netSlowData.start(); m_netSlowData.start();
} else { } else {
const unsigned char* text = m_netSlowData.addText(data + 2U, m_netN); const unsigned char* text = m_netSlowData.addText(data + 2U);
if (text != nullptr) if (text != nullptr)
LogMessage("D-Star, network slow data text = \"%s\"", text); LogMessage("D-Star, network slow data text = \"%s\"", text);
} }
@@ -808,7 +812,7 @@ void CDStarControl::writeNetwork()
CSync::addDStarSync(data + 2U); CSync::addDStarSync(data + 2U);
m_netSlowData.start(); m_netSlowData.start();
} else { } else {
m_netSlowData.peakSlowData(data + 2U, m_netN); m_netSlowData.peakSlowData(data + 2U);
bool complete = m_netSlowData.isComplete(); bool complete = m_netSlowData.isComplete();
if (complete) { if (complete) {
unsigned char type = m_netSlowData.getType(); unsigned char type = m_netSlowData.getType();

View File

@@ -33,8 +33,8 @@ m_buffer(nullptr),
m_text(nullptr), m_text(nullptr),
m_textPtr(0U), m_textPtr(0U),
m_textBits(0x00U), m_textBits(0x00U),
m_type(0x00U), m_state(SDD_STATE::FIRST),
m_complete(false) m_type(0x00U)
{ {
m_header = new unsigned char[50U]; // DSTAR_HEADER_LENGTH_BYTES m_header = new unsigned char[50U]; // DSTAR_HEADER_LENGTH_BYTES
m_buffer = new unsigned char[DSTAR_DATA_FRAME_LENGTH_BYTES * 2U]; m_buffer = new unsigned char[DSTAR_DATA_FRAME_LENGTH_BYTES * 2U];
@@ -48,33 +48,41 @@ CDStarSlowData::~CDStarSlowData()
delete[] m_text; delete[] m_text;
} }
void CDStarSlowData::peakSlowData(const unsigned char* data, unsigned int n) void CDStarSlowData::peakSlowData(const unsigned char* data)
{ {
assert(data != nullptr); assert(data != nullptr);
if ((n % 2U) == 0U) { switch (m_state) {
case SDD_STATE::FIRST:
m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_complete = false; m_state = SDD_STATE::SECOND;
} else { break;
m_complete = true;
case SDD_STATE::SECOND:
m_state = SDD_STATE::FIRST;
break;
} }
} }
CDStarHeader* CDStarSlowData::addHeader(const unsigned char* data, unsigned int n) CDStarHeader* CDStarSlowData::addHeader(const unsigned char* data)
{ {
assert(data != nullptr); assert(data != nullptr);
if ((n % 2U) == 0U) { switch (m_state) {
case SDD_STATE::FIRST:
m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[0U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_buffer[0U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[1U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U]; m_buffer[1U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U];
m_buffer[2U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U]; m_buffer[2U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U];
m_complete = false; m_state = SDD_STATE::SECOND;
} else { return nullptr;
case SDD_STATE::SECOND:
m_buffer[3U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_buffer[3U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[4U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U]; m_buffer[4U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U];
m_buffer[5U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U]; m_buffer[5U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U];
m_complete = true; m_state = SDD_STATE::FIRST;
break;
} }
if ((m_buffer[0U] & DSTAR_SLOW_DATA_TYPE_MASK) != DSTAR_SLOW_DATA_TYPE_HEADER) if ((m_buffer[0U] & DSTAR_SLOW_DATA_TYPE_MASK) != DSTAR_SLOW_DATA_TYPE_HEADER)
@@ -105,21 +113,25 @@ CDStarHeader* CDStarSlowData::addHeader(const unsigned char* data, unsigned int
return new CDStarHeader(m_header); return new CDStarHeader(m_header);
} }
const unsigned char* CDStarSlowData::addText(const unsigned char* data, unsigned int n) const unsigned char* CDStarSlowData::addText(const unsigned char* data)
{ {
assert(data != nullptr); assert(data != nullptr);
if ((n % 2U) == 0U) { switch (m_state) {
case SDD_STATE::FIRST:
m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_type = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[0U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_buffer[0U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[1U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U]; m_buffer[1U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U];
m_buffer[2U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U]; m_buffer[2U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U];
m_complete = false; m_state = SDD_STATE::SECOND;
} else { return nullptr;
case SDD_STATE::SECOND:
m_buffer[3U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U]; m_buffer[3U] = data[9U] ^ DSTAR_SCRAMBLER_BYTES[0U];
m_buffer[4U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U]; m_buffer[4U] = data[10U] ^ DSTAR_SCRAMBLER_BYTES[1U];
m_buffer[5U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U]; m_buffer[5U] = data[11U] ^ DSTAR_SCRAMBLER_BYTES[2U];
m_complete = true; m_state = SDD_STATE::FIRST;
break;
} }
switch (m_buffer[0U]) { switch (m_buffer[0U]) {
@@ -179,16 +191,16 @@ void CDStarSlowData::start()
::memset(m_header, 0x00U, DSTAR_HEADER_LENGTH_BYTES); ::memset(m_header, 0x00U, DSTAR_HEADER_LENGTH_BYTES);
m_ptr = 0U; m_ptr = 0U;
m_state = SDD_STATE::FIRST;
m_type = 0x00U; m_type = 0x00U;
m_complete = false;
m_textBits = 0x00U; m_textBits = 0x00U;
} }
void CDStarSlowData::reset() void CDStarSlowData::reset()
{ {
m_ptr = 0U; m_ptr = 0U;
m_state = SDD_STATE::FIRST;
m_type = 0x00U; m_type = 0x00U;
m_complete = false;
m_textBits = 0x00U; m_textBits = 0x00U;
} }
@@ -250,5 +262,5 @@ unsigned char CDStarSlowData::getType() const
bool CDStarSlowData::isComplete() const bool CDStarSlowData::isComplete() const
{ {
return m_complete; return m_state == SDD_STATE::FIRST;
} }

View File

@@ -26,11 +26,11 @@ public:
CDStarSlowData(); CDStarSlowData();
~CDStarSlowData(); ~CDStarSlowData();
void peakSlowData(const unsigned char* data, unsigned int n); void peakSlowData(const unsigned char* data);
CDStarHeader* addHeader(const unsigned char* data, unsigned int n); CDStarHeader* addHeader(const unsigned char* data);
const unsigned char* addText(const unsigned char* data, unsigned int n); const unsigned char* addText(const unsigned char* data);
unsigned char getType() const; unsigned char getType() const;
bool isComplete() const; bool isComplete() const;
@@ -48,8 +48,14 @@ private:
unsigned char* m_text; unsigned char* m_text;
unsigned int m_textPtr; unsigned int m_textPtr;
unsigned char m_textBits; unsigned char m_textBits;
enum class SDD_STATE {
FIRST,
SECOND
};
SDD_STATE m_state;
unsigned char m_type; unsigned char m_type;
bool m_complete;
}; };
#endif #endif

View File

@@ -19,6 +19,6 @@
#if !defined(VERSION_H) #if !defined(VERSION_H)
#define VERSION_H #define VERSION_H
const char* VERSION = "20250314"; const char* VERSION = "20250327";
#endif #endif