1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
|
#include <stdio.h>
#include <assert.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#include "bitsplit.h"
#include "util.h"
void bitsplit_init(struct bitsplit_state *s, int maxbits_in, int maxbits_out) {
assert(s && maxbits_in && maxbits_out);
assert(maxbits_in <= 8 && maxbits_out <= 8);
memset(s, 0, sizeof(struct bitsplit_state));
s->maxbits_in = maxbits_in;
s->maxbits_out = maxbits_out;
}
inline static int read_next_bit(struct bitsplit_state *s, uint8_t **src) {
assert(s);
if (!s->n_in) {
s->in = **src;
(*src)++;
s->n_in = s->maxbits_in;
}
return (s->in >> (-- (s->n_in))) & 1;
}
inline static void write_next_bit(struct bitsplit_state *s, uint8_t **dst, int bit) {
assert(s);
s->out = (s->out << 1) | (bit & 1);
s->n_out++;
if (s->n_out >= s->maxbits_out) {
**dst = s->out;
s->out = 0;
(*dst)++;
s->n_out = 0;
}
}
void bitsplit(struct bitsplit_state *s, uint8_t *src, size_t *src_l, uint8_t *dst, size_t *dst_l) {
uint8_t *save_dst = dst, *save_src = src;
assert(s && src && dst && src_l && dst_l);
while ((src < save_src+*src_l /*|| s->n_in*/) && (dst < save_dst+*dst_l /*|| s->n_out < s->maxbits_out*/)) {
int bit;
bit = read_next_bit(s, &src);
write_next_bit(s, &dst, bit);
}
*src_l = src - save_src;
*dst_l = dst - save_dst;
}
#if (TEST == 4)
int main(int argc, char *argv[]) {
struct bitsplit_state s;
assert(argc >= 3);
bitsplit_init(&s, atoi(argv[1]), atoi(argv[2]));
for (;;) {
uint8_t in[1024];
uint8_t *i;
ssize_t r;
r = read(0, in, sizeof(in));
assert(r >= 0);
if (r == 0)
break;
i = in;
while (r) {
uint8_t out[1024];
size_t outl = sizeof(out);
size_t il = r;
ssize_t r2;
bitsplit(&s, i, &il, out, &outl);
i += il;
r -= il;
if (outl) {
r2 = loop_write(1, out, outl);
assert(r2 > 0);
}
}
}
return 0;
}
#endif
|