xref: /openbmc/linux/lib/lz4/lz4_compress.c (revision 2c684d89)
1 /*
2  * LZ4 - Fast LZ compression algorithm
3  * Copyright (C) 2011-2012, Yann Collet.
4  * BSD 2-Clause License (http://www.opensource.org/licenses/bsd-license.php)
5 
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions are
8  * met:
9  *
10  *     * Redistributions of source code must retain the above copyright
11  * notice, this list of conditions and the following disclaimer.
12  *     * Redistributions in binary form must reproduce the above
13  * copyright notice, this list of conditions and the following disclaimer
14  * in the documentation and/or other materials provided with the
15  * distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
20  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
21  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
22  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
23  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
27  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28  *
29  * You can contact the author at :
30  * - LZ4 homepage : http://fastcompression.blogspot.com/p/lz4.html
31  * - LZ4 source repository : http://code.google.com/p/lz4/
32  *
33  *  Changed for kernel use by:
34  *  Chanho Min <chanho.min@lge.com>
35  */
36 
37 #include <linux/module.h>
38 #include <linux/kernel.h>
39 #include <linux/lz4.h>
40 #include <asm/unaligned.h>
41 #include "lz4defs.h"
42 
43 /*
44  * LZ4_compressCtx :
45  * -----------------
46  * Compress 'isize' bytes from 'source' into an output buffer 'dest' of
47  * maximum size 'maxOutputSize'.  * If it cannot achieve it, compression
48  * will stop, and result of the function will be zero.
49  * return : the number of bytes written in buffer 'dest', or 0 if the
50  * compression fails
51  */
52 static inline int lz4_compressctx(void *ctx,
53 		const char *source,
54 		char *dest,
55 		int isize,
56 		int maxoutputsize)
57 {
58 	HTYPE *hashtable = (HTYPE *)ctx;
59 	const u8 *ip = (u8 *)source;
60 #if LZ4_ARCH64
61 	const BYTE * const base = ip;
62 #else
63 	const int base = 0;
64 #endif
65 	const u8 *anchor = ip;
66 	const u8 *const iend = ip + isize;
67 	const u8 *const mflimit = iend - MFLIMIT;
68 	#define MATCHLIMIT (iend - LASTLITERALS)
69 
70 	u8 *op = (u8 *) dest;
71 	u8 *const oend = op + maxoutputsize;
72 	int length;
73 	const int skipstrength = SKIPSTRENGTH;
74 	u32 forwardh;
75 	int lastrun;
76 
77 	/* Init */
78 	if (isize < MINLENGTH)
79 		goto _last_literals;
80 
81 	memset((void *)hashtable, 0, LZ4_MEM_COMPRESS);
82 
83 	/* First Byte */
84 	hashtable[LZ4_HASH_VALUE(ip)] = ip - base;
85 	ip++;
86 	forwardh = LZ4_HASH_VALUE(ip);
87 
88 	/* Main Loop */
89 	for (;;) {
90 		int findmatchattempts = (1U << skipstrength) + 3;
91 		const u8 *forwardip = ip;
92 		const u8 *ref;
93 		u8 *token;
94 
95 		/* Find a match */
96 		do {
97 			u32 h = forwardh;
98 			int step = findmatchattempts++ >> skipstrength;
99 			ip = forwardip;
100 			forwardip = ip + step;
101 
102 			if (unlikely(forwardip > mflimit))
103 				goto _last_literals;
104 
105 			forwardh = LZ4_HASH_VALUE(forwardip);
106 			ref = base + hashtable[h];
107 			hashtable[h] = ip - base;
108 		} while ((ref < ip - MAX_DISTANCE) || (A32(ref) != A32(ip)));
109 
110 		/* Catch up */
111 		while ((ip > anchor) && (ref > (u8 *)source) &&
112 			unlikely(ip[-1] == ref[-1])) {
113 			ip--;
114 			ref--;
115 		}
116 
117 		/* Encode Literal length */
118 		length = (int)(ip - anchor);
119 		token = op++;
120 		/* check output limit */
121 		if (unlikely(op + length + (2 + 1 + LASTLITERALS) +
122 			(length >> 8) > oend))
123 			return 0;
124 
125 		if (length >= (int)RUN_MASK) {
126 			int len;
127 			*token = (RUN_MASK << ML_BITS);
128 			len = length - RUN_MASK;
129 			for (; len > 254 ; len -= 255)
130 				*op++ = 255;
131 			*op++ = (u8)len;
132 		} else
133 			*token = (length << ML_BITS);
134 
135 		/* Copy Literals */
136 		LZ4_BLINDCOPY(anchor, op, length);
137 _next_match:
138 		/* Encode Offset */
139 		LZ4_WRITE_LITTLEENDIAN_16(op, (u16)(ip - ref));
140 
141 		/* Start Counting */
142 		ip += MINMATCH;
143 		/* MinMatch verified */
144 		ref += MINMATCH;
145 		anchor = ip;
146 		while (likely(ip < MATCHLIMIT - (STEPSIZE - 1))) {
147 			#if LZ4_ARCH64
148 			u64 diff = A64(ref) ^ A64(ip);
149 			#else
150 			u32 diff = A32(ref) ^ A32(ip);
151 			#endif
152 			if (!diff) {
153 				ip += STEPSIZE;
154 				ref += STEPSIZE;
155 				continue;
156 			}
157 			ip += LZ4_NBCOMMONBYTES(diff);
158 			goto _endcount;
159 		}
160 		#if LZ4_ARCH64
161 		if ((ip < (MATCHLIMIT - 3)) && (A32(ref) == A32(ip))) {
162 			ip += 4;
163 			ref += 4;
164 		}
165 		#endif
166 		if ((ip < (MATCHLIMIT - 1)) && (A16(ref) == A16(ip))) {
167 			ip += 2;
168 			ref += 2;
169 		}
170 		if ((ip < MATCHLIMIT) && (*ref == *ip))
171 			ip++;
172 _endcount:
173 		/* Encode MatchLength */
174 		length = (int)(ip - anchor);
175 		/* Check output limit */
176 		if (unlikely(op + (1 + LASTLITERALS) + (length >> 8) > oend))
177 			return 0;
178 		if (length >= (int)ML_MASK) {
179 			*token += ML_MASK;
180 			length -= ML_MASK;
181 			for (; length > 509 ; length -= 510) {
182 				*op++ = 255;
183 				*op++ = 255;
184 			}
185 			if (length > 254) {
186 				length -= 255;
187 				*op++ = 255;
188 			}
189 			*op++ = (u8)length;
190 		} else
191 			*token += length;
192 
193 		/* Test end of chunk */
194 		if (ip > mflimit) {
195 			anchor = ip;
196 			break;
197 		}
198 
199 		/* Fill table */
200 		hashtable[LZ4_HASH_VALUE(ip-2)] = ip - 2 - base;
201 
202 		/* Test next position */
203 		ref = base + hashtable[LZ4_HASH_VALUE(ip)];
204 		hashtable[LZ4_HASH_VALUE(ip)] = ip - base;
205 		if ((ref > ip - (MAX_DISTANCE + 1)) && (A32(ref) == A32(ip))) {
206 			token = op++;
207 			*token = 0;
208 			goto _next_match;
209 		}
210 
211 		/* Prepare next loop */
212 		anchor = ip++;
213 		forwardh = LZ4_HASH_VALUE(ip);
214 	}
215 
216 _last_literals:
217 	/* Encode Last Literals */
218 	lastrun = (int)(iend - anchor);
219 	if (((char *)op - dest) + lastrun + 1
220 		+ ((lastrun + 255 - RUN_MASK) / 255) > (u32)maxoutputsize)
221 		return 0;
222 
223 	if (lastrun >= (int)RUN_MASK) {
224 		*op++ = (RUN_MASK << ML_BITS);
225 		lastrun -= RUN_MASK;
226 		for (; lastrun > 254 ; lastrun -= 255)
227 			*op++ = 255;
228 		*op++ = (u8)lastrun;
229 	} else
230 		*op++ = (lastrun << ML_BITS);
231 	memcpy(op, anchor, iend - anchor);
232 	op += iend - anchor;
233 
234 	/* End */
235 	return (int)(((char *)op) - dest);
236 }
237 
238 static inline int lz4_compress64kctx(void *ctx,
239 		const char *source,
240 		char *dest,
241 		int isize,
242 		int maxoutputsize)
243 {
244 	u16 *hashtable = (u16 *)ctx;
245 	const u8 *ip = (u8 *) source;
246 	const u8 *anchor = ip;
247 	const u8 *const base = ip;
248 	const u8 *const iend = ip + isize;
249 	const u8 *const mflimit = iend - MFLIMIT;
250 	#define MATCHLIMIT (iend - LASTLITERALS)
251 
252 	u8 *op = (u8 *) dest;
253 	u8 *const oend = op + maxoutputsize;
254 	int len, length;
255 	const int skipstrength = SKIPSTRENGTH;
256 	u32 forwardh;
257 	int lastrun;
258 
259 	/* Init */
260 	if (isize < MINLENGTH)
261 		goto _last_literals;
262 
263 	memset((void *)hashtable, 0, LZ4_MEM_COMPRESS);
264 
265 	/* First Byte */
266 	ip++;
267 	forwardh = LZ4_HASH64K_VALUE(ip);
268 
269 	/* Main Loop */
270 	for (;;) {
271 		int findmatchattempts = (1U << skipstrength) + 3;
272 		const u8 *forwardip = ip;
273 		const u8 *ref;
274 		u8 *token;
275 
276 		/* Find a match */
277 		do {
278 			u32 h = forwardh;
279 			int step = findmatchattempts++ >> skipstrength;
280 			ip = forwardip;
281 			forwardip = ip + step;
282 
283 			if (forwardip > mflimit)
284 				goto _last_literals;
285 
286 			forwardh = LZ4_HASH64K_VALUE(forwardip);
287 			ref = base + hashtable[h];
288 			hashtable[h] = (u16)(ip - base);
289 		} while (A32(ref) != A32(ip));
290 
291 		/* Catch up */
292 		while ((ip > anchor) && (ref > (u8 *)source)
293 			&& (ip[-1] == ref[-1])) {
294 			ip--;
295 			ref--;
296 		}
297 
298 		/* Encode Literal length */
299 		length = (int)(ip - anchor);
300 		token = op++;
301 		/* Check output limit */
302 		if (unlikely(op + length + (2 + 1 + LASTLITERALS)
303 			+ (length >> 8) > oend))
304 			return 0;
305 		if (length >= (int)RUN_MASK) {
306 			*token = (RUN_MASK << ML_BITS);
307 			len = length - RUN_MASK;
308 			for (; len > 254 ; len -= 255)
309 				*op++ = 255;
310 			*op++ = (u8)len;
311 		} else
312 			*token = (length << ML_BITS);
313 
314 		/* Copy Literals */
315 		LZ4_BLINDCOPY(anchor, op, length);
316 
317 _next_match:
318 		/* Encode Offset */
319 		LZ4_WRITE_LITTLEENDIAN_16(op, (u16)(ip - ref));
320 
321 		/* Start Counting */
322 		ip += MINMATCH;
323 		/* MinMatch verified */
324 		ref += MINMATCH;
325 		anchor = ip;
326 
327 		while (ip < MATCHLIMIT - (STEPSIZE - 1)) {
328 			#if LZ4_ARCH64
329 			u64 diff = A64(ref) ^ A64(ip);
330 			#else
331 			u32 diff = A32(ref) ^ A32(ip);
332 			#endif
333 
334 			if (!diff) {
335 				ip += STEPSIZE;
336 				ref += STEPSIZE;
337 				continue;
338 			}
339 			ip += LZ4_NBCOMMONBYTES(diff);
340 			goto _endcount;
341 		}
342 		#if LZ4_ARCH64
343 		if ((ip < (MATCHLIMIT - 3)) && (A32(ref) == A32(ip))) {
344 			ip += 4;
345 			ref += 4;
346 		}
347 		#endif
348 		if ((ip < (MATCHLIMIT - 1)) && (A16(ref) == A16(ip))) {
349 			ip += 2;
350 			ref += 2;
351 		}
352 		if ((ip < MATCHLIMIT) && (*ref == *ip))
353 			ip++;
354 _endcount:
355 
356 		/* Encode MatchLength */
357 		len = (int)(ip - anchor);
358 		/* Check output limit */
359 		if (unlikely(op + (1 + LASTLITERALS) + (len >> 8) > oend))
360 			return 0;
361 		if (len >= (int)ML_MASK) {
362 			*token += ML_MASK;
363 			len -= ML_MASK;
364 			for (; len > 509 ; len -= 510) {
365 				*op++ = 255;
366 				*op++ = 255;
367 			}
368 			if (len > 254) {
369 				len -= 255;
370 				*op++ = 255;
371 			}
372 			*op++ = (u8)len;
373 		} else
374 			*token += len;
375 
376 		/* Test end of chunk */
377 		if (ip > mflimit) {
378 			anchor = ip;
379 			break;
380 		}
381 
382 		/* Fill table */
383 		hashtable[LZ4_HASH64K_VALUE(ip-2)] = (u16)(ip - 2 - base);
384 
385 		/* Test next position */
386 		ref = base + hashtable[LZ4_HASH64K_VALUE(ip)];
387 		hashtable[LZ4_HASH64K_VALUE(ip)] = (u16)(ip - base);
388 		if (A32(ref) == A32(ip)) {
389 			token = op++;
390 			*token = 0;
391 			goto _next_match;
392 		}
393 
394 		/* Prepare next loop */
395 		anchor = ip++;
396 		forwardh = LZ4_HASH64K_VALUE(ip);
397 	}
398 
399 _last_literals:
400 	/* Encode Last Literals */
401 	lastrun = (int)(iend - anchor);
402 	if (op + lastrun + 1 + (lastrun - RUN_MASK + 255) / 255 > oend)
403 		return 0;
404 	if (lastrun >= (int)RUN_MASK) {
405 		*op++ = (RUN_MASK << ML_BITS);
406 		lastrun -= RUN_MASK;
407 		for (; lastrun > 254 ; lastrun -= 255)
408 			*op++ = 255;
409 		*op++ = (u8)lastrun;
410 	} else
411 		*op++ = (lastrun << ML_BITS);
412 	memcpy(op, anchor, iend - anchor);
413 	op += iend - anchor;
414 	/* End */
415 	return (int)(((char *)op) - dest);
416 }
417 
418 int lz4_compress(const unsigned char *src, size_t src_len,
419 			unsigned char *dst, size_t *dst_len, void *wrkmem)
420 {
421 	int ret = -1;
422 	int out_len = 0;
423 
424 	if (src_len < LZ4_64KLIMIT)
425 		out_len = lz4_compress64kctx(wrkmem, src, dst, src_len,
426 				lz4_compressbound(src_len));
427 	else
428 		out_len = lz4_compressctx(wrkmem, src, dst, src_len,
429 				lz4_compressbound(src_len));
430 
431 	if (out_len < 0)
432 		goto exit;
433 
434 	*dst_len = out_len;
435 
436 	return 0;
437 exit:
438 	return ret;
439 }
440 EXPORT_SYMBOL(lz4_compress);
441 
442 MODULE_LICENSE("Dual BSD/GPL");
443 MODULE_DESCRIPTION("LZ4 compressor");
444