1
2
3
4
5
6
7
8
9
10
11#include "libbb.h"
12#include "bb_archive.h"
13
14#if 0
15# define dbg(...) bb_error_msg(__VA_ARGS__)
16#else
17# define dbg(...) ((void)0)
18#endif
19
20
21#if ENABLE_FEATURE_LZMA_FAST
22# define speed_inline ALWAYS_INLINE
23# define size_inline
24#else
25# define speed_inline
26# define size_inline ALWAYS_INLINE
27#endif
28
29
30typedef struct {
31 int fd;
32 uint8_t *ptr;
33
34
35
36
37#define RC_BUFFER ((uint8_t*)(rc+1))
38
39 uint8_t *buffer_end;
40
41
42
43#define RC_BUFFER_SIZE 0x10000
44
45 uint32_t code;
46 uint32_t range;
47 uint32_t bound;
48} rc_t;
49
50#define RC_TOP_BITS 24
51#define RC_MOVE_BITS 5
52#define RC_MODEL_TOTAL_BITS 11
53
54
55
56static void rc_read(rc_t *rc)
57{
58 int buffer_size = safe_read(rc->fd, RC_BUFFER, RC_BUFFER_SIZE);
59
60
61 if (buffer_size <= 0)
62 bb_error_msg_and_die("unexpected EOF");
63 rc->buffer_end = RC_BUFFER + buffer_size;
64 rc->ptr = RC_BUFFER;
65}
66
67
68static void rc_do_normalize(rc_t *rc)
69{
70 if (rc->ptr >= rc->buffer_end)
71 rc_read(rc);
72 rc->range <<= 8;
73 rc->code = (rc->code << 8) | *rc->ptr++;
74}
75static ALWAYS_INLINE void rc_normalize(rc_t *rc)
76{
77 if (rc->range < (1 << RC_TOP_BITS)) {
78 rc_do_normalize(rc);
79 }
80}
81
82
83static ALWAYS_INLINE rc_t* rc_init(int fd)
84{
85 int i;
86 rc_t *rc;
87
88 rc = xzalloc(sizeof(*rc) + RC_BUFFER_SIZE);
89
90 rc->fd = fd;
91
92
93 for (i = 0; i < 5; i++) {
94 rc_do_normalize(rc);
95 }
96 rc->range = 0xffffffff;
97 return rc;
98}
99
100
101static ALWAYS_INLINE void rc_free(rc_t *rc)
102{
103 free(rc);
104}
105
106
107static speed_inline int rc_is_bit_1(rc_t *rc, uint16_t *p)
108{
109 rc_normalize(rc);
110 rc->bound = *p * (rc->range >> RC_MODEL_TOTAL_BITS);
111 if (rc->code < rc->bound) {
112 rc->range = rc->bound;
113 *p += ((1 << RC_MODEL_TOTAL_BITS) - *p) >> RC_MOVE_BITS;
114 return 0;
115 }
116 rc->range -= rc->bound;
117 rc->code -= rc->bound;
118 *p -= *p >> RC_MOVE_BITS;
119 return 1;
120}
121
122
123static ALWAYS_INLINE int rc_get_bit(rc_t *rc, uint16_t *p, int *symbol)
124{
125 int ret = rc_is_bit_1(rc, p);
126 *symbol = *symbol * 2 + ret;
127 return ret;
128}
129
130
131static ALWAYS_INLINE int rc_direct_bit(rc_t *rc)
132{
133 rc_normalize(rc);
134 rc->range >>= 1;
135 if (rc->code >= rc->range) {
136 rc->code -= rc->range;
137 return 1;
138 }
139 return 0;
140}
141
142
143static speed_inline void
144rc_bit_tree_decode(rc_t *rc, uint16_t *p, int num_levels, int *symbol)
145{
146 int i = num_levels;
147
148 *symbol = 1;
149 while (i--)
150 rc_get_bit(rc, p + *symbol, symbol);
151 *symbol -= 1 << num_levels;
152}
153
154
155typedef struct {
156 uint8_t pos;
157 uint32_t dict_size;
158 uint64_t dst_size;
159} PACKED lzma_header_t;
160
161
162
163
164enum {
165 LZMA_BASE_SIZE = 1846,
166 LZMA_LIT_SIZE = 768,
167
168 LZMA_NUM_POS_BITS_MAX = 4,
169
170 LZMA_LEN_NUM_LOW_BITS = 3,
171 LZMA_LEN_NUM_MID_BITS = 3,
172 LZMA_LEN_NUM_HIGH_BITS = 8,
173
174 LZMA_LEN_CHOICE = 0,
175 LZMA_LEN_CHOICE_2 = (LZMA_LEN_CHOICE + 1),
176 LZMA_LEN_LOW = (LZMA_LEN_CHOICE_2 + 1),
177 LZMA_LEN_MID = (LZMA_LEN_LOW \
178 + (1 << (LZMA_NUM_POS_BITS_MAX + LZMA_LEN_NUM_LOW_BITS))),
179 LZMA_LEN_HIGH = (LZMA_LEN_MID \
180 + (1 << (LZMA_NUM_POS_BITS_MAX + LZMA_LEN_NUM_MID_BITS))),
181 LZMA_NUM_LEN_PROBS = (LZMA_LEN_HIGH + (1 << LZMA_LEN_NUM_HIGH_BITS)),
182
183 LZMA_NUM_STATES = 12,
184 LZMA_NUM_LIT_STATES = 7,
185
186 LZMA_START_POS_MODEL_INDEX = 4,
187 LZMA_END_POS_MODEL_INDEX = 14,
188 LZMA_NUM_FULL_DISTANCES = (1 << (LZMA_END_POS_MODEL_INDEX >> 1)),
189
190 LZMA_NUM_POS_SLOT_BITS = 6,
191 LZMA_NUM_LEN_TO_POS_STATES = 4,
192
193 LZMA_NUM_ALIGN_BITS = 4,
194
195 LZMA_MATCH_MIN_LEN = 2,
196
197 LZMA_IS_MATCH = 0,
198 LZMA_IS_REP = (LZMA_IS_MATCH + (LZMA_NUM_STATES << LZMA_NUM_POS_BITS_MAX)),
199 LZMA_IS_REP_G0 = (LZMA_IS_REP + LZMA_NUM_STATES),
200 LZMA_IS_REP_G1 = (LZMA_IS_REP_G0 + LZMA_NUM_STATES),
201 LZMA_IS_REP_G2 = (LZMA_IS_REP_G1 + LZMA_NUM_STATES),
202 LZMA_IS_REP_0_LONG = (LZMA_IS_REP_G2 + LZMA_NUM_STATES),
203 LZMA_POS_SLOT = (LZMA_IS_REP_0_LONG \
204 + (LZMA_NUM_STATES << LZMA_NUM_POS_BITS_MAX)),
205 LZMA_SPEC_POS = (LZMA_POS_SLOT \
206 + (LZMA_NUM_LEN_TO_POS_STATES << LZMA_NUM_POS_SLOT_BITS)),
207 LZMA_ALIGN = (LZMA_SPEC_POS \
208 + LZMA_NUM_FULL_DISTANCES - LZMA_END_POS_MODEL_INDEX),
209 LZMA_LEN_CODER = (LZMA_ALIGN + (1 << LZMA_NUM_ALIGN_BITS)),
210 LZMA_REP_LEN_CODER = (LZMA_LEN_CODER + LZMA_NUM_LEN_PROBS),
211 LZMA_LITERAL = (LZMA_REP_LEN_CODER + LZMA_NUM_LEN_PROBS),
212};
213
214
215IF_DESKTOP(long long) int FAST_FUNC
216unpack_lzma_stream(transformer_state_t *xstate)
217{
218 IF_DESKTOP(long long total_written = 0;)
219 lzma_header_t header;
220 int lc, pb, lp;
221 uint32_t pos_state_mask;
222 uint32_t literal_pos_mask;
223 uint16_t *p;
224 rc_t *rc;
225 int i;
226 uint8_t *buffer;
227 uint32_t buffer_size;
228 uint8_t previous_byte = 0;
229 size_t buffer_pos = 0, global_pos = 0;
230 int len = 0;
231 int state = 0;
232 uint32_t rep0 = 1, rep1 = 1, rep2 = 1, rep3 = 1;
233
234 if (full_read(xstate->src_fd, &header, sizeof(header)) != sizeof(header)
235 || header.pos >= (9 * 5 * 5)
236 ) {
237 bb_error_msg("bad lzma header");
238 return -1;
239 }
240
241 i = header.pos / 9;
242 lc = header.pos % 9;
243 pb = i / 5;
244 lp = i % 5;
245 pos_state_mask = (1 << pb) - 1;
246 literal_pos_mask = (1 << lp) - 1;
247
248
249
250
251 header.dict_size = SWAP_LE32(header.dict_size);
252 header.dst_size = SWAP_LE64(header.dst_size);
253
254 if (header.dict_size == 0)
255 header.dict_size++;
256
257 buffer_size = MIN(header.dst_size, header.dict_size);
258 buffer = xmalloc(buffer_size);
259
260 {
261 int num_probs;
262
263 num_probs = LZMA_BASE_SIZE + (LZMA_LIT_SIZE << (lc + lp));
264 p = xmalloc(num_probs * sizeof(*p));
265 num_probs += LZMA_LITERAL - LZMA_BASE_SIZE;
266 for (i = 0; i < num_probs; i++)
267 p[i] = (1 << RC_MODEL_TOTAL_BITS) >> 1;
268 }
269
270 rc = rc_init(xstate->src_fd);
271
272 while (global_pos + buffer_pos < header.dst_size) {
273 int pos_state = (buffer_pos + global_pos) & pos_state_mask;
274 uint16_t *prob = p + LZMA_IS_MATCH + (state << LZMA_NUM_POS_BITS_MAX) + pos_state;
275
276 if (!rc_is_bit_1(rc, prob)) {
277 static const char next_state[LZMA_NUM_STATES] =
278 { 0, 0, 0, 0, 1, 2, 3, 4, 5, 6, 4, 5 };
279 int mi = 1;
280
281 prob = (p + LZMA_LITERAL
282 + (LZMA_LIT_SIZE * ((((buffer_pos + global_pos) & literal_pos_mask) << lc)
283 + (previous_byte >> (8 - lc))
284 )
285 )
286 );
287
288 if (state >= LZMA_NUM_LIT_STATES) {
289 int match_byte;
290 uint32_t pos;
291
292 pos = buffer_pos - rep0;
293 if ((int32_t)pos < 0)
294 pos += header.dict_size;
295 match_byte = buffer[pos];
296 do {
297 int bit;
298
299 match_byte <<= 1;
300 bit = match_byte & 0x100;
301 bit ^= (rc_get_bit(rc, prob + 0x100 + bit + mi, &mi) << 8);
302 if (bit)
303 break;
304 } while (mi < 0x100);
305 }
306 while (mi < 0x100) {
307 rc_get_bit(rc, prob + mi, &mi);
308 }
309
310 state = next_state[state];
311
312 previous_byte = (uint8_t) mi;
313#if ENABLE_FEATURE_LZMA_FAST
314 one_byte1:
315 buffer[buffer_pos++] = previous_byte;
316 if (buffer_pos == header.dict_size) {
317 buffer_pos = 0;
318 global_pos += header.dict_size;
319 if (transformer_write(xstate, buffer, header.dict_size) != (ssize_t)header.dict_size)
320 goto bad;
321 IF_DESKTOP(total_written += header.dict_size;)
322 }
323#else
324 len = 1;
325 goto one_byte2;
326#endif
327 } else {
328 int num_bits;
329 int offset;
330 uint16_t *prob2;
331#define prob_len prob2
332
333 prob2 = p + LZMA_IS_REP + state;
334 if (!rc_is_bit_1(rc, prob2)) {
335 rep3 = rep2;
336 rep2 = rep1;
337 rep1 = rep0;
338 state = state < LZMA_NUM_LIT_STATES ? 0 : 3;
339 prob2 = p + LZMA_LEN_CODER;
340 } else {
341 prob2 += LZMA_IS_REP_G0 - LZMA_IS_REP;
342 if (!rc_is_bit_1(rc, prob2)) {
343 prob2 = (p + LZMA_IS_REP_0_LONG
344 + (state << LZMA_NUM_POS_BITS_MAX)
345 + pos_state
346 );
347 if (!rc_is_bit_1(rc, prob2)) {
348#if ENABLE_FEATURE_LZMA_FAST
349 uint32_t pos;
350 state = state < LZMA_NUM_LIT_STATES ? 9 : 11;
351
352 pos = buffer_pos - rep0;
353 if ((int32_t)pos < 0) {
354 pos += header.dict_size;
355
356 if (pos >= buffer_size) {
357 dbg("%d pos:%d buffer_size:%d", __LINE__, pos, buffer_size);
358 goto bad;
359 }
360 }
361 previous_byte = buffer[pos];
362 goto one_byte1;
363#else
364 state = state < LZMA_NUM_LIT_STATES ? 9 : 11;
365 len = 1;
366 goto string;
367#endif
368 }
369 } else {
370 uint32_t distance;
371
372 prob2 += LZMA_IS_REP_G1 - LZMA_IS_REP_G0;
373 distance = rep1;
374 if (rc_is_bit_1(rc, prob2)) {
375 prob2 += LZMA_IS_REP_G2 - LZMA_IS_REP_G1;
376 distance = rep2;
377 if (rc_is_bit_1(rc, prob2)) {
378 distance = rep3;
379 rep3 = rep2;
380 }
381 rep2 = rep1;
382 }
383 rep1 = rep0;
384 rep0 = distance;
385 }
386 state = state < LZMA_NUM_LIT_STATES ? 8 : 11;
387 prob2 = p + LZMA_REP_LEN_CODER;
388 }
389
390 prob_len = prob2 + LZMA_LEN_CHOICE;
391 num_bits = LZMA_LEN_NUM_LOW_BITS;
392 if (!rc_is_bit_1(rc, prob_len)) {
393 prob_len += LZMA_LEN_LOW - LZMA_LEN_CHOICE
394 + (pos_state << LZMA_LEN_NUM_LOW_BITS);
395 offset = 0;
396 } else {
397 prob_len += LZMA_LEN_CHOICE_2 - LZMA_LEN_CHOICE;
398 if (!rc_is_bit_1(rc, prob_len)) {
399 prob_len += LZMA_LEN_MID - LZMA_LEN_CHOICE_2
400 + (pos_state << LZMA_LEN_NUM_MID_BITS);
401 offset = 1 << LZMA_LEN_NUM_LOW_BITS;
402 num_bits += LZMA_LEN_NUM_MID_BITS - LZMA_LEN_NUM_LOW_BITS;
403 } else {
404 prob_len += LZMA_LEN_HIGH - LZMA_LEN_CHOICE_2;
405 offset = ((1 << LZMA_LEN_NUM_LOW_BITS)
406 + (1 << LZMA_LEN_NUM_MID_BITS));
407 num_bits += LZMA_LEN_NUM_HIGH_BITS - LZMA_LEN_NUM_LOW_BITS;
408 }
409 }
410 rc_bit_tree_decode(rc, prob_len, num_bits, &len);
411 len += offset;
412
413 if (state < 4) {
414 int pos_slot;
415 uint16_t *prob3;
416
417 state += LZMA_NUM_LIT_STATES;
418 prob3 = p + LZMA_POS_SLOT +
419 ((len < LZMA_NUM_LEN_TO_POS_STATES ? len :
420 LZMA_NUM_LEN_TO_POS_STATES - 1)
421 << LZMA_NUM_POS_SLOT_BITS);
422 rc_bit_tree_decode(rc, prob3,
423 LZMA_NUM_POS_SLOT_BITS, &pos_slot);
424 rep0 = pos_slot;
425 if (pos_slot >= LZMA_START_POS_MODEL_INDEX) {
426 int i2, mi2, num_bits2 = (pos_slot >> 1) - 1;
427 rep0 = 2 | (pos_slot & 1);
428 if (pos_slot < LZMA_END_POS_MODEL_INDEX) {
429 rep0 <<= num_bits2;
430 prob3 = p + LZMA_SPEC_POS + rep0 - pos_slot - 1;
431 } else {
432 for (; num_bits2 != LZMA_NUM_ALIGN_BITS; num_bits2--)
433 rep0 = (rep0 << 1) | rc_direct_bit(rc);
434 rep0 <<= LZMA_NUM_ALIGN_BITS;
435
436
437
438 prob3 = p + LZMA_ALIGN;
439 }
440 i2 = 1;
441 mi2 = 1;
442 while (num_bits2--) {
443 if (rc_get_bit(rc, prob3 + mi2, &mi2))
444 rep0 |= i2;
445 i2 <<= 1;
446 }
447 }
448 rep0++;
449 if ((int32_t)rep0 <= 0) {
450 if (rep0 == 0)
451 break;
452 dbg("%d rep0:%d", __LINE__, rep0);
453 goto bad;
454 }
455 }
456
457 len += LZMA_MATCH_MIN_LEN;
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473 IF_NOT_FEATURE_LZMA_FAST(string:)
474 do {
475 uint32_t pos = buffer_pos - rep0;
476 if ((int32_t)pos < 0) {
477 pos += header.dict_size;
478
479
480
481
482 if (pos >= buffer_size)
483 goto bad;
484 }
485 previous_byte = buffer[pos];
486 IF_NOT_FEATURE_LZMA_FAST(one_byte2:)
487 buffer[buffer_pos++] = previous_byte;
488 if (buffer_pos == header.dict_size) {
489 buffer_pos = 0;
490 global_pos += header.dict_size;
491 if (transformer_write(xstate, buffer, header.dict_size) != (ssize_t)header.dict_size)
492 goto bad;
493 IF_DESKTOP(total_written += header.dict_size;)
494 }
495 len--;
496 } while (len != 0 && buffer_pos < header.dst_size);
497
498
499
500
501
502
503 }
504 }
505
506 {
507 IF_NOT_DESKTOP(int total_written = 0; )
508 IF_DESKTOP(total_written += buffer_pos;)
509 if (transformer_write(xstate, buffer, buffer_pos) != (ssize_t)buffer_pos) {
510 bad:
511
512
513
514
515
516 bb_error_msg("corrupted data");
517 total_written = -1;
518 }
519 rc_free(rc);
520 free(p);
521 free(buffer);
522 return total_written;
523 }
524}
525