00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018 #include "bitbuf.h"
00019
00020
00021
00022
00023 void bitbufInit(BitBuf* bitBuffer, unsigned char *start, unsigned short bytesize)
00024 {
00025
00026 bitBuffer->dataptr = start;
00027 bitBuffer->size = bytesize;
00028
00029 bitBuffer->dataindex = 0;
00030 bitbufFlush(bitBuffer);
00031 }
00032
00033 unsigned char bitbufGet(BitBuf* bitBuffer)
00034 {
00035 unsigned char byte;
00036 unsigned char bit;
00037
00038
00039 byte = bitBuffer->dataptr[bitBuffer->bytePos];
00040
00041 bit = (byte & (1<<bitBuffer->bitPos))?(1):(0);
00042
00043
00044 if(bitBuffer->bitPos < 7)
00045 {
00046 bitBuffer->bitPos++;
00047 }
00048 else
00049 {
00050
00051 bitBuffer->bitPos = 0;
00052 bitBuffer->bytePos++;
00053 }
00054
00055
00056 return bit;
00057 }
00058
00059 unsigned char bitbufGetAtIndex(BitBuf* bitBuffer, unsigned short bitIndex)
00060 {
00061
00062 return (bitBuffer->dataptr[bitIndex>>3] & (1<<(bitIndex & 0x07)))?(1):(0);
00063 }
00064
00065 void bitbufStore(BitBuf* bitBuffer, unsigned char bit)
00066 {
00067 unsigned char byte;
00068
00069 byte = bitBuffer->dataptr[bitBuffer->bytePos];
00070
00071 if(bit)
00072 byte |= (1<<bitBuffer->bitPos);
00073 else
00074 byte &= ~(1<<bitBuffer->bitPos);
00075
00076 bitBuffer->dataptr[bitBuffer->bytePos] = byte;
00077 bitBuffer->datalength++;
00078
00079
00080 if(bitBuffer->bitPos < 7)
00081 {
00082 bitBuffer->bitPos++;
00083 }
00084 else
00085 {
00086
00087 bitBuffer->bitPos = 0;
00088 bitBuffer->bytePos++;
00089 }
00090 }
00091
00092 void bitbufReset(BitBuf* bitBuffer)
00093 {
00094
00095 bitBuffer->bytePos = 0;
00096 bitBuffer->bitPos = 0;
00097 }
00098
00099 void bitbufFlush(BitBuf* bitBuffer)
00100 {
00101
00102 bitBuffer->datalength = 0;
00103
00104 bitbufReset(bitBuffer);
00105 }
00106
00107 unsigned short bitbufGetDataLength(BitBuf* bitBuffer)
00108 {
00109 return bitBuffer->datalength;
00110 }
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122