Contents of /trunk/mkinitrd-magellan/busybox/archival/lzop.c
Parent Directory | Revision Log
Revision 984 -
(show annotations)
(download)
Sun May 30 11:32:42 2010 UTC (13 years, 11 months ago) by niro
File MIME type: text/plain
File size: 26672 byte(s)
Sun May 30 11:32:42 2010 UTC (13 years, 11 months ago) by niro
File MIME type: text/plain
File size: 26672 byte(s)
-updated to busybox-1.16.1 and enabled blkid/uuid support in default config
1 | /* |
2 | This file is part of the lzop file compressor. |
3 | |
4 | Copyright (C) 1996..2003 Markus Franz Xaver Johannes Oberhumer |
5 | All Rights Reserved. |
6 | |
7 | Markus F.X.J. Oberhumer <markus@oberhumer.com> |
8 | http://www.oberhumer.com/opensource/lzop/ |
9 | |
10 | lzop and the LZO library are free software; you can redistribute them |
11 | and/or modify them under the terms of the GNU General Public License as |
12 | published by the Free Software Foundation; either version 2 of |
13 | the License, or (at your option) any later version. |
14 | |
15 | This program is distributed in the hope that it will be useful, |
16 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
17 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
18 | GNU General Public License for more details. |
19 | |
20 | You should have received a copy of the GNU General Public License |
21 | along with this program; see the file COPYING. |
22 | If not, write to the Free Software Foundation, Inc., |
23 | 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
24 | |
25 | "Minimalized" for busybox by Alain Knaff |
26 | */ |
27 | |
28 | #include "libbb.h" |
29 | #include "unarchive.h" |
30 | #include "liblzo_interface.h" |
31 | |
32 | /* lzo-2.03/src/lzo_ptr.h */ |
33 | #define pd(a,b) ((unsigned)((a)-(b))) |
34 | |
35 | #define lzo_version() LZO_VERSION |
36 | #define lzo_sizeof_dict_t (sizeof(uint8_t*)) |
37 | |
38 | /* lzo-2.03/include/lzo/lzo1x.h */ |
39 | #define LZO1X_1_MEM_COMPRESS (16384 * lzo_sizeof_dict_t) |
40 | #define LZO1X_1_15_MEM_COMPRESS (32768 * lzo_sizeof_dict_t) |
41 | #define LZO1X_999_MEM_COMPRESS (14 * 16384 * sizeof(short)) |
42 | |
43 | /* lzo-2.03/src/lzo1x_oo.c */ |
44 | #define NO_LIT UINT_MAX |
45 | |
46 | /**********************************************************************/ |
47 | static void copy2(uint8_t* ip, const uint8_t* m_pos, unsigned off) |
48 | { |
49 | ip[0] = m_pos[0]; |
50 | if (off == 1) |
51 | ip[1] = m_pos[0]; |
52 | else |
53 | ip[1] = m_pos[1]; |
54 | } |
55 | |
56 | static void copy3(uint8_t* ip, const uint8_t* m_pos, unsigned off) |
57 | { |
58 | ip[0] = m_pos[0]; |
59 | if (off == 1) { |
60 | ip[2] = ip[1] = m_pos[0]; |
61 | } |
62 | else if (off == 2) { |
63 | ip[1] = m_pos[1]; |
64 | ip[2] = m_pos[0]; |
65 | } |
66 | else { |
67 | ip[1] = m_pos[1]; |
68 | ip[2] = m_pos[2]; |
69 | } |
70 | } |
71 | |
72 | /**********************************************************************/ |
73 | // optimize a block of data. |
74 | /**********************************************************************/ |
75 | #define TEST_IP (ip < ip_end) |
76 | #define TEST_OP (op <= op_end) |
77 | |
78 | static NOINLINE int lzo1x_optimize(uint8_t *in, unsigned in_len, |
79 | uint8_t *out, unsigned *out_len, |
80 | void* wrkmem UNUSED_PARAM) |
81 | { |
82 | uint8_t* op; |
83 | uint8_t* ip; |
84 | unsigned t; |
85 | uint8_t* m_pos; |
86 | uint8_t* const ip_end = in + in_len; |
87 | uint8_t* const op_end = out + *out_len; |
88 | uint8_t* litp = NULL; |
89 | unsigned lit = 0; |
90 | unsigned next_lit = NO_LIT; |
91 | unsigned nl; |
92 | unsigned long o_m1_a = 0, o_m1_b = 0, o_m2 = 0, o_m3_a = 0, o_m3_b = 0; |
93 | |
94 | // LZO_UNUSED(wrkmem); |
95 | |
96 | *out_len = 0; |
97 | |
98 | op = out; |
99 | ip = in; |
100 | |
101 | if (*ip > 17) { |
102 | t = *ip++ - 17; |
103 | if (t < 4) |
104 | goto match_next; |
105 | goto first_literal_run; |
106 | } |
107 | |
108 | while (TEST_IP && TEST_OP) { |
109 | t = *ip++; |
110 | if (t >= 16) |
111 | goto match; |
112 | /* a literal run */ |
113 | litp = ip - 1; |
114 | if (t == 0) { |
115 | t = 15; |
116 | while (*ip == 0) |
117 | t += 255, ip++; |
118 | t += *ip++; |
119 | } |
120 | lit = t + 3; |
121 | /* copy literals */ |
122 | copy_literal_run: |
123 | *op++ = *ip++; |
124 | *op++ = *ip++; |
125 | *op++ = *ip++; |
126 | first_literal_run: |
127 | do *op++ = *ip++; while (--t > 0); |
128 | |
129 | t = *ip++; |
130 | |
131 | if (t >= 16) |
132 | goto match; |
133 | #if defined(LZO1X) |
134 | m_pos = op - 1 - 0x800; |
135 | #elif defined(LZO1Y) |
136 | m_pos = op - 1 - 0x400; |
137 | #endif |
138 | m_pos -= t >> 2; |
139 | m_pos -= *ip++ << 2; |
140 | *op++ = *m_pos++; |
141 | *op++ = *m_pos++; |
142 | *op++ = *m_pos++; |
143 | lit = 0; |
144 | goto match_done; |
145 | |
146 | |
147 | /* handle matches */ |
148 | do { |
149 | if (t < 16) { /* a M1 match */ |
150 | m_pos = op - 1; |
151 | m_pos -= t >> 2; |
152 | m_pos -= *ip++ << 2; |
153 | |
154 | if (litp == NULL) |
155 | goto copy_m1; |
156 | |
157 | nl = ip[-2] & 3; |
158 | /* test if a match follows */ |
159 | if (nl == 0 && lit == 1 && ip[0] >= 16) { |
160 | next_lit = nl; |
161 | /* adjust length of previous short run */ |
162 | lit += 2; |
163 | *litp = (unsigned char)((*litp & ~3) | lit); |
164 | /* copy over the 2 literals that replace the match */ |
165 | copy2(ip-2, m_pos, pd(op, m_pos)); |
166 | o_m1_a++; |
167 | } |
168 | /* test if a literal run follows */ |
169 | else if (nl == 0 && ip[0] < 16 && ip[0] != 0 && |
170 | (lit + 2 + ip[0] < 16)) |
171 | { |
172 | t = *ip++; |
173 | /* remove short run */ |
174 | *litp &= ~3; |
175 | /* copy over the 2 literals that replace the match */ |
176 | copy2(ip-3+1,m_pos,pd(op,m_pos)); |
177 | /* move literals 1 byte ahead */ |
178 | litp += 2; |
179 | if (lit > 0) |
180 | memmove(litp+1, litp, lit); |
181 | /* insert new length of long literal run */ |
182 | lit += 2 + t + 3; |
183 | *litp = (unsigned char)(lit - 3); |
184 | |
185 | o_m1_b++; |
186 | *op++ = *m_pos++; *op++ = *m_pos++; |
187 | goto copy_literal_run; |
188 | } |
189 | copy_m1: |
190 | *op++ = *m_pos++; |
191 | *op++ = *m_pos++; |
192 | } else { |
193 | match: |
194 | if (t >= 64) { /* a M2 match */ |
195 | m_pos = op - 1; |
196 | #if defined(LZO1X) |
197 | m_pos -= (t >> 2) & 7; |
198 | m_pos -= *ip++ << 3; |
199 | t = (t >> 5) - 1; |
200 | #elif defined(LZO1Y) |
201 | m_pos -= (t >> 2) & 3; |
202 | m_pos -= *ip++ << 2; |
203 | t = (t >> 4) - 3; |
204 | #endif |
205 | if (litp == NULL) |
206 | goto copy_m; |
207 | |
208 | nl = ip[-2] & 3; |
209 | /* test if in beetween two long literal runs */ |
210 | if (t == 1 && lit > 3 && nl == 0 |
211 | && ip[0] < 16 && ip[0] != 0 && (lit + 3 + ip[0] < 16) |
212 | ) { |
213 | t = *ip++; |
214 | /* copy over the 3 literals that replace the match */ |
215 | copy3(ip-1-2,m_pos,pd(op,m_pos)); |
216 | /* set new length of previous literal run */ |
217 | lit += 3 + t + 3; |
218 | *litp = (unsigned char)(lit - 3); |
219 | o_m2++; |
220 | *op++ = *m_pos++; |
221 | *op++ = *m_pos++; |
222 | *op++ = *m_pos++; |
223 | goto copy_literal_run; |
224 | } |
225 | } else { |
226 | if (t >= 32) { /* a M3 match */ |
227 | t &= 31; |
228 | if (t == 0) { |
229 | t = 31; |
230 | while (*ip == 0) |
231 | t += 255, ip++; |
232 | t += *ip++; |
233 | } |
234 | m_pos = op - 1; |
235 | m_pos -= *ip++ >> 2; |
236 | m_pos -= *ip++ << 6; |
237 | } else { /* a M4 match */ |
238 | m_pos = op; |
239 | m_pos -= (t & 8) << 11; |
240 | t &= 7; |
241 | if (t == 0) { |
242 | t = 7; |
243 | while (*ip == 0) |
244 | t += 255, ip++; |
245 | t += *ip++; |
246 | } |
247 | m_pos -= *ip++ >> 2; |
248 | m_pos -= *ip++ << 6; |
249 | if (m_pos == op) |
250 | goto eof_found; |
251 | m_pos -= 0x4000; |
252 | } |
253 | if (litp == NULL) |
254 | goto copy_m; |
255 | |
256 | nl = ip[-2] & 3; |
257 | /* test if in beetween two matches */ |
258 | if (t == 1 && lit == 0 && nl == 0 && ip[0] >= 16) { |
259 | next_lit = nl; |
260 | /* make a previous short run */ |
261 | lit += 3; |
262 | *litp = (unsigned char)((*litp & ~3) | lit); |
263 | /* copy over the 3 literals that replace the match */ |
264 | copy3(ip-3,m_pos,pd(op,m_pos)); |
265 | o_m3_a++; |
266 | } |
267 | /* test if a literal run follows */ |
268 | else if (t == 1 && lit <= 3 && nl == 0 |
269 | && ip[0] < 16 && ip[0] != 0 && (lit + 3 + ip[0] < 16) |
270 | ) { |
271 | t = *ip++; |
272 | /* remove short run */ |
273 | *litp &= ~3; |
274 | /* copy over the 3 literals that replace the match */ |
275 | copy3(ip-4+1,m_pos,pd(op,m_pos)); |
276 | /* move literals 1 byte ahead */ |
277 | litp += 2; |
278 | if (lit > 0) |
279 | memmove(litp+1,litp,lit); |
280 | /* insert new length of long literal run */ |
281 | lit += 3 + t + 3; |
282 | *litp = (unsigned char)(lit - 3); |
283 | |
284 | o_m3_b++; |
285 | *op++ = *m_pos++; |
286 | *op++ = *m_pos++; |
287 | *op++ = *m_pos++; |
288 | goto copy_literal_run; |
289 | } |
290 | } |
291 | copy_m: |
292 | *op++ = *m_pos++; |
293 | *op++ = *m_pos++; |
294 | do *op++ = *m_pos++; while (--t > 0); |
295 | } |
296 | |
297 | match_done: |
298 | if (next_lit == NO_LIT) { |
299 | t = ip[-2] & 3; |
300 | lit = t; |
301 | litp = ip - 2; |
302 | } |
303 | else |
304 | t = next_lit; |
305 | next_lit = NO_LIT; |
306 | if (t == 0) |
307 | break; |
308 | /* copy literals */ |
309 | match_next: |
310 | do *op++ = *ip++; while (--t > 0); |
311 | t = *ip++; |
312 | } while (TEST_IP && TEST_OP); |
313 | } |
314 | |
315 | /* no EOF code was found */ |
316 | *out_len = pd(op, out); |
317 | return LZO_E_EOF_NOT_FOUND; |
318 | |
319 | eof_found: |
320 | // LZO_UNUSED(o_m1_a); LZO_UNUSED(o_m1_b); LZO_UNUSED(o_m2); |
321 | // LZO_UNUSED(o_m3_a); LZO_UNUSED(o_m3_b); |
322 | *out_len = pd(op, out); |
323 | return (ip == ip_end ? LZO_E_OK : |
324 | (ip < ip_end ? LZO_E_INPUT_NOT_CONSUMED : LZO_E_INPUT_OVERRUN)); |
325 | } |
326 | |
327 | /**********************************************************************/ |
328 | #define F_OS F_OS_UNIX |
329 | #define F_CS F_CS_NATIVE |
330 | |
331 | /**********************************************************************/ |
332 | #define ADLER32_INIT_VALUE 1 |
333 | #define CRC32_INIT_VALUE 0 |
334 | |
335 | /**********************************************************************/ |
336 | enum { |
337 | M_LZO1X_1 = 1, |
338 | M_LZO1X_1_15 = 2, |
339 | M_LZO1X_999 = 3, |
340 | }; |
341 | |
342 | /**********************************************************************/ |
343 | /* header flags */ |
344 | #define F_ADLER32_D 0x00000001L |
345 | #define F_ADLER32_C 0x00000002L |
346 | #define F_H_EXTRA_FIELD 0x00000040L |
347 | #define F_H_GMTDIFF 0x00000080L |
348 | #define F_CRC32_D 0x00000100L |
349 | #define F_CRC32_C 0x00000200L |
350 | #define F_H_FILTER 0x00000800L |
351 | #define F_H_CRC32 0x00001000L |
352 | #define F_MASK 0x00003FFFL |
353 | |
354 | /* operating system & file system that created the file [mostly unused] */ |
355 | #define F_OS_UNIX 0x03000000L |
356 | #define F_OS_SHIFT 24 |
357 | #define F_OS_MASK 0xff000000L |
358 | |
359 | /* character set for file name encoding [mostly unused] */ |
360 | #define F_CS_NATIVE 0x00000000L |
361 | #define F_CS_SHIFT 20 |
362 | #define F_CS_MASK 0x00f00000L |
363 | |
364 | /* these bits must be zero */ |
365 | #define F_RESERVED ((F_MASK | F_OS_MASK | F_CS_MASK) ^ 0xffffffffL) |
366 | |
367 | typedef struct chksum_t { |
368 | uint32_t f_adler32; |
369 | uint32_t f_crc32; |
370 | } chksum_t; |
371 | |
372 | typedef struct header_t { |
373 | unsigned version; |
374 | unsigned lib_version; |
375 | unsigned version_needed_to_extract; |
376 | uint32_t flags; |
377 | uint32_t mode; |
378 | uint32_t mtime; |
379 | uint32_t gmtdiff; |
380 | uint32_t header_checksum; |
381 | |
382 | uint32_t extra_field_len; |
383 | uint32_t extra_field_checksum; |
384 | |
385 | unsigned char method; |
386 | unsigned char level; |
387 | |
388 | /* info */ |
389 | char name[255+1]; |
390 | } header_t; |
391 | |
392 | struct globals { |
393 | const uint32_t *lzo_crc32_table; |
394 | chksum_t chksum_in; |
395 | chksum_t chksum_out; |
396 | }; |
397 | #define G (*(struct globals*)&bb_common_bufsiz1) |
398 | #define INIT_G() do { } while (0) |
399 | //#define G (*ptr_to_globals) |
400 | //#define INIT_G() do { |
401 | // SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); |
402 | //} while (0) |
403 | |
404 | |
405 | /**********************************************************************/ |
406 | #define LZOP_VERSION 0x1010 |
407 | //#define LZOP_VERSION_STRING "1.01" |
408 | //#define LZOP_VERSION_DATE "Apr 27th 2003" |
409 | |
410 | #define OPTION_STRING "cfvdt123456789CF" |
411 | |
412 | enum { |
413 | OPT_STDOUT = (1 << 0), |
414 | OPT_FORCE = (1 << 1), |
415 | OPT_VERBOSE = (1 << 2), |
416 | OPT_DECOMPRESS = (1 << 3), |
417 | OPT_TEST = (1 << 4), |
418 | OPT_1 = (1 << 5), |
419 | OPT_2 = (1 << 6), |
420 | OPT_3 = (1 << 7), |
421 | OPT_4 = (1 << 8), |
422 | OPT_5 = (1 << 9), |
423 | OPT_6 = (1 << 10), |
424 | OPT_789 = (7 << 11), |
425 | OPT_7 = (1 << 11), |
426 | OPT_8 = (1 << 12), |
427 | OPT_C = (1 << 14), |
428 | OPT_F = (1 << 15), |
429 | }; |
430 | |
431 | /**********************************************************************/ |
432 | // adler32 checksum |
433 | // adapted from free code by Mark Adler <madler@alumni.caltech.edu> |
434 | // see http://www.zlib.org/ |
435 | /**********************************************************************/ |
436 | static FAST_FUNC uint32_t |
437 | lzo_adler32(uint32_t adler, const uint8_t* buf, unsigned len) |
438 | { |
439 | enum { |
440 | LZO_BASE = 65521, /* largest prime smaller than 65536 */ |
441 | /* NMAX is the largest n such that |
442 | * 255n(n+1)/2 + (n+1)(BASE-1) <= 2^32-1 */ |
443 | LZO_NMAX = 5552, |
444 | }; |
445 | uint32_t s1 = adler & 0xffff; |
446 | uint32_t s2 = (adler >> 16) & 0xffff; |
447 | unsigned k; |
448 | |
449 | if (buf == NULL) |
450 | return 1; |
451 | |
452 | while (len > 0) { |
453 | k = len < LZO_NMAX ? (unsigned) len : LZO_NMAX; |
454 | len -= k; |
455 | if (k != 0) do { |
456 | s1 += *buf++; |
457 | s2 += s1; |
458 | } while (--k > 0); |
459 | s1 %= LZO_BASE; |
460 | s2 %= LZO_BASE; |
461 | } |
462 | return (s2 << 16) | s1; |
463 | } |
464 | |
465 | static FAST_FUNC uint32_t |
466 | lzo_crc32(uint32_t c, const uint8_t* buf, unsigned len) |
467 | { |
468 | uint32_t crc; |
469 | |
470 | if (buf == NULL) |
471 | return 0; |
472 | |
473 | crc = ~c; |
474 | if (len != 0) do { |
475 | crc = G.lzo_crc32_table[((int)crc ^ *buf) & 0xff] ^ (crc >> 8); |
476 | buf += 1; |
477 | len -= 1; |
478 | } while (len > 0); |
479 | |
480 | return ~crc; |
481 | } |
482 | |
483 | /**********************************************************************/ |
484 | static void init_chksum(chksum_t *ct) |
485 | { |
486 | ct->f_adler32 = ADLER32_INIT_VALUE; |
487 | ct->f_crc32 = CRC32_INIT_VALUE; |
488 | } |
489 | |
490 | static void add_bytes_to_chksum(chksum_t *ct, const void* buf, int cnt) |
491 | { |
492 | /* We need to handle the two checksums at once, because at the |
493 | * beginning of the header, we don't know yet which one we'll |
494 | * eventually need */ |
495 | ct->f_adler32 = lzo_adler32(ct->f_adler32, (const uint8_t*)buf, cnt); |
496 | ct->f_crc32 = lzo_crc32(ct->f_crc32, (const uint8_t*)buf, cnt); |
497 | } |
498 | |
499 | static uint32_t chksum_getresult(chksum_t *ct, const header_t *h) |
500 | { |
501 | return (h->flags & F_H_CRC32) ? ct->f_crc32 : ct->f_adler32; |
502 | } |
503 | |
504 | /**********************************************************************/ |
505 | static uint32_t read32(void) |
506 | { |
507 | uint32_t v; |
508 | xread(0, &v, 4); |
509 | return ntohl(v); |
510 | } |
511 | |
512 | static void write32(uint32_t v) |
513 | { |
514 | v = htonl(v); |
515 | xwrite(1, &v, 4); |
516 | } |
517 | |
518 | static void f_write(const void* buf, int cnt) |
519 | { |
520 | xwrite(1, buf, cnt); |
521 | add_bytes_to_chksum(&G.chksum_out, buf, cnt); |
522 | } |
523 | |
524 | static void f_read(void* buf, int cnt) |
525 | { |
526 | xread(0, buf, cnt); |
527 | add_bytes_to_chksum(&G.chksum_in, buf, cnt); |
528 | } |
529 | |
530 | static int f_read8(void) |
531 | { |
532 | uint8_t v; |
533 | f_read(&v, 1); |
534 | return v; |
535 | } |
536 | |
537 | static void f_write8(uint8_t v) |
538 | { |
539 | f_write(&v, 1); |
540 | } |
541 | |
542 | static unsigned f_read16(void) |
543 | { |
544 | uint16_t v; |
545 | f_read(&v, 2); |
546 | return ntohs(v); |
547 | } |
548 | |
549 | static void f_write16(uint16_t v) |
550 | { |
551 | v = htons(v); |
552 | f_write(&v, 2); |
553 | } |
554 | |
555 | static uint32_t f_read32(void) |
556 | { |
557 | uint32_t v; |
558 | f_read(&v, 4); |
559 | return ntohl(v); |
560 | } |
561 | |
562 | static void f_write32(uint32_t v) |
563 | { |
564 | v = htonl(v); |
565 | f_write(&v, 4); |
566 | } |
567 | |
568 | /**********************************************************************/ |
569 | static int lzo_get_method(header_t *h) |
570 | { |
571 | /* check method */ |
572 | if (h->method == M_LZO1X_1) { |
573 | if (h->level == 0) |
574 | h->level = 3; |
575 | } else if (h->method == M_LZO1X_1_15) { |
576 | if (h->level == 0) |
577 | h->level = 1; |
578 | } else if (h->method == M_LZO1X_999) { |
579 | if (h->level == 0) |
580 | h->level = 9; |
581 | } else |
582 | return -1; /* not a LZO method */ |
583 | |
584 | /* check compression level */ |
585 | if (h->level < 1 || h->level > 9) |
586 | return 15; |
587 | |
588 | return 0; |
589 | } |
590 | |
591 | /**********************************************************************/ |
592 | #define LZO_BLOCK_SIZE (256 * 1024l) |
593 | #define MAX_BLOCK_SIZE (64 * 1024l * 1024l) /* DO NOT CHANGE */ |
594 | |
595 | /* LZO may expand uncompressible data by a small amount */ |
596 | #define MAX_COMPRESSED_SIZE(x) ((x) + (x) / 16 + 64 + 3) |
597 | |
598 | /**********************************************************************/ |
599 | // compress a file |
600 | /**********************************************************************/ |
601 | static NOINLINE smallint lzo_compress(const header_t *h) |
602 | { |
603 | unsigned block_size = LZO_BLOCK_SIZE; |
604 | int r = 0; /* LZO_E_OK */ |
605 | uint8_t *const b1 = xzalloc(block_size); |
606 | uint8_t *const b2 = xzalloc(MAX_COMPRESSED_SIZE(block_size)); |
607 | unsigned src_len = 0, dst_len = 0; |
608 | uint32_t d_adler32 = ADLER32_INIT_VALUE; |
609 | uint32_t d_crc32 = CRC32_INIT_VALUE; |
610 | int l; |
611 | smallint ok = 1; |
612 | uint8_t *wrk_mem = NULL; |
613 | |
614 | if (h->method == M_LZO1X_1) |
615 | wrk_mem = xzalloc(LZO1X_1_MEM_COMPRESS); |
616 | else if (h->method == M_LZO1X_1_15) |
617 | wrk_mem = xzalloc(LZO1X_1_15_MEM_COMPRESS); |
618 | else if (h->method == M_LZO1X_999) |
619 | wrk_mem = xzalloc(LZO1X_999_MEM_COMPRESS); |
620 | |
621 | for (;;) { |
622 | /* read a block */ |
623 | l = full_read(0, b1, block_size); |
624 | src_len = (l > 0 ? l : 0); |
625 | |
626 | /* write uncompressed block size */ |
627 | write32(src_len); |
628 | |
629 | /* exit if last block */ |
630 | if (src_len == 0) |
631 | break; |
632 | |
633 | /* compute checksum of uncompressed block */ |
634 | if (h->flags & F_ADLER32_D) |
635 | d_adler32 = lzo_adler32(ADLER32_INIT_VALUE, b1, src_len); |
636 | if (h->flags & F_CRC32_D) |
637 | d_crc32 = lzo_crc32(CRC32_INIT_VALUE, b1, src_len); |
638 | |
639 | /* compress */ |
640 | if (h->method == M_LZO1X_1) |
641 | r = lzo1x_1_compress(b1, src_len, b2, &dst_len, wrk_mem); |
642 | else if (h->method == M_LZO1X_1_15) |
643 | r = lzo1x_1_15_compress(b1, src_len, b2, &dst_len, wrk_mem); |
644 | #if ENABLE_LZOP_COMPR_HIGH |
645 | else if (h->method == M_LZO1X_999) |
646 | r = lzo1x_999_compress_level(b1, src_len, b2, &dst_len, |
647 | wrk_mem, h->level); |
648 | #endif |
649 | else |
650 | bb_error_msg_and_die("internal error"); |
651 | |
652 | if (r != 0) /* not LZO_E_OK */ |
653 | bb_error_msg_and_die("internal error - compression failed"); |
654 | |
655 | /* write compressed block size */ |
656 | if (dst_len < src_len) { |
657 | /* optimize */ |
658 | if (h->method == M_LZO1X_999) { |
659 | unsigned new_len = src_len; |
660 | r = lzo1x_optimize(b2, dst_len, b1, &new_len, NULL); |
661 | if (r != 0 /*LZO_E_OK*/ || new_len != src_len) |
662 | bb_error_msg_and_die("internal error - optimization failed"); |
663 | } |
664 | write32(dst_len); |
665 | } else { |
666 | /* data actually expanded => store data uncompressed */ |
667 | write32(src_len); |
668 | } |
669 | |
670 | /* write checksum of uncompressed block */ |
671 | if (h->flags & F_ADLER32_D) |
672 | write32(d_adler32); |
673 | if (h->flags & F_CRC32_D) |
674 | write32(d_crc32); |
675 | |
676 | if (dst_len < src_len) { |
677 | /* write checksum of compressed block */ |
678 | if (h->flags & F_ADLER32_C) |
679 | write32(lzo_adler32(ADLER32_INIT_VALUE, b2, |
680 | dst_len)); |
681 | if (h->flags & F_CRC32_C) |
682 | write32(lzo_crc32(CRC32_INIT_VALUE, b2, dst_len)); |
683 | /* write compressed block data */ |
684 | xwrite(1, b2, dst_len); |
685 | } else { |
686 | /* write uncompressed block data */ |
687 | xwrite(1, b1, src_len); |
688 | } |
689 | } |
690 | |
691 | free(wrk_mem); |
692 | free(b1); |
693 | free(b2); |
694 | return ok; |
695 | } |
696 | |
697 | static void lzo_check(uint32_t FAST_FUNC (*fn)(uint32_t, const uint8_t*, unsigned), |
698 | uint32_t ref, uint32_t init, |
699 | uint8_t* buf, unsigned len) |
700 | { |
701 | uint32_t c = fn(init, buf, len); |
702 | if (c != ref) |
703 | bb_error_msg_and_die("checksum error"); |
704 | } |
705 | |
706 | /**********************************************************************/ |
707 | // decompress a file |
708 | /**********************************************************************/ |
709 | static NOINLINE smallint lzo_decompress(const header_t *h) |
710 | { |
711 | unsigned block_size = LZO_BLOCK_SIZE; |
712 | int r; |
713 | uint32_t src_len, dst_len; |
714 | uint32_t c_adler32 = ADLER32_INIT_VALUE; |
715 | uint32_t d_adler32 = ADLER32_INIT_VALUE; |
716 | uint32_t c_crc32 = CRC32_INIT_VALUE, d_crc32 = CRC32_INIT_VALUE; |
717 | smallint ok = 1; |
718 | uint8_t *b1; |
719 | uint32_t mcs_block_size = MAX_COMPRESSED_SIZE(block_size); |
720 | uint8_t *b2 = NULL; |
721 | |
722 | for (;;) { |
723 | uint8_t *dst; |
724 | |
725 | /* read uncompressed block size */ |
726 | dst_len = read32(); |
727 | |
728 | /* exit if last block */ |
729 | if (dst_len == 0) |
730 | break; |
731 | |
732 | /* error if split file */ |
733 | if (dst_len == 0xffffffffL) |
734 | /* should not happen - not yet implemented */ |
735 | bb_error_msg_and_die("this file is a split lzop file"); |
736 | |
737 | if (dst_len > MAX_BLOCK_SIZE) |
738 | bb_error_msg_and_die("lzop file corrupted"); |
739 | |
740 | /* read compressed block size */ |
741 | src_len = read32(); |
742 | if (src_len <= 0 || src_len > dst_len) |
743 | bb_error_msg_and_die("lzop file corrupted"); |
744 | |
745 | if (dst_len > block_size) { |
746 | if (b2) { |
747 | //FIXME! |
748 | b2 = NULL; |
749 | free(b2); |
750 | } |
751 | block_size = dst_len; |
752 | mcs_block_size = MAX_COMPRESSED_SIZE(block_size); |
753 | } |
754 | |
755 | /* read checksum of uncompressed block */ |
756 | if (h->flags & F_ADLER32_D) |
757 | d_adler32 = read32(); |
758 | if (h->flags & F_CRC32_D) |
759 | d_crc32 = read32(); |
760 | |
761 | /* read checksum of compressed block */ |
762 | if (src_len < dst_len) { |
763 | if (h->flags & F_ADLER32_C) |
764 | c_adler32 = read32(); |
765 | if (h->flags & F_CRC32_C) |
766 | c_crc32 = read32(); |
767 | } |
768 | |
769 | if (b2 == NULL) |
770 | b2 = xzalloc(mcs_block_size); |
771 | /* read the block into the end of our buffer */ |
772 | b1 = b2 + mcs_block_size - src_len; |
773 | xread(0, b1, src_len); |
774 | |
775 | if (src_len < dst_len) { |
776 | unsigned d = dst_len; |
777 | |
778 | if (!(option_mask32 & OPT_F)) { |
779 | /* verify checksum of compressed block */ |
780 | if (h->flags & F_ADLER32_C) |
781 | lzo_check(lzo_adler32, c_adler32, |
782 | ADLER32_INIT_VALUE, |
783 | b1, src_len); |
784 | if (h->flags & F_CRC32_C) |
785 | lzo_check(lzo_crc32, c_crc32, |
786 | CRC32_INIT_VALUE, |
787 | b1, src_len); |
788 | } |
789 | |
790 | /* decompress */ |
791 | // if (option_mask32 & OPT_F) |
792 | // r = lzo1x_decompress(b1, src_len, b2, &d, NULL); |
793 | // else |
794 | r = lzo1x_decompress_safe(b1, src_len, b2, &d, NULL); |
795 | |
796 | if (r != 0 /*LZO_E_OK*/ || dst_len != d) { |
797 | bb_error_msg_and_die("corrupted compressed data"); |
798 | } |
799 | dst = b2; |
800 | } else { |
801 | /* "stored" block => no decompression */ |
802 | dst = b1; |
803 | } |
804 | |
805 | if (!(option_mask32 & OPT_F)) { |
806 | /* verify checksum of uncompressed block */ |
807 | if (h->flags & F_ADLER32_D) |
808 | lzo_check(lzo_adler32, d_adler32, ADLER32_INIT_VALUE, |
809 | dst, dst_len); |
810 | if (h->flags & F_CRC32_D) |
811 | lzo_check(lzo_crc32, d_crc32, CRC32_INIT_VALUE, |
812 | dst, dst_len); |
813 | } |
814 | |
815 | /* write uncompressed block data */ |
816 | xwrite(1, dst, dst_len); |
817 | } |
818 | |
819 | free(b2); |
820 | return ok; |
821 | } |
822 | |
823 | /**********************************************************************/ |
824 | // lzop file signature (shamelessly borrowed from PNG) |
825 | /**********************************************************************/ |
826 | /* |
827 | * The first nine bytes of a lzop file always contain the following values: |
828 | * |
829 | * 0 1 2 3 4 5 6 7 8 |
830 | * --- --- --- --- --- --- --- --- --- |
831 | * (hex) 89 4c 5a 4f 00 0d 0a 1a 0a |
832 | * (decimal) 137 76 90 79 0 13 10 26 10 |
833 | * (C notation - ASCII) \211 L Z O \0 \r \n \032 \n |
834 | */ |
835 | |
836 | /* (vda) comparison with lzop v1.02rc1 ("lzop -1 <FILE" cmd): |
837 | * Only slight differences in header: |
838 | * -00000000 89 4c 5a 4f 00 0d 0a 1a 0a 10 20 20 20 09 40 02 |
839 | * +00000000 89 4c 5a 4f 00 0d 0a 1a 0a 10 10 20 30 09 40 02 |
840 | * ^^^^^ ^^^^^ |
841 | * version lib_version |
842 | * -00000010 01 03 00 00 0d 00 00 81 a4 49 f7 a6 3f 00 00 00 |
843 | * +00000010 01 03 00 00 01 00 00 00 00 00 00 00 00 00 00 00 |
844 | * ^^^^^^^^^^^ ^^^^^^^^^^^ ^^^^^^^^^^^ |
845 | * flags mode mtime |
846 | * -00000020 00 00 2d 67 04 17 00 04 00 00 00 03 ed ec 9d 6d |
847 | * +00000020 00 00 10 5f 00 c1 00 04 00 00 00 03 ed ec 9d 6d |
848 | * ^^^^^^^^^^^ |
849 | * chksum_out |
850 | * The rest is identical. |
851 | */ |
852 | static const unsigned char lzop_magic[9] = { |
853 | 0x89, 0x4c, 0x5a, 0x4f, 0x00, 0x0d, 0x0a, 0x1a, 0x0a |
854 | }; |
855 | |
856 | /* This coding is derived from Alexander Lehmann's pngcheck code. */ |
857 | static void check_magic(void) |
858 | { |
859 | unsigned char magic[sizeof(lzop_magic)]; |
860 | xread(0, magic, sizeof(magic)); |
861 | if (memcmp(magic, lzop_magic, sizeof(lzop_magic)) != 0) |
862 | bb_error_msg_and_die("bad magic number"); |
863 | } |
864 | |
865 | /**********************************************************************/ |
866 | // lzop file header |
867 | /**********************************************************************/ |
868 | static void write_header(const header_t *h) |
869 | { |
870 | int l; |
871 | |
872 | xwrite(1, lzop_magic, sizeof(lzop_magic)); |
873 | |
874 | init_chksum(&G.chksum_out); |
875 | |
876 | f_write16(h->version); |
877 | f_write16(h->lib_version); |
878 | f_write16(h->version_needed_to_extract); |
879 | f_write8(h->method); |
880 | f_write8(h->level); |
881 | f_write32(h->flags); |
882 | f_write32(h->mode); |
883 | f_write32(h->mtime); |
884 | f_write32(h->gmtdiff); |
885 | |
886 | l = (int) strlen(h->name); |
887 | f_write8(l); |
888 | if (l) |
889 | f_write(h->name, l); |
890 | |
891 | f_write32(chksum_getresult(&G.chksum_out, h)); |
892 | } |
893 | |
894 | static int read_header(header_t *h) |
895 | { |
896 | int r; |
897 | int l; |
898 | uint32_t checksum; |
899 | |
900 | memset(h, 0, sizeof(*h)); |
901 | h->version_needed_to_extract = 0x0900; /* first lzop version */ |
902 | h->level = 0; |
903 | |
904 | init_chksum(&G.chksum_in); |
905 | |
906 | h->version = f_read16(); |
907 | if (h->version < 0x0900) |
908 | return 3; |
909 | h->lib_version = f_read16(); |
910 | if (h->version >= 0x0940) { |
911 | h->version_needed_to_extract = f_read16(); |
912 | if (h->version_needed_to_extract > LZOP_VERSION) |
913 | return 16; |
914 | if (h->version_needed_to_extract < 0x0900) |
915 | return 3; |
916 | } |
917 | h->method = f_read8(); |
918 | if (h->version >= 0x0940) |
919 | h->level = f_read8(); |
920 | h->flags = f_read32(); |
921 | if (h->flags & F_H_FILTER) |
922 | return 16; /* filter not supported */ |
923 | h->mode = f_read32(); |
924 | h->mtime = f_read32(); |
925 | if (h->version >= 0x0940) |
926 | h->gmtdiff = f_read32(); |
927 | |
928 | l = f_read8(); |
929 | if (l > 0) |
930 | f_read(h->name, l); |
931 | h->name[l] = 0; |
932 | |
933 | checksum = chksum_getresult(&G.chksum_in, h); |
934 | h->header_checksum = f_read32(); |
935 | if (h->header_checksum != checksum) |
936 | return 2; |
937 | |
938 | if (h->method <= 0) |
939 | return 14; |
940 | r = lzo_get_method(h); |
941 | if (r != 0) |
942 | return r; |
943 | |
944 | /* check reserved flags */ |
945 | if (h->flags & F_RESERVED) |
946 | return -13; |
947 | |
948 | /* skip extra field [not used yet] */ |
949 | if (h->flags & F_H_EXTRA_FIELD) { |
950 | uint32_t k; |
951 | |
952 | /* note: the checksum also covers the length */ |
953 | init_chksum(&G.chksum_in); |
954 | h->extra_field_len = f_read32(); |
955 | for (k = 0; k < h->extra_field_len; k++) |
956 | f_read8(); |
957 | checksum = chksum_getresult(&G.chksum_in, h); |
958 | h->extra_field_checksum = f_read32(); |
959 | if (h->extra_field_checksum != checksum) |
960 | return 3; |
961 | } |
962 | |
963 | return 0; |
964 | } |
965 | |
966 | static void p_header(header_t *h) |
967 | { |
968 | int r; |
969 | |
970 | r = read_header(h); |
971 | if (r == 0) |
972 | return; |
973 | bb_error_msg_and_die("header_error %d", r); |
974 | } |
975 | |
976 | /**********************************************************************/ |
977 | // compress |
978 | /**********************************************************************/ |
979 | static void lzo_set_method(header_t *h) |
980 | { |
981 | int level = 1; |
982 | |
983 | if (option_mask32 & OPT_1) { |
984 | h->method = M_LZO1X_1_15; |
985 | } else if (option_mask32 & OPT_789) { |
986 | #if ENABLE_LZOP_COMPR_HIGH |
987 | h->method = M_LZO1X_999; |
988 | if (option_mask32 & OPT_7) |
989 | level = 7; |
990 | else if (option_mask32 & OPT_8) |
991 | level = 8; |
992 | else |
993 | level = 9; |
994 | #else |
995 | bb_error_msg_and_die("high compression not compiled in"); |
996 | #endif |
997 | } else { /* levels 2..6 or none (defaults to level 3) */ |
998 | h->method = M_LZO1X_1; |
999 | level = 5; /* levels 2-6 are actually the same */ |
1000 | } |
1001 | |
1002 | h->level = level; |
1003 | } |
1004 | |
1005 | static smallint do_lzo_compress(void) |
1006 | { |
1007 | header_t header; |
1008 | |
1009 | #define h (&header) |
1010 | memset(h, 0, sizeof(*h)); |
1011 | |
1012 | lzo_set_method(h); |
1013 | |
1014 | h->version = (LZOP_VERSION & 0xffff); |
1015 | h->version_needed_to_extract = 0x0940; |
1016 | h->lib_version = lzo_version() & 0xffff; |
1017 | |
1018 | h->flags = (F_OS & F_OS_MASK) | (F_CS & F_CS_MASK); |
1019 | |
1020 | if (!(option_mask32 & OPT_F) || h->method == M_LZO1X_999) { |
1021 | h->flags |= F_ADLER32_D; |
1022 | if (option_mask32 & OPT_C) |
1023 | h->flags |= F_ADLER32_C; |
1024 | } |
1025 | write_header(h); |
1026 | return lzo_compress(h); |
1027 | #undef h |
1028 | } |
1029 | |
1030 | /**********************************************************************/ |
1031 | // decompress |
1032 | /**********************************************************************/ |
1033 | static smallint do_lzo_decompress(void) |
1034 | { |
1035 | header_t header; |
1036 | |
1037 | check_magic(); |
1038 | p_header(&header); |
1039 | return lzo_decompress(&header); |
1040 | } |
1041 | |
1042 | static char* make_new_name_lzop(char *filename) |
1043 | { |
1044 | if (option_mask32 & OPT_DECOMPRESS) { |
1045 | char *extension = strrchr(filename, '.'); |
1046 | if (!extension || strcmp(extension + 1, "lzo") != 0) |
1047 | return xasprintf("%s.out", filename); |
1048 | *extension = '\0'; |
1049 | return filename; |
1050 | } |
1051 | return xasprintf("%s.lzo", filename); |
1052 | } |
1053 | |
1054 | static IF_DESKTOP(long long) int pack_lzop(unpack_info_t *info UNUSED_PARAM) |
1055 | { |
1056 | if (option_mask32 & OPT_DECOMPRESS) |
1057 | return do_lzo_decompress(); |
1058 | return do_lzo_compress(); |
1059 | } |
1060 | |
1061 | int lzop_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; |
1062 | int lzop_main(int argc UNUSED_PARAM, char **argv) |
1063 | { |
1064 | getopt32(argv, OPTION_STRING); |
1065 | argv += optind; |
1066 | /* lzopcat? */ |
1067 | if (applet_name[4] == 'c') |
1068 | option_mask32 |= (OPT_STDOUT | OPT_DECOMPRESS); |
1069 | /* unlzop? */ |
1070 | if (applet_name[0] == 'u') |
1071 | option_mask32 |= OPT_DECOMPRESS; |
1072 | |
1073 | G.lzo_crc32_table = crc32_filltable(NULL, 0); |
1074 | return bbunpack(argv, make_new_name_lzop, pack_lzop); |
1075 | } |