Unsignedio
/
MMDVM
mirror of https://github.com/markqvist/MMDVM.git
1
0
Fork 0
Code Issues Releases Wiki Activity

Shift the control information in line with the samples.

48kHz
Jonathan Naylor 2016-03-22 06:44:08 +00:00
parent 7907ce6911
commit 414fd9f779
1 changed files with 8 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
IO.cpp
View File

@ -198,6 +198,7 @@ void CIO::start()
m_pinLED.write(1); m_pinLED.write(1);
#endif #endif
m_count = 0U;
m_started = true; m_started = true;
} }
@ -260,9 +261,9 @@ void CIO::process()
q15_t samples[RX_BLOCK_SIZE + 1U]; q15_t samples[RX_BLOCK_SIZE + 1U];
uint8_t control[RX_BLOCK_SIZE + 1U]; uint8_t control[RX_BLOCK_SIZE + 1U];
uint8_t blockSize = RX_BLOCK_SIZE; uint8_t blockSize = RX_BLOCK_SIZE;
for (uint16_t i = 0U; i < RX_BLOCK_SIZE; i++) { for (uint16_t i = 0U; i < RX_BLOCK_SIZE; i++) {
uint16_t sample; uint16_t sample;
m_rxBuffer.get(sample, control[i]); m_rxBuffer.get(sample, control[i]);
@ -282,11 +283,14 @@ void CIO::process()
if (m_count >= m_sampleCount) { if (m_count >= m_sampleCount) {
if (m_sampleInsert) { if (m_sampleInsert) {
control[RX_BLOCK_SIZE] = control[RX_BLOCK_SIZE - 1U];
samples[RX_BLOCK_SIZE] = 0;
blockSize = RX_BLOCK_SIZE + 1U; blockSize = RX_BLOCK_SIZE + 1U;
samples[RX_BLOCK_SIZE] = 0;
for (int8_t i = RX_BLOCK_SIZE - 1; i >= 0; i--)
control[i + 1] = control[i];
} else { } else {
blockSize = RX_BLOCK_SIZE - 1U; blockSize = RX_BLOCK_SIZE - 1U;
for (uint8_t i = 0U; i < (RX_BLOCK_SIZE - 1U); i++)
control[i] = control[i + 1U];
} }
m_count -= m_sampleCount; m_count -= m_sampleCount;