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

Fix the lengths in the DC removal code.

This commit is contained in:
Jonathan Naylor 2017-08-18 10:42:41 +01:00
parent 74682e7ac0
commit 3e03fcff8e
1 changed files with 8 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
IO.cpp
View File

@ -170,20 +170,20 @@ void CIO::process()
return; return;
q31_t dcLevel = 0; q31_t dcLevel = 0;
q31_t dcVals[20U]; q31_t dcValues[RX_BLOCK_SIZE];
q31_t q31Samples[20U]; q31_t q31Samples[RX_BLOCK_SIZE];
::arm_q15_to_q31(samples, q31Samples, length); ::arm_q15_to_q31(samples, q31Samples, RX_BLOCK_SIZE);
::arm_biquad_cascade_df1_q31(&m_dcFilter, q31Samples, dcVals, length); ::arm_biquad_cascade_df1_q31(&m_dcFilter, q31Samples, dcValues, RX_BLOCK_SIZE);
for (uint8_t i = 0U; i < length; i++) for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++)
dcLevel += dcVals[i]; dcLevel += dcValues[i];
dcLevel /= length; dcLevel /= RX_BLOCK_SIZE;
q15_t offset = q15_t(__SSAT((dcLevel >> 16), 16));; q15_t offset = q15_t(__SSAT((dcLevel >> 16), 16));;
q15_t dcSamples[RX_BLOCK_SIZE]; q15_t dcSamples[RX_BLOCK_SIZE];
for (uint8_t i = 0U; i < length; i++) for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++)
dcSamples[i] = samples[i] - offset; dcSamples[i] = samples[i] - offset;
if (m_modemState == STATE_IDLE) { if (m_modemState == STATE_IDLE) {