Superminaren
/
MMDVM
mirror of https://github.com/g4klx/MMDVM.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Revert the DMR changes.

This commit is contained in:
Jonathan Naylor 2017-01-29 18:51:33 +00:00
parent 37daa04a6c
commit 609c2ead53
4 changed files with 95 additions and 137 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

96
DMRDMORX.cpp
View File

@ -46,18 +46,12 @@ m_bitBuffer(),
m_buffer(), m_buffer(),
m_bitPtr(0U), m_bitPtr(0U),
m_dataPtr(0U), m_dataPtr(0U),
m_syncPtr(NOENDPTR), m_syncPtr(0U),
m_startPtr(0U), m_startPtr(0U),
m_endPtr(NOENDPTR), m_endPtr(NOENDPTR),
m_minSyncPtr(NOENDPTR),
m_maxSyncPtr(NOENDPTR),
m_maxCorr(0), m_maxCorr(0),
m_centre(), m_centre(),
m_centreVal(0),
m_centreBest(0),
m_threshold(), m_threshold(),
m_thresholdVal(0),
m_thresholdBest(0),
m_averagePtr(0U), m_averagePtr(0U),
m_control(CONTROL_NONE), m_control(CONTROL_NONE),
m_syncCount(0U), m_syncCount(0U),
@ -71,19 +65,13 @@ m_rssi()
void CDMRDMORX::reset() void CDMRDMORX::reset()
{ {
m_syncPtr = NOENDPTR; m_syncPtr = 0U;
m_minSyncPtr = NOENDPTR;
m_maxSyncPtr = NOENDPTR;
m_maxCorr = 0; m_maxCorr = 0;
m_control = CONTROL_NONE; m_control = CONTROL_NONE;
m_syncCount = 0U; m_syncCount = 0U;
m_state = DMORXS_NONE; m_state = DMORXS_NONE;
m_startPtr = 0U; m_startPtr = 0U;
m_endPtr = NOENDPTR; m_endPtr = NOENDPTR;
m_centreVal = 0;
m_centreBest = 0;
m_thresholdVal = 0;
m_thresholdBest = 0;
} }
void CDMRDMORX::samples(const q15_t* samples, const uint16_t* rssi, uint8_t length) void CDMRDMORX::samples(const q15_t* samples, const uint16_t* rssi, uint8_t length)
@ -94,7 +82,6 @@ void CDMRDMORX::samples(const q15_t* samples, const uint16_t* rssi, uint8_t leng
dcd = processSample(samples[i], rssi[i]); dcd = processSample(samples[i], rssi[i]);
io.setDecode(dcd); io.setDecode(dcd);
io.setADCDetection(dcd);
} }
bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi) bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
@ -109,36 +96,28 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
if (m_state == DMORXS_NONE) { if (m_state == DMORXS_NONE) {
correlateSync(true); correlateSync(true);
} else { } else {
if (m_minSyncPtr < m_maxSyncPtr) {
if (m_dataPtr >= m_minSyncPtr && m_dataPtr <= m_maxSyncPtr) uint16_t min = m_syncPtr + DMO_BUFFER_LENGTH_SAMPLES - 1U;
uint16_t max = m_syncPtr + 1U;
if (min >= DMO_BUFFER_LENGTH_SAMPLES)
min -= DMO_BUFFER_LENGTH_SAMPLES;
if (max >= DMO_BUFFER_LENGTH_SAMPLES)
max -= DMO_BUFFER_LENGTH_SAMPLES;
if (min < max) {
if (m_dataPtr >= min && m_dataPtr <= max)
correlateSync(false); correlateSync(false);
} else { } else {
if (m_dataPtr >= m_minSyncPtr || m_dataPtr <= m_maxSyncPtr) if (m_dataPtr >= min || m_dataPtr <= max)
correlateSync(false); correlateSync(false);
} }
} }
if (m_dataPtr == m_endPtr) { if (m_dataPtr == m_endPtr) {
if (m_control == CONTROL_DATA || m_control == CONTROL_VOICE) {
m_threshold[m_averagePtr] = m_thresholdBest;
m_centre[m_averagePtr] = m_centreBest;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
// Find the average centre and threshold values // Find the average centre and threshold values
m_centreVal = (m_centre[0U] + m_centre[1U] + m_centre[2U] + m_centre[3U]) >> 2; q15_t centre = (m_centre[0U] + m_centre[1U] + m_centre[2U] + m_centre[3U]) >> 2;
m_thresholdVal = (m_threshold[0U] + m_threshold[1U] + m_threshold[2U] + m_threshold[3U]) >> 2; q15_t threshold = (m_threshold[0U] + m_threshold[1U] + m_threshold[2U] + m_threshold[3U]) >> 2;
m_minSyncPtr = m_syncPtr + DMO_BUFFER_LENGTH_SAMPLES - 1U;
if (m_minSyncPtr >= DMO_BUFFER_LENGTH_SAMPLES)
m_minSyncPtr -= DMO_BUFFER_LENGTH_SAMPLES;
m_maxSyncPtr = m_syncPtr + 1U;
if (m_maxSyncPtr >= DMO_BUFFER_LENGTH_SAMPLES)
m_maxSyncPtr -= DMO_BUFFER_LENGTH_SAMPLES;
}
uint8_t frame[DMR_FRAME_LENGTH_BYTES + 3U]; uint8_t frame[DMR_FRAME_LENGTH_BYTES + 3U];
frame[0U] = m_control; frame[0U] = m_control;
@ -147,7 +126,7 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
if (ptr >= DMO_BUFFER_LENGTH_SAMPLES) if (ptr >= DMO_BUFFER_LENGTH_SAMPLES)
ptr -= DMO_BUFFER_LENGTH_SAMPLES; ptr -= DMO_BUFFER_LENGTH_SAMPLES;
samplesToBits(ptr, DMR_FRAME_LENGTH_SYMBOLS, frame, 8U, m_centreVal, m_thresholdVal); samplesToBits(ptr, DMR_FRAME_LENGTH_SYMBOLS, frame, 8U, centre, threshold);
if (m_control == CONTROL_DATA) { if (m_control == CONTROL_DATA) {
// Data sync // Data sync
@ -164,7 +143,7 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
switch (dataType) { switch (dataType) {
case DT_DATA_HEADER: case DT_DATA_HEADER:
DEBUG4("DMRDMORX: data header found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: data header found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMORXS_DATA; m_state = DMORXS_DATA;
m_type = 0x00U; m_type = 0x00U;
@ -173,32 +152,32 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
case DT_RATE_34_DATA: case DT_RATE_34_DATA:
case DT_RATE_1_DATA: case DT_RATE_1_DATA:
if (m_state == DMORXS_DATA) { if (m_state == DMORXS_DATA) {
DEBUG4("DMRDMORX: data payload found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: data payload found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_type = dataType; m_type = dataType;
} }
break; break;
case DT_VOICE_LC_HEADER: case DT_VOICE_LC_HEADER:
DEBUG4("DMRDMORX: voice header found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: voice header found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMORXS_VOICE; m_state = DMORXS_VOICE;
break; break;
case DT_VOICE_PI_HEADER: case DT_VOICE_PI_HEADER:
if (m_state == DMORXS_VOICE) { if (m_state == DMORXS_VOICE) {
DEBUG4("DMRDMORX: voice pi header found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: voice pi header found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
} }
m_state = DMORXS_VOICE; m_state = DMORXS_VOICE;
break; break;
case DT_TERMINATOR_WITH_LC: case DT_TERMINATOR_WITH_LC:
if (m_state == DMORXS_VOICE) { if (m_state == DMORXS_VOICE) {
DEBUG4("DMRDMORX: voice terminator found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: voice terminator found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
reset(); reset();
} }
break; break;
default: // DT_CSBK default: // DT_CSBK
DEBUG4("DMRDMORX: csbk found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: csbk found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
reset(); reset();
break; break;
@ -206,7 +185,7 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
} }
} else if (m_control == CONTROL_VOICE) { } else if (m_control == CONTROL_VOICE) {
// Voice sync // Voice sync
DEBUG4("DMRDMORX: voice sync found pos/centre/threshold", m_syncPtr, m_centreVal, m_thresholdVal); DEBUG4("DMRDMORX: voice sync found pos/centre/threshold", m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMORXS_VOICE; m_state = DMORXS_VOICE;
m_syncCount = 0U; m_syncCount = 0U;
@ -307,10 +286,7 @@ void CDMRDMORX::correlateSync(bool first)
if (ptr >= DMO_BUFFER_LENGTH_SAMPLES) if (ptr >= DMO_BUFFER_LENGTH_SAMPLES)
ptr -= DMO_BUFFER_LENGTH_SAMPLES; ptr -= DMO_BUFFER_LENGTH_SAMPLES;
if (first)
samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, centre, threshold); samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, centre, threshold);
else
samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, m_centreVal, m_thresholdVal);
if (data1 || data2) { if (data1 || data2) {
uint8_t errs = 0U; uint8_t errs = 0U;
@ -323,12 +299,16 @@ void CDMRDMORX::correlateSync(bool first)
if (errs <= MAX_SYNC_BYTES_ERRS) { if (errs <= MAX_SYNC_BYTES_ERRS) {
if (first) { if (first) {
m_thresholdBest = m_thresholdVal = m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold; m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold;
m_centreBest = m_centreVal = m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre; m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre;
m_averagePtr = 0U; m_averagePtr = 0U;
} else { } else {
m_thresholdBest = threshold; m_threshold[m_averagePtr] = threshold;
m_centreBest = centre; m_centre[m_averagePtr] = centre;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
} }
m_maxCorr = corr; m_maxCorr = corr;
@ -354,12 +334,16 @@ void CDMRDMORX::correlateSync(bool first)
if (errs <= MAX_SYNC_BYTES_ERRS) { if (errs <= MAX_SYNC_BYTES_ERRS) {
if (first) { if (first) {
m_thresholdBest = m_thresholdVal = m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold; m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold;
m_centreBest = m_centreVal = m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre; m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre;
m_averagePtr = 0U; m_averagePtr = 0U;
} else { } else {
m_thresholdBest = threshold; m_threshold[m_averagePtr] = threshold;
m_centreBest = centre; m_centre[m_averagePtr] = centre;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
} }
m_maxCorr = corr; m_maxCorr = corr;

6
DMRDMORX.h
View File

@ -48,15 +48,9 @@ private:
uint16_t m_syncPtr; uint16_t m_syncPtr;
uint16_t m_startPtr; uint16_t m_startPtr;
uint16_t m_endPtr; uint16_t m_endPtr;
uint16_t m_minSyncPtr;
uint16_t m_maxSyncPtr;
q31_t m_maxCorr; q31_t m_maxCorr;
q15_t m_centre[4U]; q15_t m_centre[4U];
q15_t m_centreVal;
q15_t m_centreBest;
q15_t m_threshold[4U]; q15_t m_threshold[4U];
q15_t m_thresholdVal;
q15_t m_thresholdBest;
uint8_t m_averagePtr; uint8_t m_averagePtr;
uint8_t m_control; uint8_t m_control;
uint8_t m_syncCount; uint8_t m_syncCount;

70
DMRSlotRX.cpp
View File

@ -56,11 +56,7 @@ m_endPtr(NOENDPTR),
m_delayPtr(0U), m_delayPtr(0U),
m_maxCorr(0), m_maxCorr(0),
m_centre(), m_centre(),
m_centreVal(0),
m_centreBest(0),
m_threshold(), m_threshold(),
m_thresholdVal(0),
m_thresholdBest(0),
m_averagePtr(0U), m_averagePtr(0U),
m_control(CONTROL_NONE), m_control(CONTROL_NONE),
m_syncCount(0U), m_syncCount(0U),
@ -80,10 +76,6 @@ void CDMRSlotRX::start()
m_bitPtr = 0U; m_bitPtr = 0U;
m_maxCorr = 0; m_maxCorr = 0;
m_control = CONTROL_NONE; m_control = CONTROL_NONE;
m_centreVal = 0;
m_centreBest = 0;
m_thresholdVal = 0;
m_thresholdBest = 0;
} }
void CDMRSlotRX::reset() void CDMRSlotRX::reset()
@ -98,10 +90,6 @@ void CDMRSlotRX::reset()
m_state = DMRRXS_NONE; m_state = DMRRXS_NONE;
m_startPtr = 0U; m_startPtr = 0U;
m_endPtr = NOENDPTR; m_endPtr = NOENDPTR;
m_centreVal = 0;
m_centreBest = 0;
m_thresholdVal = 0;
m_thresholdBest = 0;
} }
bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi) bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
@ -125,6 +113,7 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
if (m_dataPtr >= SCAN_START && m_dataPtr <= SCAN_END) if (m_dataPtr >= SCAN_START && m_dataPtr <= SCAN_END)
correlateSync(true); correlateSync(true);
} else { } else {
uint16_t min = m_syncPtr - 1U; uint16_t min = m_syncPtr - 1U;
uint16_t max = m_syncPtr + 1U; uint16_t max = m_syncPtr + 1U;
if (m_dataPtr >= min && m_dataPtr <= max) if (m_dataPtr >= min && m_dataPtr <= max)
@ -132,24 +121,15 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
} }
if (m_dataPtr == m_endPtr) { if (m_dataPtr == m_endPtr) {
if (m_control == CONTROL_DATA || m_control == CONTROL_VOICE) {
m_threshold[m_averagePtr] = m_thresholdBest;
m_centre[m_averagePtr] = m_centreBest;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
// Find the average centre and threshold values // Find the average centre and threshold values
m_centreVal = (m_centre[0U] + m_centre[1U] + m_centre[2U] + m_centre[3U]) >> 2; q15_t centre = (m_centre[0U] + m_centre[1U] + m_centre[2U] + m_centre[3U]) >> 2;
m_thresholdVal = (m_threshold[0U] + m_threshold[1U] + m_threshold[2U] + m_threshold[3U]) >> 2; q15_t threshold = (m_threshold[0U] + m_threshold[1U] + m_threshold[2U] + m_threshold[3U]) >> 2;
}
uint8_t frame[DMR_FRAME_LENGTH_BYTES + 3U]; uint8_t frame[DMR_FRAME_LENGTH_BYTES + 3U];
frame[0U] = m_control; frame[0U] = m_control;
uint16_t ptr = m_endPtr - DMR_FRAME_LENGTH_SAMPLES + DMR_RADIO_SYMBOL_LENGTH + 1U; uint16_t ptr = m_endPtr - DMR_FRAME_LENGTH_SAMPLES + DMR_RADIO_SYMBOL_LENGTH + 1U;
samplesToBits(ptr, DMR_FRAME_LENGTH_SYMBOLS, frame, 8U, m_centreVal, m_thresholdVal); samplesToBits(ptr, DMR_FRAME_LENGTH_SYMBOLS, frame, 8U, centre, threshold);
if (m_control == CONTROL_DATA) { if (m_control == CONTROL_DATA) {
// Data sync // Data sync
@ -166,7 +146,7 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
switch (dataType) { switch (dataType) {
case DT_DATA_HEADER: case DT_DATA_HEADER:
DEBUG5("DMRSlotRX: data header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: data header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMRRXS_DATA; m_state = DMRRXS_DATA;
m_type = 0x00U; m_type = 0x00U;
@ -175,33 +155,33 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
case DT_RATE_34_DATA: case DT_RATE_34_DATA:
case DT_RATE_1_DATA: case DT_RATE_1_DATA:
if (m_state == DMRRXS_DATA) { if (m_state == DMRRXS_DATA) {
DEBUG5("DMRSlotRX: data payload found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: data payload found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_type = dataType; m_type = dataType;
} }
break; break;
case DT_VOICE_LC_HEADER: case DT_VOICE_LC_HEADER:
DEBUG5("DMRSlotRX: voice header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: voice header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMRRXS_VOICE; m_state = DMRRXS_VOICE;
break; break;
case DT_VOICE_PI_HEADER: case DT_VOICE_PI_HEADER:
if (m_state == DMRRXS_VOICE) { if (m_state == DMRRXS_VOICE) {
DEBUG5("DMRSlotRX: voice pi header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: voice pi header found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
} }
m_state = DMRRXS_VOICE; m_state = DMRRXS_VOICE;
break; break;
case DT_TERMINATOR_WITH_LC: case DT_TERMINATOR_WITH_LC:
if (m_state == DMRRXS_VOICE) { if (m_state == DMRRXS_VOICE) {
DEBUG5("DMRSlotRX: voice terminator found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: voice terminator found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMRRXS_NONE; m_state = DMRRXS_NONE;
m_endPtr = NOENDPTR; m_endPtr = NOENDPTR;
} }
break; break;
default: // DT_CSBK default: // DT_CSBK
DEBUG5("DMRSlotRX: csbk found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: csbk found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMRRXS_NONE; m_state = DMRRXS_NONE;
m_endPtr = NOENDPTR; m_endPtr = NOENDPTR;
@ -210,7 +190,7 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
} }
} else if (m_control == CONTROL_VOICE) { } else if (m_control == CONTROL_VOICE) {
// Voice sync // Voice sync
DEBUG5("DMRSlotRX: voice sync found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, m_centreVal, m_thresholdVal); DEBUG5("DMRSlotRX: voice sync found slot/pos/centre/threshold", m_slot ? 2U : 1U, m_syncPtr, centre, threshold);
writeRSSIData(frame); writeRSSIData(frame);
m_state = DMRRXS_VOICE; m_state = DMRRXS_VOICE;
m_syncCount = 0U; m_syncCount = 0U;
@ -292,11 +272,7 @@ void CDMRSlotRX::correlateSync(bool first)
uint8_t sync[DMR_SYNC_BYTES_LENGTH]; uint8_t sync[DMR_SYNC_BYTES_LENGTH];
uint16_t ptr = m_dataPtr - DMR_SYNC_LENGTH_SAMPLES + DMR_RADIO_SYMBOL_LENGTH; uint16_t ptr = m_dataPtr - DMR_SYNC_LENGTH_SAMPLES + DMR_RADIO_SYMBOL_LENGTH;
if (first)
samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, centre, threshold); samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, centre, threshold);
else
samplesToBits(ptr, DMR_SYNC_LENGTH_SYMBOLS, sync, 4U, m_centreVal, m_thresholdVal);
if (data) { if (data) {
uint8_t errs = 0U; uint8_t errs = 0U;
@ -305,12 +281,16 @@ void CDMRSlotRX::correlateSync(bool first)
if (errs <= MAX_SYNC_BYTES_ERRS) { if (errs <= MAX_SYNC_BYTES_ERRS) {
if (first) { if (first) {
m_thresholdBest = m_thresholdVal = m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold; m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold;
m_centreBest = m_centreVal = m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre; m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre;
m_averagePtr = 0U; m_averagePtr = 0U;
} else { } else {
m_thresholdBest = threshold; m_threshold[m_averagePtr] = threshold;
m_centreBest = centre; m_centre[m_averagePtr] = centre;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
} }
m_maxCorr = corr; m_maxCorr = corr;
@ -326,12 +306,16 @@ void CDMRSlotRX::correlateSync(bool first)
if (errs <= MAX_SYNC_BYTES_ERRS) { if (errs <= MAX_SYNC_BYTES_ERRS) {
if (first) { if (first) {
m_thresholdBest = m_thresholdVal = m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold; m_threshold[0U] = m_threshold[1U] = m_threshold[2U] = m_threshold[3U] = threshold;
m_centreBest = m_centreVal = m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre; m_centre[0U] = m_centre[1U] = m_centre[2U] = m_centre[3U] = centre;
m_averagePtr = 0U; m_averagePtr = 0U;
} else { } else {
m_thresholdBest = threshold; m_threshold[m_averagePtr] = threshold;
m_centreBest = centre; m_centre[m_averagePtr] = centre;
m_averagePtr++;
if (m_averagePtr >= 4U)
m_averagePtr = 0U;
} }
m_maxCorr = corr; m_maxCorr = corr;

4
DMRSlotRX.h
View File

@ -53,11 +53,7 @@ private:
uint16_t m_delayPtr; uint16_t m_delayPtr;
q31_t m_maxCorr; q31_t m_maxCorr;
q15_t m_centre[4U]; q15_t m_centre[4U];
q15_t m_centreVal;
q15_t m_centreBest;
q15_t m_threshold[4U]; q15_t m_threshold[4U];
q15_t m_thresholdVal;
q15_t m_thresholdBest;
uint8_t m_averagePtr; uint8_t m_averagePtr;
uint8_t m_control; uint8_t m_control;
uint8_t m_syncCount; uint8_t m_syncCount;