Annotation of /trunk/mkinitrd-magellan/busybox/archival/lzop.c
Parent Directory | Revision Log
Revision 984 -
(hide 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 | niro | 984 | /* |
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 | } |