mirror of https://github.com/markqvist/MMDVM.git
Remove any DC offset from before any further filtering takes place.
parent
9d1ebc0f8f
commit
8540964097
|
@ -88,7 +88,7 @@ bool CDMRDMORX::processSample(q15_t sample, uint16_t rssi)
|
|||
m_rssi[m_dataPtr] = rssi;
|
||||
|
||||
m_bitBuffer[m_bitPtr] <<= 1;
|
||||
if (sample < m_dcLevel)
|
||||
if (sample < 0)
|
||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||
|
||||
if (m_state == DMORXS_NONE) {
|
||||
|
|
|
@ -104,7 +104,7 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
|
|||
m_rssi[m_dataPtr] = rssi;
|
||||
|
||||
m_bitBuffer[m_bitPtr] <<= 1;
|
||||
if (sample < m_dcLevel)
|
||||
if (sample < 0)
|
||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||
|
||||
if (m_state == DMRRXS_NONE) {
|
||||
|
|
|
@ -279,7 +279,7 @@ void CDStarRX::samples(const q15_t* samples, const uint16_t* rssi, uint8_t lengt
|
|||
m_rssiAccum += rssi[i];
|
||||
m_rssiCount++;
|
||||
|
||||
bool bit = samples[i] < m_dcLevel;
|
||||
bool bit = samples[i] < 0;
|
||||
|
||||
if (bit != m_prev) {
|
||||
if (m_pll < (PLLMAX / 2U))
|
||||
|
|
|
@ -93,8 +93,6 @@ extern bool m_duplex;
|
|||
extern bool m_tx;
|
||||
extern bool m_dcd;
|
||||
|
||||
extern q15_t m_dcLevel;
|
||||
|
||||
extern CSerialPort serial;
|
||||
extern CIO io;
|
||||
|
||||
|
|
14
IO.cpp
14
IO.cpp
|
@ -33,7 +33,7 @@ static q15_t GAUSSIAN_0_5_FILTER[] = {8, 104, 760, 3158, 7421, 9866, 7421, 315
|
|||
const uint16_t GAUSSIAN_0_5_FILTER_LEN = 12U;
|
||||
|
||||
// One symbol boxcar filter
|
||||
static q15_t BOXCAR_FILTER[] = {3000, 3000, 3000, 3000, 3000, 0};
|
||||
static q15_t BOXCAR_FILTER[] = {12000, 12000, 12000, 12000, 12000, 0};
|
||||
const uint16_t BOXCAR_FILTER_LEN = 6U;
|
||||
|
||||
// Generated using [b, a] = butter(1, 0.001) in MATLAB
|
||||
|
@ -171,17 +171,19 @@ void CIO::process()
|
|||
|
||||
q31_t dcLevel = 0;
|
||||
q31_t dcVals[20];
|
||||
q31_t intSamp[20];
|
||||
q31_t q31Samples[20U];
|
||||
|
||||
::arm_q15_to_q31((q15_t*)samples, intSamp, RX_BLOCK_SIZE);
|
||||
::arm_biquad_cascade_df1_q31(&m_dcFilter, intSamp, dcVals, RX_BLOCK_SIZE);
|
||||
::arm_q15_to_q31(samples, q31Samples, RX_BLOCK_SIZE);
|
||||
::arm_biquad_cascade_df1_q31(&m_dcFilter, q31Samples, dcVals, RX_BLOCK_SIZE);
|
||||
|
||||
for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++)
|
||||
dcLevel += dcVals[i];
|
||||
|
||||
dcLevel /= RX_BLOCK_SIZE;
|
||||
|
||||
m_dcLevel = q15_t(dcLevel >> 16);
|
||||
q15_t offset = q15_t(dcLevel >> 16);
|
||||
|
||||
for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++)
|
||||
samples[i] -= offset;
|
||||
|
||||
if (m_modemState == STATE_IDLE) {
|
||||
if (m_dstarEnable) {
|
||||
|
|
|
@ -36,8 +36,6 @@ bool m_duplex = true;
|
|||
bool m_tx = false;
|
||||
bool m_dcd = false;
|
||||
|
||||
q15_t m_dcLevel = 0;
|
||||
|
||||
CDStarRX dstarRX;
|
||||
CDStarTX dstarTX;
|
||||
|
||||
|
|
|
@ -95,7 +95,7 @@ void CP25RX::samples(const q15_t* samples, uint16_t* rssi, uint8_t length)
|
|||
m_rssiCount++;
|
||||
|
||||
m_bitBuffer[m_bitPtr] <<= 1;
|
||||
if (sample < m_dcLevel)
|
||||
if (sample < 0)
|
||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||
|
||||
m_buffer[m_dataPtr] = sample;
|
||||
|
|
Loading…
Reference in New Issue