From 3e03fcff8e533d6f993b7979dcbb9efd50f5b282 Mon Sep 17 00:00:00 2001 From: Jonathan Naylor Date: Fri, 18 Aug 2017 10:42:41 +0100 Subject: [PATCH] Fix the lengths in the DC removal code. --- IO.cpp | 16 ++++++++-------- 1 file changed, 8 insertions(+), 8 deletions(-) diff --git a/IO.cpp b/IO.cpp index 626f072..90c04c2 100644 --- a/IO.cpp +++ b/IO.cpp @@ -170,20 +170,20 @@ void CIO::process() return; q31_t dcLevel = 0; - q31_t dcVals[20U]; - q31_t q31Samples[20U]; + q31_t dcValues[RX_BLOCK_SIZE]; + q31_t q31Samples[RX_BLOCK_SIZE]; - ::arm_q15_to_q31(samples, q31Samples, length); - ::arm_biquad_cascade_df1_q31(&m_dcFilter, q31Samples, dcVals, length); + ::arm_q15_to_q31(samples, q31Samples, RX_BLOCK_SIZE); + ::arm_biquad_cascade_df1_q31(&m_dcFilter, q31Samples, dcValues, RX_BLOCK_SIZE); - for (uint8_t i = 0U; i < length; i++) - dcLevel += dcVals[i]; - dcLevel /= length; + for (uint8_t i = 0U; i < RX_BLOCK_SIZE; i++) + dcLevel += dcValues[i]; + dcLevel /= RX_BLOCK_SIZE; q15_t offset = q15_t(__SSAT((dcLevel >> 16), 16));; 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; if (m_modemState == STATE_IDLE) {