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_rssi[m_dataPtr] = rssi;
|
||||||
|
|
||||||
m_bitBuffer[m_bitPtr] <<= 1;
|
m_bitBuffer[m_bitPtr] <<= 1;
|
||||||
if (sample < m_dcLevel)
|
if (sample < 0)
|
||||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||||
|
|
||||||
if (m_state == DMORXS_NONE) {
|
if (m_state == DMORXS_NONE) {
|
||||||
|
|
|
@ -104,7 +104,7 @@ bool CDMRSlotRX::processSample(q15_t sample, uint16_t rssi)
|
||||||
m_rssi[m_dataPtr] = rssi;
|
m_rssi[m_dataPtr] = rssi;
|
||||||
|
|
||||||
m_bitBuffer[m_bitPtr] <<= 1;
|
m_bitBuffer[m_bitPtr] <<= 1;
|
||||||
if (sample < m_dcLevel)
|
if (sample < 0)
|
||||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||||
|
|
||||||
if (m_state == DMRRXS_NONE) {
|
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_rssiAccum += rssi[i];
|
||||||
m_rssiCount++;
|
m_rssiCount++;
|
||||||
|
|
||||||
bool bit = samples[i] < m_dcLevel;
|
bool bit = samples[i] < 0;
|
||||||
|
|
||||||
if (bit != m_prev) {
|
if (bit != m_prev) {
|
||||||
if (m_pll < (PLLMAX / 2U))
|
if (m_pll < (PLLMAX / 2U))
|
||||||
|
|
|
@ -93,8 +93,6 @@ extern bool m_duplex;
|
||||||
extern bool m_tx;
|
extern bool m_tx;
|
||||||
extern bool m_dcd;
|
extern bool m_dcd;
|
||||||
|
|
||||||
extern q15_t m_dcLevel;
|
|
||||||
|
|
||||||
extern CSerialPort serial;
|
extern CSerialPort serial;
|
||||||
extern CIO io;
|
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;
|
const uint16_t GAUSSIAN_0_5_FILTER_LEN = 12U;
|
||||||
|
|
||||||
// One symbol boxcar filter
|
// 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;
|
const uint16_t BOXCAR_FILTER_LEN = 6U;
|
||||||
|
|
||||||
// Generated using [b, a] = butter(1, 0.001) in MATLAB
|
// Generated using [b, a] = butter(1, 0.001) in MATLAB
|
||||||
|
@ -171,17 +171,19 @@ void CIO::process()
|
||||||
|
|
||||||
q31_t dcLevel = 0;
|
q31_t dcLevel = 0;
|
||||||
q31_t dcVals[20];
|
q31_t dcVals[20];
|
||||||
q31_t intSamp[20];
|
q31_t q31Samples[20U];
|
||||||
|
|
||||||
::arm_q15_to_q31((q15_t*)samples, intSamp, RX_BLOCK_SIZE);
|
::arm_q15_to_q31(samples, q31Samples, RX_BLOCK_SIZE);
|
||||||
::arm_biquad_cascade_df1_q31(&m_dcFilter, intSamp, dcVals, 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++)
|
for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++)
|
||||||
dcLevel += dcVals[i];
|
dcLevel += dcVals[i];
|
||||||
|
|
||||||
dcLevel /= RX_BLOCK_SIZE;
|
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_modemState == STATE_IDLE) {
|
||||||
if (m_dstarEnable) {
|
if (m_dstarEnable) {
|
||||||
|
|
|
@ -36,8 +36,6 @@ bool m_duplex = true;
|
||||||
bool m_tx = false;
|
bool m_tx = false;
|
||||||
bool m_dcd = false;
|
bool m_dcd = false;
|
||||||
|
|
||||||
q15_t m_dcLevel = 0;
|
|
||||||
|
|
||||||
CDStarRX dstarRX;
|
CDStarRX dstarRX;
|
||||||
CDStarTX dstarTX;
|
CDStarTX dstarTX;
|
||||||
|
|
||||||
|
|
|
@ -95,7 +95,7 @@ void CP25RX::samples(const q15_t* samples, uint16_t* rssi, uint8_t length)
|
||||||
m_rssiCount++;
|
m_rssiCount++;
|
||||||
|
|
||||||
m_bitBuffer[m_bitPtr] <<= 1;
|
m_bitBuffer[m_bitPtr] <<= 1;
|
||||||
if (sample < m_dcLevel)
|
if (sample < 0)
|
||||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||||
|
|
||||||
m_buffer[m_dataPtr] = sample;
|
m_buffer[m_dataPtr] = sample;
|
||||||
|
|
|
@ -91,7 +91,7 @@ void CYSFRX::samples(const q15_t* samples, uint16_t* rssi, uint8_t length)
|
||||||
m_rssiCount++;
|
m_rssiCount++;
|
||||||
|
|
||||||
m_bitBuffer[m_bitPtr] <<= 1;
|
m_bitBuffer[m_bitPtr] <<= 1;
|
||||||
if (sample < m_dcLevel)
|
if (sample < 0)
|
||||||
m_bitBuffer[m_bitPtr] |= 0x01U;
|
m_bitBuffer[m_bitPtr] |= 0x01U;
|
||||||
|
|
||||||
m_buffer[m_dataPtr] = sample;
|
m_buffer[m_dataPtr] = sample;
|
||||||
|
|
Loading…
Reference in New Issue