1 // This GETBIT is supposed to work on little endian
2 // 32bit systems. The algorithm will definitely need
3 // some fixing on other systems, but it might not be
4 // a problem since the nrv2b binary behaves the same..
13 #define GETBIT_8(bb, src, ilen) \
14 (((bb = bb & 0x7f ? bb*2 : ((unsigned)src[ilen++]*2+1)) >> 8) & 1)
16 #define GETBIT_LE16(bb, src, ilen) \
17 (bb*=2,bb&0xffff ? (bb>>16)&1 : (ilen+=2,((bb=(src[ilen-2]+src[ilen-1]*256u)*2+1)>>16)&1))
18 #define GETBIT_LE32(bb, src, ilen) \
19 (bc > 0 ? ((bb>>--bc)&1) : (bc=31,\
20 bb=*(const uint32_t *)((src)+ilen),ilen+=4,(bb>>31)&1))
22 #if ENDIAN == 0 && BITSIZE == 8
23 #define GETBIT(bb, src, ilen) GETBIT_8(bb, src, ilen)
25 #if ENDIAN == 0 && BITSIZE == 16
26 #define GETBIT(bb, src, ilen) GETBIT_LE16(bb, src, ilen)
28 #if ENDIAN == 0 && BITSIZE == 32
29 #define GETBIT(bb, src, ilen) GETBIT_LE32(bb, src, ilen)
31 static unsigned long unrv2b(uint8_t * src, uint8_t * dst, unsigned long *ilen_p)
33 unsigned long ilen = 0, olen = 0, last_m_off = 1;
40 /* FIXME: check olen with the length stored in first 4 bytes */
43 unsigned int m_off, m_len;
44 while (GETBIT(bb, src, ilen)) {
45 dst[olen++] = src[ilen++];
50 m_off = m_off * 2 + GETBIT(bb, src, ilen);
51 } while (!GETBIT(bb, src, ilen));
55 m_off = (m_off - 3) * 256 + src[ilen++];
56 if (m_off == 0xffffffffU)
61 m_len = GETBIT(bb, src, ilen);
62 m_len = m_len * 2 + GETBIT(bb, src, ilen);
66 m_len = m_len * 2 + GETBIT(bb, src, ilen);
67 } while (!GETBIT(bb, src, ilen));
70 m_len += (m_off > 0xd00);
72 m_pos = dst + olen - m_off;
73 dst[olen++] = *m_pos++;
75 dst[olen++] = *m_pos++;
76 } while (--m_len > 0);