| /* |
| * Huffman decoder, part of New Generation Entropy library |
| * Copyright (C) 2013-2016, Yann Collet. |
| * |
| * BSD 2-Clause License (http://www.opensource.org/licenses/bsd-license.php) |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are |
| * met: |
| * |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above |
| * copyright notice, this list of conditions and the following disclaimer |
| * in the documentation and/or other materials provided with the |
| * distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
| * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
| * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
| * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * |
| * This program is free software; you can redistribute it and/or modify it under |
| * the terms of the GNU General Public License version 2 as published by the |
| * Free Software Foundation. This program is dual-licensed; you may select |
| * either version 2 of the GNU General Public License ("GPL") or BSD license |
| * ("BSD"). |
| * |
| * You can contact the author at : |
| * - Source repository : https://github.com/Cyan4973/FiniteStateEntropy |
| */ |
| |
| /* ************************************************************** |
| * Compiler specifics |
| ****************************************************************/ |
| #define FORCE_INLINE static __always_inline |
| |
| /* ************************************************************** |
| * Dependencies |
| ****************************************************************/ |
| #include "bitstream.h" /* BIT_* */ |
| #include "fse.h" /* header compression */ |
| #include "huf.h" |
| #include <linux/compiler.h> |
| #include <linux/kernel.h> |
| #include <linux/string.h> /* memcpy, memset */ |
| |
| /* ************************************************************** |
| * Error Management |
| ****************************************************************/ |
| #define HUF_STATIC_ASSERT(c) \ |
| { \ |
| enum { HUF_static_assert = 1 / (int)(!!(c)) }; \ |
| } /* use only *after* variable declarations */ |
| |
| /*-***************************/ |
| /* generic DTableDesc */ |
| /*-***************************/ |
| |
| typedef struct { |
| BYTE maxTableLog; |
| BYTE tableType; |
| BYTE tableLog; |
| BYTE reserved; |
| } DTableDesc; |
| |
| static DTableDesc HUF_getDTableDesc(const HUF_DTable *table) |
| { |
| DTableDesc dtd; |
| memcpy(&dtd, table, sizeof(dtd)); |
| return dtd; |
| } |
| |
| /*-***************************/ |
| /* single-symbol decoding */ |
| /*-***************************/ |
| |
| typedef struct { |
| BYTE byte; |
| BYTE nbBits; |
| } HUF_DEltX2; /* single-symbol decoding */ |
| |
| size_t HUF_readDTableX2_wksp(HUF_DTable *DTable, const void *src, size_t srcSize, void *workspace, size_t workspaceSize) |
| { |
| U32 tableLog = 0; |
| U32 nbSymbols = 0; |
| size_t iSize; |
| void *const dtPtr = DTable + 1; |
| HUF_DEltX2 *const dt = (HUF_DEltX2 *)dtPtr; |
| |
| U32 *rankVal; |
| BYTE *huffWeight; |
| size_t spaceUsed32 = 0; |
| |
| rankVal = (U32 *)workspace + spaceUsed32; |
| spaceUsed32 += HUF_TABLELOG_ABSOLUTEMAX + 1; |
| huffWeight = (BYTE *)((U32 *)workspace + spaceUsed32); |
| spaceUsed32 += ALIGN(HUF_SYMBOLVALUE_MAX + 1, sizeof(U32)) >> 2; |
| |
| if ((spaceUsed32 << 2) > workspaceSize) |
| return ERROR(tableLog_tooLarge); |
| workspace = (U32 *)workspace + spaceUsed32; |
| workspaceSize -= (spaceUsed32 << 2); |
| |
| HUF_STATIC_ASSERT(sizeof(DTableDesc) == sizeof(HUF_DTable)); |
| /* memset(huffWeight, 0, sizeof(huffWeight)); */ /* is not necessary, even though some analyzer complain ... */ |
| |
| iSize = HUF_readStats_wksp(huffWeight, HUF_SYMBOLVALUE_MAX + 1, rankVal, &nbSymbols, &tableLog, src, srcSize, workspace, workspaceSize); |
| if (HUF_isError(iSize)) |
| return iSize; |
| |
| /* Table header */ |
| { |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| if (tableLog > (U32)(dtd.maxTableLog + 1)) |
| return ERROR(tableLog_tooLarge); /* DTable too small, Huffman tree cannot fit in */ |
| dtd.tableType = 0; |
| dtd.tableLog = (BYTE)tableLog; |
| memcpy(DTable, &dtd, sizeof(dtd)); |
| } |
| |
| /* Calculate starting value for each rank */ |
| { |
| U32 n, nextRankStart = 0; |
| for (n = 1; n < tableLog + 1; n++) { |
| U32 const curr = nextRankStart; |
| nextRankStart += (rankVal[n] << (n - 1)); |
| rankVal[n] = curr; |
| } |
| } |
| |
| /* fill DTable */ |
| { |
| U32 n; |
| for (n = 0; n < nbSymbols; n++) { |
| U32 const w = huffWeight[n]; |
| U32 const length = (1 << w) >> 1; |
| U32 u; |
| HUF_DEltX2 D; |
| D.byte = (BYTE)n; |
| D.nbBits = (BYTE)(tableLog + 1 - w); |
| for (u = rankVal[w]; u < rankVal[w] + length; u++) |
| dt[u] = D; |
| rankVal[w] += length; |
| } |
| } |
| |
| return iSize; |
| } |
| |
| static BYTE HUF_decodeSymbolX2(BIT_DStream_t *Dstream, const HUF_DEltX2 *dt, const U32 dtLog) |
| { |
| size_t const val = BIT_lookBitsFast(Dstream, dtLog); /* note : dtLog >= 1 */ |
| BYTE const c = dt[val].byte; |
| BIT_skipBits(Dstream, dt[val].nbBits); |
| return c; |
| } |
| |
| #define HUF_DECODE_SYMBOLX2_0(ptr, DStreamPtr) *ptr++ = HUF_decodeSymbolX2(DStreamPtr, dt, dtLog) |
| |
| #define HUF_DECODE_SYMBOLX2_1(ptr, DStreamPtr) \ |
| if (ZSTD_64bits() || (HUF_TABLELOG_MAX <= 12)) \ |
| HUF_DECODE_SYMBOLX2_0(ptr, DStreamPtr) |
| |
| #define HUF_DECODE_SYMBOLX2_2(ptr, DStreamPtr) \ |
| if (ZSTD_64bits()) \ |
| HUF_DECODE_SYMBOLX2_0(ptr, DStreamPtr) |
| |
| FORCE_INLINE size_t HUF_decodeStreamX2(BYTE *p, BIT_DStream_t *const bitDPtr, BYTE *const pEnd, const HUF_DEltX2 *const dt, const U32 dtLog) |
| { |
| BYTE *const pStart = p; |
| |
| /* up to 4 symbols at a time */ |
| while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) && (p <= pEnd - 4)) { |
| HUF_DECODE_SYMBOLX2_2(p, bitDPtr); |
| HUF_DECODE_SYMBOLX2_1(p, bitDPtr); |
| HUF_DECODE_SYMBOLX2_2(p, bitDPtr); |
| HUF_DECODE_SYMBOLX2_0(p, bitDPtr); |
| } |
| |
| /* closer to the end */ |
| while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) && (p < pEnd)) |
| HUF_DECODE_SYMBOLX2_0(p, bitDPtr); |
| |
| /* no more data to retrieve from bitstream, hence no need to reload */ |
| while (p < pEnd) |
| HUF_DECODE_SYMBOLX2_0(p, bitDPtr); |
| |
| return pEnd - pStart; |
| } |
| |
| static size_t HUF_decompress1X2_usingDTable_internal(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| BYTE *op = (BYTE *)dst; |
| BYTE *const oend = op + dstSize; |
| const void *dtPtr = DTable + 1; |
| const HUF_DEltX2 *const dt = (const HUF_DEltX2 *)dtPtr; |
| BIT_DStream_t bitD; |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| U32 const dtLog = dtd.tableLog; |
| |
| { |
| size_t const errorCode = BIT_initDStream(&bitD, cSrc, cSrcSize); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| |
| HUF_decodeStreamX2(op, &bitD, oend, dt, dtLog); |
| |
| /* check */ |
| if (!BIT_endOfDStream(&bitD)) |
| return ERROR(corruption_detected); |
| |
| return dstSize; |
| } |
| |
| size_t HUF_decompress1X2_usingDTable(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| if (dtd.tableType != 0) |
| return ERROR(GENERIC); |
| return HUF_decompress1X2_usingDTable_internal(dst, dstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| size_t HUF_decompress1X2_DCtx_wksp(HUF_DTable *DCtx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| const BYTE *ip = (const BYTE *)cSrc; |
| |
| size_t const hSize = HUF_readDTableX2_wksp(DCtx, cSrc, cSrcSize, workspace, workspaceSize); |
| if (HUF_isError(hSize)) |
| return hSize; |
| if (hSize >= cSrcSize) |
| return ERROR(srcSize_wrong); |
| ip += hSize; |
| cSrcSize -= hSize; |
| |
| return HUF_decompress1X2_usingDTable_internal(dst, dstSize, ip, cSrcSize, DCtx); |
| } |
| |
| static size_t HUF_decompress4X2_usingDTable_internal(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| /* Check */ |
| if (cSrcSize < 10) |
| return ERROR(corruption_detected); /* strict minimum : jump table + 1 byte per stream */ |
| |
| { |
| const BYTE *const istart = (const BYTE *)cSrc; |
| BYTE *const ostart = (BYTE *)dst; |
| BYTE *const oend = ostart + dstSize; |
| const void *const dtPtr = DTable + 1; |
| const HUF_DEltX2 *const dt = (const HUF_DEltX2 *)dtPtr; |
| |
| /* Init */ |
| BIT_DStream_t bitD1; |
| BIT_DStream_t bitD2; |
| BIT_DStream_t bitD3; |
| BIT_DStream_t bitD4; |
| size_t const length1 = ZSTD_readLE16(istart); |
| size_t const length2 = ZSTD_readLE16(istart + 2); |
| size_t const length3 = ZSTD_readLE16(istart + 4); |
| size_t const length4 = cSrcSize - (length1 + length2 + length3 + 6); |
| const BYTE *const istart1 = istart + 6; /* jumpTable */ |
| const BYTE *const istart2 = istart1 + length1; |
| const BYTE *const istart3 = istart2 + length2; |
| const BYTE *const istart4 = istart3 + length3; |
| const size_t segmentSize = (dstSize + 3) / 4; |
| BYTE *const opStart2 = ostart + segmentSize; |
| BYTE *const opStart3 = opStart2 + segmentSize; |
| BYTE *const opStart4 = opStart3 + segmentSize; |
| BYTE *op1 = ostart; |
| BYTE *op2 = opStart2; |
| BYTE *op3 = opStart3; |
| BYTE *op4 = opStart4; |
| U32 endSignal; |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| U32 const dtLog = dtd.tableLog; |
| |
| if (length4 > cSrcSize) |
| return ERROR(corruption_detected); /* overflow */ |
| { |
| size_t const errorCode = BIT_initDStream(&bitD1, istart1, length1); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD2, istart2, length2); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD3, istart3, length3); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD4, istart4, length4); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| |
| /* 16-32 symbols per loop (4-8 symbols per stream) */ |
| endSignal = BIT_reloadDStream(&bitD1) | BIT_reloadDStream(&bitD2) | BIT_reloadDStream(&bitD3) | BIT_reloadDStream(&bitD4); |
| for (; (endSignal == BIT_DStream_unfinished) && (op4 < (oend - 7));) { |
| HUF_DECODE_SYMBOLX2_2(op1, &bitD1); |
| HUF_DECODE_SYMBOLX2_2(op2, &bitD2); |
| HUF_DECODE_SYMBOLX2_2(op3, &bitD3); |
| HUF_DECODE_SYMBOLX2_2(op4, &bitD4); |
| HUF_DECODE_SYMBOLX2_1(op1, &bitD1); |
| HUF_DECODE_SYMBOLX2_1(op2, &bitD2); |
| HUF_DECODE_SYMBOLX2_1(op3, &bitD3); |
| HUF_DECODE_SYMBOLX2_1(op4, &bitD4); |
| HUF_DECODE_SYMBOLX2_2(op1, &bitD1); |
| HUF_DECODE_SYMBOLX2_2(op2, &bitD2); |
| HUF_DECODE_SYMBOLX2_2(op3, &bitD3); |
| HUF_DECODE_SYMBOLX2_2(op4, &bitD4); |
| HUF_DECODE_SYMBOLX2_0(op1, &bitD1); |
| HUF_DECODE_SYMBOLX2_0(op2, &bitD2); |
| HUF_DECODE_SYMBOLX2_0(op3, &bitD3); |
| HUF_DECODE_SYMBOLX2_0(op4, &bitD4); |
| endSignal = BIT_reloadDStream(&bitD1) | BIT_reloadDStream(&bitD2) | BIT_reloadDStream(&bitD3) | BIT_reloadDStream(&bitD4); |
| } |
| |
| /* check corruption */ |
| if (op1 > opStart2) |
| return ERROR(corruption_detected); |
| if (op2 > opStart3) |
| return ERROR(corruption_detected); |
| if (op3 > opStart4) |
| return ERROR(corruption_detected); |
| /* note : op4 supposed already verified within main loop */ |
| |
| /* finish bitStreams one by one */ |
| HUF_decodeStreamX2(op1, &bitD1, opStart2, dt, dtLog); |
| HUF_decodeStreamX2(op2, &bitD2, opStart3, dt, dtLog); |
| HUF_decodeStreamX2(op3, &bitD3, opStart4, dt, dtLog); |
| HUF_decodeStreamX2(op4, &bitD4, oend, dt, dtLog); |
| |
| /* check */ |
| endSignal = BIT_endOfDStream(&bitD1) & BIT_endOfDStream(&bitD2) & BIT_endOfDStream(&bitD3) & BIT_endOfDStream(&bitD4); |
| if (!endSignal) |
| return ERROR(corruption_detected); |
| |
| /* decoded size */ |
| return dstSize; |
| } |
| } |
| |
| size_t HUF_decompress4X2_usingDTable(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| if (dtd.tableType != 0) |
| return ERROR(GENERIC); |
| return HUF_decompress4X2_usingDTable_internal(dst, dstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| size_t HUF_decompress4X2_DCtx_wksp(HUF_DTable *dctx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| const BYTE *ip = (const BYTE *)cSrc; |
| |
| size_t const hSize = HUF_readDTableX2_wksp(dctx, cSrc, cSrcSize, workspace, workspaceSize); |
| if (HUF_isError(hSize)) |
| return hSize; |
| if (hSize >= cSrcSize) |
| return ERROR(srcSize_wrong); |
| ip += hSize; |
| cSrcSize -= hSize; |
| |
| return HUF_decompress4X2_usingDTable_internal(dst, dstSize, ip, cSrcSize, dctx); |
| } |
| |
| /* *************************/ |
| /* double-symbols decoding */ |
| /* *************************/ |
| typedef struct { |
| U16 sequence; |
| BYTE nbBits; |
| BYTE length; |
| } HUF_DEltX4; /* double-symbols decoding */ |
| |
| typedef struct { |
| BYTE symbol; |
| BYTE weight; |
| } sortedSymbol_t; |
| |
| /* HUF_fillDTableX4Level2() : |
| * `rankValOrigin` must be a table of at least (HUF_TABLELOG_MAX + 1) U32 */ |
| static void HUF_fillDTableX4Level2(HUF_DEltX4 *DTable, U32 sizeLog, const U32 consumed, const U32 *rankValOrigin, const int minWeight, |
| const sortedSymbol_t *sortedSymbols, const U32 sortedListSize, U32 nbBitsBaseline, U16 baseSeq) |
| { |
| HUF_DEltX4 DElt; |
| U32 rankVal[HUF_TABLELOG_MAX + 1]; |
| |
| /* get pre-calculated rankVal */ |
| memcpy(rankVal, rankValOrigin, sizeof(rankVal)); |
| |
| /* fill skipped values */ |
| if (minWeight > 1) { |
| U32 i, skipSize = rankVal[minWeight]; |
| ZSTD_writeLE16(&(DElt.sequence), baseSeq); |
| DElt.nbBits = (BYTE)(consumed); |
| DElt.length = 1; |
| for (i = 0; i < skipSize; i++) |
| DTable[i] = DElt; |
| } |
| |
| /* fill DTable */ |
| { |
| U32 s; |
| for (s = 0; s < sortedListSize; s++) { /* note : sortedSymbols already skipped */ |
| const U32 symbol = sortedSymbols[s].symbol; |
| const U32 weight = sortedSymbols[s].weight; |
| const U32 nbBits = nbBitsBaseline - weight; |
| const U32 length = 1 << (sizeLog - nbBits); |
| const U32 start = rankVal[weight]; |
| U32 i = start; |
| const U32 end = start + length; |
| |
| ZSTD_writeLE16(&(DElt.sequence), (U16)(baseSeq + (symbol << 8))); |
| DElt.nbBits = (BYTE)(nbBits + consumed); |
| DElt.length = 2; |
| do { |
| DTable[i++] = DElt; |
| } while (i < end); /* since length >= 1 */ |
| |
| rankVal[weight] += length; |
| } |
| } |
| } |
| |
| typedef U32 rankVal_t[HUF_TABLELOG_MAX][HUF_TABLELOG_MAX + 1]; |
| typedef U32 rankValCol_t[HUF_TABLELOG_MAX + 1]; |
| |
| static void HUF_fillDTableX4(HUF_DEltX4 *DTable, const U32 targetLog, const sortedSymbol_t *sortedList, const U32 sortedListSize, const U32 *rankStart, |
| rankVal_t rankValOrigin, const U32 maxWeight, const U32 nbBitsBaseline) |
| { |
| U32 rankVal[HUF_TABLELOG_MAX + 1]; |
| const int scaleLog = nbBitsBaseline - targetLog; /* note : targetLog >= srcLog, hence scaleLog <= 1 */ |
| const U32 minBits = nbBitsBaseline - maxWeight; |
| U32 s; |
| |
| memcpy(rankVal, rankValOrigin, sizeof(rankVal)); |
| |
| /* fill DTable */ |
| for (s = 0; s < sortedListSize; s++) { |
| const U16 symbol = sortedList[s].symbol; |
| const U32 weight = sortedList[s].weight; |
| const U32 nbBits = nbBitsBaseline - weight; |
| const U32 start = rankVal[weight]; |
| const U32 length = 1 << (targetLog - nbBits); |
| |
| if (targetLog - nbBits >= minBits) { /* enough room for a second symbol */ |
| U32 sortedRank; |
| int minWeight = nbBits + scaleLog; |
| if (minWeight < 1) |
| minWeight = 1; |
| sortedRank = rankStart[minWeight]; |
| HUF_fillDTableX4Level2(DTable + start, targetLog - nbBits, nbBits, rankValOrigin[nbBits], minWeight, sortedList + sortedRank, |
| sortedListSize - sortedRank, nbBitsBaseline, symbol); |
| } else { |
| HUF_DEltX4 DElt; |
| ZSTD_writeLE16(&(DElt.sequence), symbol); |
| DElt.nbBits = (BYTE)(nbBits); |
| DElt.length = 1; |
| { |
| U32 const end = start + length; |
| U32 u; |
| for (u = start; u < end; u++) |
| DTable[u] = DElt; |
| } |
| } |
| rankVal[weight] += length; |
| } |
| } |
| |
| size_t HUF_readDTableX4_wksp(HUF_DTable *DTable, const void *src, size_t srcSize, void *workspace, size_t workspaceSize) |
| { |
| U32 tableLog, maxW, sizeOfSort, nbSymbols; |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| U32 const maxTableLog = dtd.maxTableLog; |
| size_t iSize; |
| void *dtPtr = DTable + 1; /* force compiler to avoid strict-aliasing */ |
| HUF_DEltX4 *const dt = (HUF_DEltX4 *)dtPtr; |
| U32 *rankStart; |
| |
| rankValCol_t *rankVal; |
| U32 *rankStats; |
| U32 *rankStart0; |
| sortedSymbol_t *sortedSymbol; |
| BYTE *weightList; |
| size_t spaceUsed32 = 0; |
| |
| HUF_STATIC_ASSERT((sizeof(rankValCol_t) & 3) == 0); |
| |
| rankVal = (rankValCol_t *)((U32 *)workspace + spaceUsed32); |
| spaceUsed32 += (sizeof(rankValCol_t) * HUF_TABLELOG_MAX) >> 2; |
| rankStats = (U32 *)workspace + spaceUsed32; |
| spaceUsed32 += HUF_TABLELOG_MAX + 1; |
| rankStart0 = (U32 *)workspace + spaceUsed32; |
| spaceUsed32 += HUF_TABLELOG_MAX + 2; |
| sortedSymbol = (sortedSymbol_t *)((U32 *)workspace + spaceUsed32); |
| spaceUsed32 += ALIGN(sizeof(sortedSymbol_t) * (HUF_SYMBOLVALUE_MAX + 1), sizeof(U32)) >> 2; |
| weightList = (BYTE *)((U32 *)workspace + spaceUsed32); |
| spaceUsed32 += ALIGN(HUF_SYMBOLVALUE_MAX + 1, sizeof(U32)) >> 2; |
| |
| if ((spaceUsed32 << 2) > workspaceSize) |
| return ERROR(tableLog_tooLarge); |
| workspace = (U32 *)workspace + spaceUsed32; |
| workspaceSize -= (spaceUsed32 << 2); |
| |
| rankStart = rankStart0 + 1; |
| memset(rankStats, 0, sizeof(U32) * (2 * HUF_TABLELOG_MAX + 2 + 1)); |
| |
| HUF_STATIC_ASSERT(sizeof(HUF_DEltX4) == sizeof(HUF_DTable)); /* if compiler fails here, assertion is wrong */ |
| if (maxTableLog > HUF_TABLELOG_MAX) |
| return ERROR(tableLog_tooLarge); |
| /* memset(weightList, 0, sizeof(weightList)); */ /* is not necessary, even though some analyzer complain ... */ |
| |
| iSize = HUF_readStats_wksp(weightList, HUF_SYMBOLVALUE_MAX + 1, rankStats, &nbSymbols, &tableLog, src, srcSize, workspace, workspaceSize); |
| if (HUF_isError(iSize)) |
| return iSize; |
| |
| /* check result */ |
| if (tableLog > maxTableLog) |
| return ERROR(tableLog_tooLarge); /* DTable can't fit code depth */ |
| |
| /* find maxWeight */ |
| for (maxW = tableLog; rankStats[maxW] == 0; maxW--) { |
| } /* necessarily finds a solution before 0 */ |
| |
| /* Get start index of each weight */ |
| { |
| U32 w, nextRankStart = 0; |
| for (w = 1; w < maxW + 1; w++) { |
| U32 curr = nextRankStart; |
| nextRankStart += rankStats[w]; |
| rankStart[w] = curr; |
| } |
| rankStart[0] = nextRankStart; /* put all 0w symbols at the end of sorted list*/ |
| sizeOfSort = nextRankStart; |
| } |
| |
| /* sort symbols by weight */ |
| { |
| U32 s; |
| for (s = 0; s < nbSymbols; s++) { |
| U32 const w = weightList[s]; |
| U32 const r = rankStart[w]++; |
| sortedSymbol[r].symbol = (BYTE)s; |
| sortedSymbol[r].weight = (BYTE)w; |
| } |
| rankStart[0] = 0; /* forget 0w symbols; this is beginning of weight(1) */ |
| } |
| |
| /* Build rankVal */ |
| { |
| U32 *const rankVal0 = rankVal[0]; |
| { |
| int const rescale = (maxTableLog - tableLog) - 1; /* tableLog <= maxTableLog */ |
| U32 nextRankVal = 0; |
| U32 w; |
| for (w = 1; w < maxW + 1; w++) { |
| U32 curr = nextRankVal; |
| nextRankVal += rankStats[w] << (w + rescale); |
| rankVal0[w] = curr; |
| } |
| } |
| { |
| U32 const minBits = tableLog + 1 - maxW; |
| U32 consumed; |
| for (consumed = minBits; consumed < maxTableLog - minBits + 1; consumed++) { |
| U32 *const rankValPtr = rankVal[consumed]; |
| U32 w; |
| for (w = 1; w < maxW + 1; w++) { |
| rankValPtr[w] = rankVal0[w] >> consumed; |
| } |
| } |
| } |
| } |
| |
| HUF_fillDTableX4(dt, maxTableLog, sortedSymbol, sizeOfSort, rankStart0, rankVal, maxW, tableLog + 1); |
| |
| dtd.tableLog = (BYTE)maxTableLog; |
| dtd.tableType = 1; |
| memcpy(DTable, &dtd, sizeof(dtd)); |
| return iSize; |
| } |
| |
| static U32 HUF_decodeSymbolX4(void *op, BIT_DStream_t *DStream, const HUF_DEltX4 *dt, const U32 dtLog) |
| { |
| size_t const val = BIT_lookBitsFast(DStream, dtLog); /* note : dtLog >= 1 */ |
| memcpy(op, dt + val, 2); |
| BIT_skipBits(DStream, dt[val].nbBits); |
| return dt[val].length; |
| } |
| |
| static U32 HUF_decodeLastSymbolX4(void *op, BIT_DStream_t *DStream, const HUF_DEltX4 *dt, const U32 dtLog) |
| { |
| size_t const val = BIT_lookBitsFast(DStream, dtLog); /* note : dtLog >= 1 */ |
| memcpy(op, dt + val, 1); |
| if (dt[val].length == 1) |
| BIT_skipBits(DStream, dt[val].nbBits); |
| else { |
| if (DStream->bitsConsumed < (sizeof(DStream->bitContainer) * 8)) { |
| BIT_skipBits(DStream, dt[val].nbBits); |
| if (DStream->bitsConsumed > (sizeof(DStream->bitContainer) * 8)) |
| /* ugly hack; works only because it's the last symbol. Note : can't easily extract nbBits from just this symbol */ |
| DStream->bitsConsumed = (sizeof(DStream->bitContainer) * 8); |
| } |
| } |
| return 1; |
| } |
| |
| #define HUF_DECODE_SYMBOLX4_0(ptr, DStreamPtr) ptr += HUF_decodeSymbolX4(ptr, DStreamPtr, dt, dtLog) |
| |
| #define HUF_DECODE_SYMBOLX4_1(ptr, DStreamPtr) \ |
| if (ZSTD_64bits() || (HUF_TABLELOG_MAX <= 12)) \ |
| ptr += HUF_decodeSymbolX4(ptr, DStreamPtr, dt, dtLog) |
| |
| #define HUF_DECODE_SYMBOLX4_2(ptr, DStreamPtr) \ |
| if (ZSTD_64bits()) \ |
| ptr += HUF_decodeSymbolX4(ptr, DStreamPtr, dt, dtLog) |
| |
| FORCE_INLINE size_t HUF_decodeStreamX4(BYTE *p, BIT_DStream_t *bitDPtr, BYTE *const pEnd, const HUF_DEltX4 *const dt, const U32 dtLog) |
| { |
| BYTE *const pStart = p; |
| |
| /* up to 8 symbols at a time */ |
| while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p < pEnd - (sizeof(bitDPtr->bitContainer) - 1))) { |
| HUF_DECODE_SYMBOLX4_2(p, bitDPtr); |
| HUF_DECODE_SYMBOLX4_1(p, bitDPtr); |
| HUF_DECODE_SYMBOLX4_2(p, bitDPtr); |
| HUF_DECODE_SYMBOLX4_0(p, bitDPtr); |
| } |
| |
| /* closer to end : up to 2 symbols at a time */ |
| while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p <= pEnd - 2)) |
| HUF_DECODE_SYMBOLX4_0(p, bitDPtr); |
| |
| while (p <= pEnd - 2) |
| HUF_DECODE_SYMBOLX4_0(p, bitDPtr); /* no need to reload : reached the end of DStream */ |
| |
| if (p < pEnd) |
| p += HUF_decodeLastSymbolX4(p, bitDPtr, dt, dtLog); |
| |
| return p - pStart; |
| } |
| |
| static size_t HUF_decompress1X4_usingDTable_internal(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| BIT_DStream_t bitD; |
| |
| /* Init */ |
| { |
| size_t const errorCode = BIT_initDStream(&bitD, cSrc, cSrcSize); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| |
| /* decode */ |
| { |
| BYTE *const ostart = (BYTE *)dst; |
| BYTE *const oend = ostart + dstSize; |
| const void *const dtPtr = DTable + 1; /* force compiler to not use strict-aliasing */ |
| const HUF_DEltX4 *const dt = (const HUF_DEltX4 *)dtPtr; |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| HUF_decodeStreamX4(ostart, &bitD, oend, dt, dtd.tableLog); |
| } |
| |
| /* check */ |
| if (!BIT_endOfDStream(&bitD)) |
| return ERROR(corruption_detected); |
| |
| /* decoded size */ |
| return dstSize; |
| } |
| |
| size_t HUF_decompress1X4_usingDTable(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| if (dtd.tableType != 1) |
| return ERROR(GENERIC); |
| return HUF_decompress1X4_usingDTable_internal(dst, dstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| size_t HUF_decompress1X4_DCtx_wksp(HUF_DTable *DCtx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| const BYTE *ip = (const BYTE *)cSrc; |
| |
| size_t const hSize = HUF_readDTableX4_wksp(DCtx, cSrc, cSrcSize, workspace, workspaceSize); |
| if (HUF_isError(hSize)) |
| return hSize; |
| if (hSize >= cSrcSize) |
| return ERROR(srcSize_wrong); |
| ip += hSize; |
| cSrcSize -= hSize; |
| |
| return HUF_decompress1X4_usingDTable_internal(dst, dstSize, ip, cSrcSize, DCtx); |
| } |
| |
| static size_t HUF_decompress4X4_usingDTable_internal(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| if (cSrcSize < 10) |
| return ERROR(corruption_detected); /* strict minimum : jump table + 1 byte per stream */ |
| |
| { |
| const BYTE *const istart = (const BYTE *)cSrc; |
| BYTE *const ostart = (BYTE *)dst; |
| BYTE *const oend = ostart + dstSize; |
| const void *const dtPtr = DTable + 1; |
| const HUF_DEltX4 *const dt = (const HUF_DEltX4 *)dtPtr; |
| |
| /* Init */ |
| BIT_DStream_t bitD1; |
| BIT_DStream_t bitD2; |
| BIT_DStream_t bitD3; |
| BIT_DStream_t bitD4; |
| size_t const length1 = ZSTD_readLE16(istart); |
| size_t const length2 = ZSTD_readLE16(istart + 2); |
| size_t const length3 = ZSTD_readLE16(istart + 4); |
| size_t const length4 = cSrcSize - (length1 + length2 + length3 + 6); |
| const BYTE *const istart1 = istart + 6; /* jumpTable */ |
| const BYTE *const istart2 = istart1 + length1; |
| const BYTE *const istart3 = istart2 + length2; |
| const BYTE *const istart4 = istart3 + length3; |
| size_t const segmentSize = (dstSize + 3) / 4; |
| BYTE *const opStart2 = ostart + segmentSize; |
| BYTE *const opStart3 = opStart2 + segmentSize; |
| BYTE *const opStart4 = opStart3 + segmentSize; |
| BYTE *op1 = ostart; |
| BYTE *op2 = opStart2; |
| BYTE *op3 = opStart3; |
| BYTE *op4 = opStart4; |
| U32 endSignal; |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| U32 const dtLog = dtd.tableLog; |
| |
| if (length4 > cSrcSize) |
| return ERROR(corruption_detected); /* overflow */ |
| { |
| size_t const errorCode = BIT_initDStream(&bitD1, istart1, length1); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD2, istart2, length2); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD3, istart3, length3); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| { |
| size_t const errorCode = BIT_initDStream(&bitD4, istart4, length4); |
| if (HUF_isError(errorCode)) |
| return errorCode; |
| } |
| |
| /* 16-32 symbols per loop (4-8 symbols per stream) */ |
| endSignal = BIT_reloadDStream(&bitD1) | BIT_reloadDStream(&bitD2) | BIT_reloadDStream(&bitD3) | BIT_reloadDStream(&bitD4); |
| for (; (endSignal == BIT_DStream_unfinished) & (op4 < (oend - (sizeof(bitD4.bitContainer) - 1)));) { |
| HUF_DECODE_SYMBOLX4_2(op1, &bitD1); |
| HUF_DECODE_SYMBOLX4_2(op2, &bitD2); |
| HUF_DECODE_SYMBOLX4_2(op3, &bitD3); |
| HUF_DECODE_SYMBOLX4_2(op4, &bitD4); |
| HUF_DECODE_SYMBOLX4_1(op1, &bitD1); |
| HUF_DECODE_SYMBOLX4_1(op2, &bitD2); |
| HUF_DECODE_SYMBOLX4_1(op3, &bitD3); |
| HUF_DECODE_SYMBOLX4_1(op4, &bitD4); |
| HUF_DECODE_SYMBOLX4_2(op1, &bitD1); |
| HUF_DECODE_SYMBOLX4_2(op2, &bitD2); |
| HUF_DECODE_SYMBOLX4_2(op3, &bitD3); |
| HUF_DECODE_SYMBOLX4_2(op4, &bitD4); |
| HUF_DECODE_SYMBOLX4_0(op1, &bitD1); |
| HUF_DECODE_SYMBOLX4_0(op2, &bitD2); |
| HUF_DECODE_SYMBOLX4_0(op3, &bitD3); |
| HUF_DECODE_SYMBOLX4_0(op4, &bitD4); |
| |
| endSignal = BIT_reloadDStream(&bitD1) | BIT_reloadDStream(&bitD2) | BIT_reloadDStream(&bitD3) | BIT_reloadDStream(&bitD4); |
| } |
| |
| /* check corruption */ |
| if (op1 > opStart2) |
| return ERROR(corruption_detected); |
| if (op2 > opStart3) |
| return ERROR(corruption_detected); |
| if (op3 > opStart4) |
| return ERROR(corruption_detected); |
| /* note : op4 already verified within main loop */ |
| |
| /* finish bitStreams one by one */ |
| HUF_decodeStreamX4(op1, &bitD1, opStart2, dt, dtLog); |
| HUF_decodeStreamX4(op2, &bitD2, opStart3, dt, dtLog); |
| HUF_decodeStreamX4(op3, &bitD3, opStart4, dt, dtLog); |
| HUF_decodeStreamX4(op4, &bitD4, oend, dt, dtLog); |
| |
| /* check */ |
| { |
| U32 const endCheck = BIT_endOfDStream(&bitD1) & BIT_endOfDStream(&bitD2) & BIT_endOfDStream(&bitD3) & BIT_endOfDStream(&bitD4); |
| if (!endCheck) |
| return ERROR(corruption_detected); |
| } |
| |
| /* decoded size */ |
| return dstSize; |
| } |
| } |
| |
| size_t HUF_decompress4X4_usingDTable(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc dtd = HUF_getDTableDesc(DTable); |
| if (dtd.tableType != 1) |
| return ERROR(GENERIC); |
| return HUF_decompress4X4_usingDTable_internal(dst, dstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| size_t HUF_decompress4X4_DCtx_wksp(HUF_DTable *dctx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| const BYTE *ip = (const BYTE *)cSrc; |
| |
| size_t hSize = HUF_readDTableX4_wksp(dctx, cSrc, cSrcSize, workspace, workspaceSize); |
| if (HUF_isError(hSize)) |
| return hSize; |
| if (hSize >= cSrcSize) |
| return ERROR(srcSize_wrong); |
| ip += hSize; |
| cSrcSize -= hSize; |
| |
| return HUF_decompress4X4_usingDTable_internal(dst, dstSize, ip, cSrcSize, dctx); |
| } |
| |
| /* ********************************/ |
| /* Generic decompression selector */ |
| /* ********************************/ |
| |
| size_t HUF_decompress1X_usingDTable(void *dst, size_t maxDstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| return dtd.tableType ? HUF_decompress1X4_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable) |
| : HUF_decompress1X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| size_t HUF_decompress4X_usingDTable(void *dst, size_t maxDstSize, const void *cSrc, size_t cSrcSize, const HUF_DTable *DTable) |
| { |
| DTableDesc const dtd = HUF_getDTableDesc(DTable); |
| return dtd.tableType ? HUF_decompress4X4_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable) |
| : HUF_decompress4X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable); |
| } |
| |
| typedef struct { |
| U32 tableTime; |
| U32 decode256Time; |
| } algo_time_t; |
| static const algo_time_t algoTime[16 /* Quantization */][3 /* single, double, quad */] = { |
| /* single, double, quad */ |
| {{0, 0}, {1, 1}, {2, 2}}, /* Q==0 : impossible */ |
| {{0, 0}, {1, 1}, {2, 2}}, /* Q==1 : impossible */ |
| {{38, 130}, {1313, 74}, {2151, 38}}, /* Q == 2 : 12-18% */ |
| {{448, 128}, {1353, 74}, {2238, 41}}, /* Q == 3 : 18-25% */ |
| {{556, 128}, {1353, 74}, {2238, 47}}, /* Q == 4 : 25-32% */ |
| {{714, 128}, {1418, 74}, {2436, 53}}, /* Q == 5 : 32-38% */ |
| {{883, 128}, {1437, 74}, {2464, 61}}, /* Q == 6 : 38-44% */ |
| {{897, 128}, {1515, 75}, {2622, 68}}, /* Q == 7 : 44-50% */ |
| {{926, 128}, {1613, 75}, {2730, 75}}, /* Q == 8 : 50-56% */ |
| {{947, 128}, {1729, 77}, {3359, 77}}, /* Q == 9 : 56-62% */ |
| {{1107, 128}, {2083, 81}, {4006, 84}}, /* Q ==10 : 62-69% */ |
| {{1177, 128}, {2379, 87}, {4785, 88}}, /* Q ==11 : 69-75% */ |
| {{1242, 128}, {2415, 93}, {5155, 84}}, /* Q ==12 : 75-81% */ |
| {{1349, 128}, {2644, 106}, {5260, 106}}, /* Q ==13 : 81-87% */ |
| {{1455, 128}, {2422, 124}, {4174, 124}}, /* Q ==14 : 87-93% */ |
| {{722, 128}, {1891, 145}, {1936, 146}}, /* Q ==15 : 93-99% */ |
| }; |
| |
| /** HUF_selectDecoder() : |
| * Tells which decoder is likely to decode faster, |
| * based on a set of pre-determined metrics. |
| * @return : 0==HUF_decompress4X2, 1==HUF_decompress4X4 . |
| * Assumption : 0 < cSrcSize < dstSize <= 128 KB */ |
| U32 HUF_selectDecoder(size_t dstSize, size_t cSrcSize) |
| { |
| /* decoder timing evaluation */ |
| U32 const Q = (U32)(cSrcSize * 16 / dstSize); /* Q < 16 since dstSize > cSrcSize */ |
| U32 const D256 = (U32)(dstSize >> 8); |
| U32 const DTime0 = algoTime[Q][0].tableTime + (algoTime[Q][0].decode256Time * D256); |
| U32 DTime1 = algoTime[Q][1].tableTime + (algoTime[Q][1].decode256Time * D256); |
| DTime1 += DTime1 >> 3; /* advantage to algorithm using less memory, for cache eviction */ |
| |
| return DTime1 < DTime0; |
| } |
| |
| typedef size_t (*decompressionAlgo)(void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize); |
| |
| size_t HUF_decompress4X_DCtx_wksp(HUF_DTable *dctx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| /* validation checks */ |
| if (dstSize == 0) |
| return ERROR(dstSize_tooSmall); |
| if (cSrcSize > dstSize) |
| return ERROR(corruption_detected); /* invalid */ |
| if (cSrcSize == dstSize) { |
| memcpy(dst, cSrc, dstSize); |
| return dstSize; |
| } /* not compressed */ |
| if (cSrcSize == 1) { |
| memset(dst, *(const BYTE *)cSrc, dstSize); |
| return dstSize; |
| } /* RLE */ |
| |
| { |
| U32 const algoNb = HUF_selectDecoder(dstSize, cSrcSize); |
| return algoNb ? HUF_decompress4X4_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize) |
| : HUF_decompress4X2_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize); |
| } |
| } |
| |
| size_t HUF_decompress4X_hufOnly_wksp(HUF_DTable *dctx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| /* validation checks */ |
| if (dstSize == 0) |
| return ERROR(dstSize_tooSmall); |
| if ((cSrcSize >= dstSize) || (cSrcSize <= 1)) |
| return ERROR(corruption_detected); /* invalid */ |
| |
| { |
| U32 const algoNb = HUF_selectDecoder(dstSize, cSrcSize); |
| return algoNb ? HUF_decompress4X4_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize) |
| : HUF_decompress4X2_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize); |
| } |
| } |
| |
| size_t HUF_decompress1X_DCtx_wksp(HUF_DTable *dctx, void *dst, size_t dstSize, const void *cSrc, size_t cSrcSize, void *workspace, size_t workspaceSize) |
| { |
| /* validation checks */ |
| if (dstSize == 0) |
| return ERROR(dstSize_tooSmall); |
| if (cSrcSize > dstSize) |
| return ERROR(corruption_detected); /* invalid */ |
| if (cSrcSize == dstSize) { |
| memcpy(dst, cSrc, dstSize); |
| return dstSize; |
| } /* not compressed */ |
| if (cSrcSize == 1) { |
| memset(dst, *(const BYTE *)cSrc, dstSize); |
| return dstSize; |
| } /* RLE */ |
| |
| { |
| U32 const algoNb = HUF_selectDecoder(dstSize, cSrcSize); |
| return algoNb ? HUF_decompress1X4_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize) |
| : HUF_decompress1X2_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workspace, workspaceSize); |
| } |
| } |