g4klx/MMDVM_HS
1
0
Fork 0
mirror of https://github.com/g4klx/MMDVM_HS.git synced 2026-01-10 18:51:22 +01:00
Code Issues Actions Packages Projects Releases Wiki Activity

Fix bits to bytes conversion in DMRIdle

Browse source
This commit is contained in:
Andy CA6JAU 2017-07-22 13:42:26 -04:00
parent 5c4189f51f
commit f5e065673d
1 changed files with 22 additions and 10 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

32
DMRIdleRX.cpp
View file

@ -95,16 +95,28 @@ void CDMRIdleRX::bitsToBytes(uint16_t start, uint8_t count, uint8_t* buffer)
{
for (uint8_t i = 0U; i < count; i++) {
buffer[i] = 0U;
buffer[i] |= ((m_buffer[start + 0U] & 0x01) << 7);
buffer[i] |= ((m_buffer[start + 1U] & 0x01) << 6);
buffer[i] |= ((m_buffer[start + 2U] & 0x01) << 5);
buffer[i] |= ((m_buffer[start + 3U] & 0x01) << 4);
buffer[i] |= ((m_buffer[start + 4U] & 0x01) << 3);
buffer[i] |= ((m_buffer[start + 5U] & 0x01) << 2);
buffer[i] |= ((m_buffer[start + 6U] & 0x01) << 1);
buffer[i] |= ((m_buffer[start + 7U] & 0x01) << 0);
start += 8U;
buffer[i] |= ((m_buffer[start++] & 0x01) << 7);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 6);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 5);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 4);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 3);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 2);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 1);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
buffer[i] |= ((m_buffer[start++] & 0x01) << 0);
if (start >= DMR_FRAME_LENGTH_BITS)
start -= DMR_FRAME_LENGTH_BITS;
}