mirror of
https://github.com/g4klx/MMDVMHost
synced 2025-12-21 06:55:52 +08:00
Revert some D-Star slow data changes.
This commit is contained in:
@@ -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();
|
||||||
|
|||||||
@@ -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;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -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
|
||||||
|
|||||||
Reference in New Issue
Block a user