lib/lz4/lz4hc_compress.c

   1 /*
   2  * LZ4 HC - High Compression Mode of LZ4
   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 struct lz4hc_data {
  44         const u8 *base;
  45         HTYPE hashtable[HASHTABLESIZE];
  46         u16 chaintable[MAXD];
  47         const u8 *nexttoupdate;
  48 } __attribute__((__packed__));
  49
  50 static inline int lz4hc_init(struct lz4hc_data *hc4, const u8 *base)
  51 {
  52         memset((void *)hc4->hashtable, 0, sizeof(hc4->hashtable));
  53         memset(hc4->chaintable, 0xFF, sizeof(hc4->chaintable));
  54
  55 #if LZ4_ARCH64
  56         hc4->nexttoupdate = base + 1;
  57 #else
  58         hc4->nexttoupdate = base;
  59 #endif
  60         hc4->base = base;
  61         return 1;
  62 }
  63
  64 /* Update chains up to ip (excluded) */
  65 static inline void lz4hc_insert(struct lz4hc_data *hc4, const u8 *ip)
  66 {
  67         u16 *chaintable = hc4->chaintable;
  68         HTYPE *hashtable  = hc4->hashtable;
  69 #if LZ4_ARCH64
  70         const BYTE * const base = hc4->base;
  71 #else
  72         const int base = 0;
  73 #endif
  74
  75         while (hc4->nexttoupdate < ip) {
  76                 const u8 *p = hc4->nexttoupdate;
  77                 size_t delta = p - (hashtable[HASH_VALUE(p)] + base);
  78                 if (delta > MAX_DISTANCE)
  79                         delta = MAX_DISTANCE;
  80                 chaintable[(size_t)(p) & MAXD_MASK] = (u16)delta;
  81                 hashtable[HASH_VALUE(p)] = (p) - base;
  82                 hc4->nexttoupdate++;
  83         }
  84 }
  85
  86 static inline size_t lz4hc_commonlength(const u8 *p1, const u8 *p2,
  87                 const u8 *const matchlimit)
  88 {
  89         const u8 *p1t = p1;
  90
  91         while (p1t < matchlimit - (STEPSIZE - 1)) {
  92 #if LZ4_ARCH64
  93                 u64 diff = A64(p2) ^ A64(p1t);
  94 #else
  95                 u32 diff = A32(p2) ^ A32(p1t);
  96 #endif
  97                 if (!diff) {
  98                         p1t += STEPSIZE;
  99                         p2 += STEPSIZE;
 100                         continue;
 101                 }
 102                 p1t += LZ4_NBCOMMONBYTES(diff);
 103                 return p1t - p1;
 104         }
 105 #if LZ4_ARCH64
 106         if ((p1t < (matchlimit-3)) && (A32(p2) == A32(p1t))) {
 107                 p1t += 4;
 108                 p2 += 4;
 109         }
 110 #endif
 111
 112         if ((p1t < (matchlimit - 1)) && (A16(p2) == A16(p1t))) {
 113                 p1t += 2;
 114                 p2 += 2;
 115         }
 116         if ((p1t < matchlimit) && (*p2 == *p1t))
 117                 p1t++;
 118         return p1t - p1;
 119 }
 120
 121 static inline int lz4hc_insertandfindbestmatch(struct lz4hc_data *hc4,
 122                 const u8 *ip, const u8 *const matchlimit, const u8 **matchpos)
 123 {
 124         u16 *const chaintable = hc4->chaintable;
 125         HTYPE *const hashtable = hc4->hashtable;
 126         const u8 *ref;
 127 #if LZ4_ARCH64
 128         const BYTE * const base = hc4->base;
 129 #else
 130         const int base = 0;
 131 #endif
 132         int nbattempts = MAX_NB_ATTEMPTS;
 133         size_t repl = 0, ml = 0;
 134         u16 delta;
 135
 136         /* HC4 match finder */
 137         lz4hc_insert(hc4, ip);
 138         ref = hashtable[HASH_VALUE(ip)] + base;
 139
 140         /* potential repetition */
 141         if (ref >= ip-4) {
 142                 /* confirmed */
 143                 if (A32(ref) == A32(ip)) {
 144                         delta = (u16)(ip-ref);
 145                         repl = ml  = lz4hc_commonlength(ip + MINMATCH,
 146                                         ref + MINMATCH, matchlimit) + MINMATCH;
 147                         *matchpos = ref;
 148                 }
 149                 ref -= (size_t)chaintable[(size_t)(ref) & MAXD_MASK];
 150         }
 151
 152         while ((ref >= ip - MAX_DISTANCE) && nbattempts) {
 153                 nbattempts--;
 154                 if (*(ref + ml) == *(ip + ml)) {
 155                         if (A32(ref) == A32(ip)) {
 156                                 size_t mlt =
 157                                         lz4hc_commonlength(ip + MINMATCH,
 158                                         ref + MINMATCH, matchlimit) + MINMATCH;
 159                                 if (mlt > ml) {
 160                                         ml = mlt;
 161                                         *matchpos = ref;
 162                                 }
 163                         }
 164                 }
 165                 ref -= (size_t)chaintable[(size_t)(ref) & MAXD_MASK];
 166         }
 167
 168         /* Complete table */
 169         if (repl) {
 170                 const BYTE *ptr = ip;
 171                 const BYTE *end;
 172                 end = ip + repl - (MINMATCH-1);
 173                 /* Pre-Load */
 174                 while (ptr < end - delta) {
 175                         chaintable[(size_t)(ptr) & MAXD_MASK] = delta;
 176                         ptr++;
 177                 }
 178                 do {
 179                         chaintable[(size_t)(ptr) & MAXD_MASK] = delta;
 180                         /* Head of chain */
 181                         hashtable[HASH_VALUE(ptr)] = (ptr) - base;
 182                         ptr++;
 183                 } while (ptr < end);
 184                 hc4->nexttoupdate = end;
 185         }
 186
 187         return (int)ml;
 188 }
 189
 190 static inline int lz4hc_insertandgetwidermatch(struct lz4hc_data *hc4,
 191         const u8 *ip, const u8 *startlimit, const u8 *matchlimit, int longest,
 192         const u8 **matchpos, const u8 **startpos)
 193 {
 194         u16 *const chaintable = hc4->chaintable;
 195         HTYPE *const hashtable = hc4->hashtable;
 196 #if LZ4_ARCH64
 197         const BYTE * const base = hc4->base;
 198 #else
 199         const int base = 0;
 200 #endif
 201         const u8 *ref;
 202         int nbattempts = MAX_NB_ATTEMPTS;
 203         int delta = (int)(ip - startlimit);
 204
 205         /* First Match */
 206         lz4hc_insert(hc4, ip);
 207         ref = hashtable[HASH_VALUE(ip)] + base;
 208
 209         while ((ref >= ip - MAX_DISTANCE) && (ref >= hc4->base)
 210                 && (nbattempts)) {
 211                 nbattempts--;
 212                 if (*(startlimit + longest) == *(ref - delta + longest)) {
 213                         if (A32(ref) == A32(ip)) {
 214                                 const u8 *reft = ref + MINMATCH;
 215                                 const u8 *ipt = ip + MINMATCH;
 216                                 const u8 *startt = ip;
 217
 218                                 while (ipt < matchlimit-(STEPSIZE - 1)) {
 219                                         #if LZ4_ARCH64
 220                                         u64 diff = A64(reft) ^ A64(ipt);
 221                                         #else
 222                                         u32 diff = A32(reft) ^ A32(ipt);
 223                                         #endif
 224
 225                                         if (!diff) {
 226                                                 ipt += STEPSIZE;
 227                                                 reft += STEPSIZE;
 228                                                 continue;
 229                                         }
 230                                         ipt += LZ4_NBCOMMONBYTES(diff);
 231                                         goto _endcount;
 232                                 }
 233                                 #if LZ4_ARCH64
 234                                 if ((ipt < (matchlimit - 3))
 235                                         && (A32(reft) == A32(ipt))) {
 236                                         ipt += 4;
 237                                         reft += 4;
 238                                 }
 239                                 ipt += 2;
 240                                 #endif
 241                                 if ((ipt < (matchlimit - 1))
 242                                         && (A16(reft) == A16(ipt))) {
 243                                         reft += 2;
 244                                 }
 245                                 if ((ipt < matchlimit) && (*reft == *ipt))
 246                                         ipt++;
 247 _endcount:
 248                                 reft = ref;
 249
 250                                 while ((startt > startlimit)
 251                                         && (reft > hc4->base)
 252                                         && (startt[-1] == reft[-1])) {
 253                                         startt--;
 254                                         reft--;
 255                                 }
 256
 257                                 if ((ipt - startt) > longest) {
 258                                         longest = (int)(ipt - startt);
 259                                         *matchpos = reft;
 260                                         *startpos = startt;
 261                                 }
 262                         }
 263                 }
 264                 ref -= (size_t)chaintable[(size_t)(ref) & MAXD_MASK];
 265         }
 266         return longest;
 267 }
 268
 269 static inline int lz4_encodesequence(const u8 **ip, u8 **op, const u8 **anchor,
 270                 int ml, const u8 *ref)
 271 {
 272         int length, len;
 273         u8 *token;
 274
 275         /* Encode Literal length */
 276         length = (int)(*ip - *anchor);
 277         token = (*op)++;
 278         if (length >= (int)RUN_MASK) {
 279                 *token = (RUN_MASK << ML_BITS);
 280                 len = length - RUN_MASK;
 281                 for (; len > 254 ; len -= 255)
 282                         *(*op)++ = 255;
 283                 *(*op)++ = (u8)len;
 284         } else
 285                 *token = (length << ML_BITS);
 286
 287         /* Copy Literals */
 288         LZ4_BLINDCOPY(*anchor, *op, length);
 289
 290         /* Encode Offset */
 291         LZ4_WRITE_LITTLEENDIAN_16(*op, (u16)(*ip - ref));
 292
 293         /* Encode MatchLength */
 294         len = (int)(ml - MINMATCH);
 295         if (len >= (int)ML_MASK) {
 296                 *token += ML_MASK;
 297                 len -= ML_MASK;
 298                 for (; len > 509 ; len -= 510) {
 299                         *(*op)++ = 255;
 300                         *(*op)++ = 255;
 301                 }
 302                 if (len > 254) {
 303                         len -= 255;
 304                         *(*op)++ = 255;
 305                 }
 306                 *(*op)++ = (u8)len;
 307         } else
 308                 *token += len;
 309
 310         /* Prepare next loop */
 311         *ip += ml;
 312         *anchor = *ip;
 313
 314         return 0;
 315 }
 316
 317 static int lz4_compresshcctx(struct lz4hc_data *ctx,
 318                 const char *source,
 319                 char *dest,
 320                 int isize)
 321 {
 322         const u8 *ip = (const u8 *)source;
 323         const u8 *anchor = ip;
 324         const u8 *const iend = ip + isize;
 325         const u8 *const mflimit = iend - MFLIMIT;
 326         const u8 *const matchlimit = (iend - LASTLITERALS);
 327
 328         u8 *op = (u8 *)dest;
 329
 330         int ml, ml2, ml3, ml0;
 331         const u8 *ref = NULL;
 332         const u8 *start2 = NULL;
 333         const u8 *ref2 = NULL;
 334         const u8 *start3 = NULL;
 335         const u8 *ref3 = NULL;
 336         const u8 *start0;
 337         const u8 *ref0;
 338         int lastrun;
 339
 340         ip++;
 341
 342         /* Main Loop */
 343         while (ip < mflimit) {
 344                 ml = lz4hc_insertandfindbestmatch(ctx, ip, matchlimit, (&ref));
 345                 if (!ml) {
 346                         ip++;
 347                         continue;
 348                 }
 349
 350                 /* saved, in case we would skip too much */
 351                 start0 = ip;
 352                 ref0 = ref;
 353                 ml0 = ml;
 354 _search2:
 355                 if (ip+ml < mflimit)
 356                         ml2 = lz4hc_insertandgetwidermatch(ctx, ip + ml - 2,
 357                                 ip + 1, matchlimit, ml, &ref2, &start2);
 358                 else
 359                         ml2 = ml;
 360                 /* No better match */
 361                 if (ml2 == ml) {
 362                         lz4_encodesequence(&ip, &op, &anchor, ml, ref);
 363                         continue;
 364                 }
 365
 366                 if (start0 < ip) {
 367                         /* empirical */
 368                         if (start2 < ip + ml0) {
 369                                 ip = start0;
 370                                 ref = ref0;
 371                                 ml = ml0;
 372                         }
 373                 }
 374                 /*
 375                  * Here, start0==ip
 376                  * First Match too small : removed
 377                  */
 378                 if ((start2 - ip) < 3) {
 379                         ml = ml2;
 380                         ip = start2;
 381                         ref = ref2;
 382                         goto _search2;
 383                 }
 384
 385 _search3:
 386                 /*
 387                  * Currently we have :
 388                  * ml2 > ml1, and
 389                  * ip1+3 <= ip2 (usually < ip1+ml1)
 390                  */
 391                 if ((start2 - ip) < OPTIMAL_ML) {
 392                         int correction;
 393                         int new_ml = ml;
 394                         if (new_ml > OPTIMAL_ML)
 395                                 new_ml = OPTIMAL_ML;
 396                         if (ip + new_ml > start2 + ml2 - MINMATCH)
 397                                 new_ml = (int)(start2 - ip) + ml2 - MINMATCH;
 398                         correction = new_ml - (int)(start2 - ip);
 399                         if (correction > 0) {
 400                                 start2 += correction;
 401                                 ref2 += correction;
 402                                 ml2 -= correction;
 403                         }
 404                 }
 405                 /*
 406                  * Now, we have start2 = ip+new_ml,
 407                  * with new_ml=min(ml, OPTIMAL_ML=18)
 408                  */
 409                 if (start2 + ml2 < mflimit)
 410                         ml3 = lz4hc_insertandgetwidermatch(ctx,
 411                                 start2 + ml2 - 3, start2, matchlimit,
 412                                 ml2, &ref3, &start3);
 413                 else
 414                         ml3 = ml2;
 415
 416                 /* No better match : 2 sequences to encode */
 417                 if (ml3 == ml2) {
 418                         /* ip & ref are known; Now for ml */
 419                         if (start2 < ip+ml)
 420                                 ml = (int)(start2 - ip);
 421
 422                         /* Now, encode 2 sequences */
 423                         lz4_encodesequence(&ip, &op, &anchor, ml, ref);
 424                         ip = start2;
 425                         lz4_encodesequence(&ip, &op, &anchor, ml2, ref2);
 426                         continue;
 427                 }
 428
 429                 /* Not enough space for match 2 : remove it */
 430                 if (start3 < ip + ml + 3) {
 431                         /*
 432                          * can write Seq1 immediately ==> Seq2 is removed,
 433                          * so Seq3 becomes Seq1
 434                          */
 435                         if (start3 >= (ip + ml)) {
 436                                 if (start2 < ip + ml) {
 437                                         int correction =
 438                                                 (int)(ip + ml - start2);
 439                                         start2 += correction;
 440                                         ref2 += correction;
 441                                         ml2 -= correction;
 442                                         if (ml2 < MINMATCH) {
 443                                                 start2 = start3;
 444                                                 ref2 = ref3;
 445                                                 ml2 = ml3;
 446                                         }
 447                                 }
 448
 449                                 lz4_encodesequence(&ip, &op, &anchor, ml, ref);
 450                                 ip  = start3;
 451                                 ref = ref3;
 452                                 ml  = ml3;
 453
 454                                 start0 = start2;
 455                                 ref0 = ref2;
 456                                 ml0 = ml2;
 457                                 goto _search2;
 458                         }
 459
 460                         start2 = start3;
 461                         ref2 = ref3;
 462                         ml2 = ml3;
 463                         goto _search3;
 464                 }
 465
 466                 /*
 467                  * OK, now we have 3 ascending matches; let's write at least
 468                  * the first one ip & ref are known; Now for ml
 469                  */
 470                 if (start2 < ip + ml) {
 471                         if ((start2 - ip) < (int)ML_MASK) {
 472                                 int correction;
 473                                 if (ml > OPTIMAL_ML)
 474                                         ml = OPTIMAL_ML;
 475                                 if (ip + ml > start2 + ml2 - MINMATCH)
 476                                         ml = (int)(start2 - ip) + ml2
 477                                                 - MINMATCH;
 478                                 correction = ml - (int)(start2 - ip);
 479                                 if (correction > 0) {
 480                                         start2 += correction;
 481                                         ref2 += correction;
 482                                         ml2 -= correction;
 483                                 }
 484                         } else
 485                                 ml = (int)(start2 - ip);
 486                 }
 487                 lz4_encodesequence(&ip, &op, &anchor, ml, ref);
 488
 489                 ip = start2;
 490                 ref = ref2;
 491                 ml = ml2;
 492
 493                 start2 = start3;
 494                 ref2 = ref3;
 495                 ml2 = ml3;
 496
 497                 goto _search3;
 498         }
 499
 500         /* Encode Last Literals */
 501         lastrun = (int)(iend - anchor);
 502         if (lastrun >= (int)RUN_MASK) {
 503                 *op++ = (RUN_MASK << ML_BITS);
 504                 lastrun -= RUN_MASK;
 505                 for (; lastrun > 254 ; lastrun -= 255)
 506                         *op++ = 255;
 507                 *op++ = (u8) lastrun;
 508         } else
 509                 *op++ = (lastrun << ML_BITS);
 510         memcpy(op, anchor, iend - anchor);
 511         op += iend - anchor;
 512         /* End */
 513         return (int) (((char *)op) - dest);
 514 }
 515
 516 int lz4hc_compress(const unsigned char *src, size_t src_len,
 517                         unsigned char *dst, size_t *dst_len, void *wrkmem)
 518 {
 519         int ret = -1;
 520         int out_len = 0;
 521
 522         struct lz4hc_data *hc4 = (struct lz4hc_data *)wrkmem;
 523         lz4hc_init(hc4, (const u8 *)src);
 524         out_len = lz4_compresshcctx((struct lz4hc_data *)hc4, (const u8 *)src,
 525                 (char *)dst, (int)src_len);
 526
 527         if (out_len < 0)
 528                 goto exit;
 529
 530         *dst_len = out_len;
 531         return 0;
 532
 533 exit:
 534         return ret;
 535 }
 536 EXPORT_SYMBOL(lz4hc_compress);
 537
 538 MODULE_LICENSE("Dual BSD/GPL");
 539 MODULE_DESCRIPTION("LZ4HC compressor");