xref: /netbsd-src/external/bsd/zstd/dist/lib/decompress/huf_decompress.c (revision 3117ece4fc4a4ca4489ba793710b60b0d26bab6c)
1*3117ece4Schristos /* ******************************************************************
2*3117ece4Schristos  * huff0 huffman decoder,
3*3117ece4Schristos  * part of Finite State Entropy library
4*3117ece4Schristos  * Copyright (c) Meta Platforms, Inc. and affiliates.
5*3117ece4Schristos  *
6*3117ece4Schristos  *  You can contact the author at :
7*3117ece4Schristos  *  - FSE+HUF source repository : https://github.com/Cyan4973/FiniteStateEntropy
8*3117ece4Schristos  *
9*3117ece4Schristos  * This source code is licensed under both the BSD-style license (found in the
10*3117ece4Schristos  * LICENSE file in the root directory of this source tree) and the GPLv2 (found
11*3117ece4Schristos  * in the COPYING file in the root directory of this source tree).
12*3117ece4Schristos  * You may select, at your option, one of the above-listed licenses.
13*3117ece4Schristos ****************************************************************** */
14*3117ece4Schristos 
15*3117ece4Schristos /* **************************************************************
16*3117ece4Schristos *  Dependencies
17*3117ece4Schristos ****************************************************************/
18*3117ece4Schristos #include "../common/zstd_deps.h"  /* ZSTD_memcpy, ZSTD_memset */
19*3117ece4Schristos #include "../common/compiler.h"
20*3117ece4Schristos #include "../common/bitstream.h"  /* BIT_* */
21*3117ece4Schristos #include "../common/fse.h"        /* to compress headers */
22*3117ece4Schristos #include "../common/huf.h"
23*3117ece4Schristos #include "../common/error_private.h"
24*3117ece4Schristos #include "../common/zstd_internal.h"
25*3117ece4Schristos #include "../common/bits.h"       /* ZSTD_highbit32, ZSTD_countTrailingZeros64 */
26*3117ece4Schristos 
27*3117ece4Schristos /* **************************************************************
28*3117ece4Schristos *  Constants
29*3117ece4Schristos ****************************************************************/
30*3117ece4Schristos 
31*3117ece4Schristos #define HUF_DECODER_FAST_TABLELOG 11
32*3117ece4Schristos 
33*3117ece4Schristos /* **************************************************************
34*3117ece4Schristos *  Macros
35*3117ece4Schristos ****************************************************************/
36*3117ece4Schristos 
37*3117ece4Schristos #ifdef HUF_DISABLE_FAST_DECODE
38*3117ece4Schristos # define HUF_ENABLE_FAST_DECODE 0
39*3117ece4Schristos #else
40*3117ece4Schristos # define HUF_ENABLE_FAST_DECODE 1
41*3117ece4Schristos #endif
42*3117ece4Schristos 
43*3117ece4Schristos /* These two optional macros force the use one way or another of the two
44*3117ece4Schristos  * Huffman decompression implementations. You can't force in both directions
45*3117ece4Schristos  * at the same time.
46*3117ece4Schristos  */
47*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1) && \
48*3117ece4Schristos     defined(HUF_FORCE_DECOMPRESS_X2)
49*3117ece4Schristos #error "Cannot force the use of the X1 and X2 decoders at the same time!"
50*3117ece4Schristos #endif
51*3117ece4Schristos 
52*3117ece4Schristos /* When DYNAMIC_BMI2 is enabled, fast decoders are only called when bmi2 is
53*3117ece4Schristos  * supported at runtime, so we can add the BMI2 target attribute.
54*3117ece4Schristos  * When it is disabled, we will still get BMI2 if it is enabled statically.
55*3117ece4Schristos  */
56*3117ece4Schristos #if DYNAMIC_BMI2
57*3117ece4Schristos # define HUF_FAST_BMI2_ATTRS BMI2_TARGET_ATTRIBUTE
58*3117ece4Schristos #else
59*3117ece4Schristos # define HUF_FAST_BMI2_ATTRS
60*3117ece4Schristos #endif
61*3117ece4Schristos 
62*3117ece4Schristos #ifdef __cplusplus
63*3117ece4Schristos # define HUF_EXTERN_C extern "C"
64*3117ece4Schristos #else
65*3117ece4Schristos # define HUF_EXTERN_C
66*3117ece4Schristos #endif
67*3117ece4Schristos #define HUF_ASM_DECL HUF_EXTERN_C
68*3117ece4Schristos 
69*3117ece4Schristos #if DYNAMIC_BMI2
70*3117ece4Schristos # define HUF_NEED_BMI2_FUNCTION 1
71*3117ece4Schristos #else
72*3117ece4Schristos # define HUF_NEED_BMI2_FUNCTION 0
73*3117ece4Schristos #endif
74*3117ece4Schristos 
75*3117ece4Schristos /* **************************************************************
76*3117ece4Schristos *  Error Management
77*3117ece4Schristos ****************************************************************/
78*3117ece4Schristos #define HUF_isError ERR_isError
79*3117ece4Schristos 
80*3117ece4Schristos 
81*3117ece4Schristos /* **************************************************************
82*3117ece4Schristos *  Byte alignment for workSpace management
83*3117ece4Schristos ****************************************************************/
84*3117ece4Schristos #define HUF_ALIGN(x, a)         HUF_ALIGN_MASK((x), (a) - 1)
85*3117ece4Schristos #define HUF_ALIGN_MASK(x, mask) (((x) + (mask)) & ~(mask))
86*3117ece4Schristos 
87*3117ece4Schristos 
88*3117ece4Schristos /* **************************************************************
89*3117ece4Schristos *  BMI2 Variant Wrappers
90*3117ece4Schristos ****************************************************************/
91*3117ece4Schristos typedef size_t (*HUF_DecompressUsingDTableFn)(void *dst, size_t dstSize,
92*3117ece4Schristos                                               const void *cSrc,
93*3117ece4Schristos                                               size_t cSrcSize,
94*3117ece4Schristos                                               const HUF_DTable *DTable);
95*3117ece4Schristos 
96*3117ece4Schristos #if DYNAMIC_BMI2
97*3117ece4Schristos 
98*3117ece4Schristos #define HUF_DGEN(fn)                                                        \
99*3117ece4Schristos                                                                             \
100*3117ece4Schristos     static size_t fn##_default(                                             \
101*3117ece4Schristos                   void* dst,  size_t dstSize,                               \
102*3117ece4Schristos             const void* cSrc, size_t cSrcSize,                              \
103*3117ece4Schristos             const HUF_DTable* DTable)                                       \
104*3117ece4Schristos     {                                                                       \
105*3117ece4Schristos         return fn##_body(dst, dstSize, cSrc, cSrcSize, DTable);             \
106*3117ece4Schristos     }                                                                       \
107*3117ece4Schristos                                                                             \
108*3117ece4Schristos     static BMI2_TARGET_ATTRIBUTE size_t fn##_bmi2(                          \
109*3117ece4Schristos                   void* dst,  size_t dstSize,                               \
110*3117ece4Schristos             const void* cSrc, size_t cSrcSize,                              \
111*3117ece4Schristos             const HUF_DTable* DTable)                                       \
112*3117ece4Schristos     {                                                                       \
113*3117ece4Schristos         return fn##_body(dst, dstSize, cSrc, cSrcSize, DTable);             \
114*3117ece4Schristos     }                                                                       \
115*3117ece4Schristos                                                                             \
116*3117ece4Schristos     static size_t fn(void* dst, size_t dstSize, void const* cSrc,           \
117*3117ece4Schristos                      size_t cSrcSize, HUF_DTable const* DTable, int flags)  \
118*3117ece4Schristos     {                                                                       \
119*3117ece4Schristos         if (flags & HUF_flags_bmi2) {                                       \
120*3117ece4Schristos             return fn##_bmi2(dst, dstSize, cSrc, cSrcSize, DTable);         \
121*3117ece4Schristos         }                                                                   \
122*3117ece4Schristos         return fn##_default(dst, dstSize, cSrc, cSrcSize, DTable);          \
123*3117ece4Schristos     }
124*3117ece4Schristos 
125*3117ece4Schristos #else
126*3117ece4Schristos 
127*3117ece4Schristos #define HUF_DGEN(fn)                                                        \
128*3117ece4Schristos     static size_t fn(void* dst, size_t dstSize, void const* cSrc,           \
129*3117ece4Schristos                      size_t cSrcSize, HUF_DTable const* DTable, int flags)  \
130*3117ece4Schristos     {                                                                       \
131*3117ece4Schristos         (void)flags;                                                        \
132*3117ece4Schristos         return fn##_body(dst, dstSize, cSrc, cSrcSize, DTable);             \
133*3117ece4Schristos     }
134*3117ece4Schristos 
135*3117ece4Schristos #endif
136*3117ece4Schristos 
137*3117ece4Schristos 
138*3117ece4Schristos /*-***************************/
139*3117ece4Schristos /*  generic DTableDesc       */
140*3117ece4Schristos /*-***************************/
141*3117ece4Schristos typedef struct { BYTE maxTableLog; BYTE tableType; BYTE tableLog; BYTE reserved; } DTableDesc;
142*3117ece4Schristos 
143*3117ece4Schristos static DTableDesc HUF_getDTableDesc(const HUF_DTable* table)
144*3117ece4Schristos {
145*3117ece4Schristos     DTableDesc dtd;
146*3117ece4Schristos     ZSTD_memcpy(&dtd, table, sizeof(dtd));
147*3117ece4Schristos     return dtd;
148*3117ece4Schristos }
149*3117ece4Schristos 
150*3117ece4Schristos static size_t HUF_initFastDStream(BYTE const* ip) {
151*3117ece4Schristos     BYTE const lastByte = ip[7];
152*3117ece4Schristos     size_t const bitsConsumed = lastByte ? 8 - ZSTD_highbit32(lastByte) : 0;
153*3117ece4Schristos     size_t const value = MEM_readLEST(ip) | 1;
154*3117ece4Schristos     assert(bitsConsumed <= 8);
155*3117ece4Schristos     assert(sizeof(size_t) == 8);
156*3117ece4Schristos     return value << bitsConsumed;
157*3117ece4Schristos }
158*3117ece4Schristos 
159*3117ece4Schristos 
160*3117ece4Schristos /**
161*3117ece4Schristos  * The input/output arguments to the Huffman fast decoding loop:
162*3117ece4Schristos  *
163*3117ece4Schristos  * ip [in/out] - The input pointers, must be updated to reflect what is consumed.
164*3117ece4Schristos  * op [in/out] - The output pointers, must be updated to reflect what is written.
165*3117ece4Schristos  * bits [in/out] - The bitstream containers, must be updated to reflect the current state.
166*3117ece4Schristos  * dt [in] - The decoding table.
167*3117ece4Schristos  * ilowest [in] - The beginning of the valid range of the input. Decoders may read
168*3117ece4Schristos  *                down to this pointer. It may be below iend[0].
169*3117ece4Schristos  * oend [in] - The end of the output stream. op[3] must not cross oend.
170*3117ece4Schristos  * iend [in] - The end of each input stream. ip[i] may cross iend[i],
171*3117ece4Schristos  *             as long as it is above ilowest, but that indicates corruption.
172*3117ece4Schristos  */
173*3117ece4Schristos typedef struct {
174*3117ece4Schristos     BYTE const* ip[4];
175*3117ece4Schristos     BYTE* op[4];
176*3117ece4Schristos     U64 bits[4];
177*3117ece4Schristos     void const* dt;
178*3117ece4Schristos     BYTE const* ilowest;
179*3117ece4Schristos     BYTE* oend;
180*3117ece4Schristos     BYTE const* iend[4];
181*3117ece4Schristos } HUF_DecompressFastArgs;
182*3117ece4Schristos 
183*3117ece4Schristos typedef void (*HUF_DecompressFastLoopFn)(HUF_DecompressFastArgs*);
184*3117ece4Schristos 
185*3117ece4Schristos /**
186*3117ece4Schristos  * Initializes args for the fast decoding loop.
187*3117ece4Schristos  * @returns 1 on success
188*3117ece4Schristos  *          0 if the fallback implementation should be used.
189*3117ece4Schristos  *          Or an error code on failure.
190*3117ece4Schristos  */
191*3117ece4Schristos static size_t HUF_DecompressFastArgs_init(HUF_DecompressFastArgs* args, void* dst, size_t dstSize, void const* src, size_t srcSize, const HUF_DTable* DTable)
192*3117ece4Schristos {
193*3117ece4Schristos     void const* dt = DTable + 1;
194*3117ece4Schristos     U32 const dtLog = HUF_getDTableDesc(DTable).tableLog;
195*3117ece4Schristos 
196*3117ece4Schristos     const BYTE* const istart = (const BYTE*)src;
197*3117ece4Schristos 
198*3117ece4Schristos     BYTE* const oend = ZSTD_maybeNullPtrAdd((BYTE*)dst, dstSize);
199*3117ece4Schristos 
200*3117ece4Schristos     /* The fast decoding loop assumes 64-bit little-endian.
201*3117ece4Schristos      * This condition is false on x32.
202*3117ece4Schristos      */
203*3117ece4Schristos     if (!MEM_isLittleEndian() || MEM_32bits())
204*3117ece4Schristos         return 0;
205*3117ece4Schristos 
206*3117ece4Schristos     /* Avoid nullptr addition */
207*3117ece4Schristos     if (dstSize == 0)
208*3117ece4Schristos         return 0;
209*3117ece4Schristos     assert(dst != NULL);
210*3117ece4Schristos 
211*3117ece4Schristos     /* strict minimum : jump table + 1 byte per stream */
212*3117ece4Schristos     if (srcSize < 10)
213*3117ece4Schristos         return ERROR(corruption_detected);
214*3117ece4Schristos 
215*3117ece4Schristos     /* Must have at least 8 bytes per stream because we don't handle initializing smaller bit containers.
216*3117ece4Schristos      * If table log is not correct at this point, fallback to the old decoder.
217*3117ece4Schristos      * On small inputs we don't have enough data to trigger the fast loop, so use the old decoder.
218*3117ece4Schristos      */
219*3117ece4Schristos     if (dtLog != HUF_DECODER_FAST_TABLELOG)
220*3117ece4Schristos         return 0;
221*3117ece4Schristos 
222*3117ece4Schristos     /* Read the jump table. */
223*3117ece4Schristos     {
224*3117ece4Schristos         size_t const length1 = MEM_readLE16(istart);
225*3117ece4Schristos         size_t const length2 = MEM_readLE16(istart+2);
226*3117ece4Schristos         size_t const length3 = MEM_readLE16(istart+4);
227*3117ece4Schristos         size_t const length4 = srcSize - (length1 + length2 + length3 + 6);
228*3117ece4Schristos         args->iend[0] = istart + 6;  /* jumpTable */
229*3117ece4Schristos         args->iend[1] = args->iend[0] + length1;
230*3117ece4Schristos         args->iend[2] = args->iend[1] + length2;
231*3117ece4Schristos         args->iend[3] = args->iend[2] + length3;
232*3117ece4Schristos 
233*3117ece4Schristos         /* HUF_initFastDStream() requires this, and this small of an input
234*3117ece4Schristos          * won't benefit from the ASM loop anyways.
235*3117ece4Schristos          */
236*3117ece4Schristos         if (length1 < 8 || length2 < 8 || length3 < 8 || length4 < 8)
237*3117ece4Schristos             return 0;
238*3117ece4Schristos         if (length4 > srcSize) return ERROR(corruption_detected);   /* overflow */
239*3117ece4Schristos     }
240*3117ece4Schristos     /* ip[] contains the position that is currently loaded into bits[]. */
241*3117ece4Schristos     args->ip[0] = args->iend[1] - sizeof(U64);
242*3117ece4Schristos     args->ip[1] = args->iend[2] - sizeof(U64);
243*3117ece4Schristos     args->ip[2] = args->iend[3] - sizeof(U64);
244*3117ece4Schristos     args->ip[3] = (BYTE const*)src + srcSize - sizeof(U64);
245*3117ece4Schristos 
246*3117ece4Schristos     /* op[] contains the output pointers. */
247*3117ece4Schristos     args->op[0] = (BYTE*)dst;
248*3117ece4Schristos     args->op[1] = args->op[0] + (dstSize+3)/4;
249*3117ece4Schristos     args->op[2] = args->op[1] + (dstSize+3)/4;
250*3117ece4Schristos     args->op[3] = args->op[2] + (dstSize+3)/4;
251*3117ece4Schristos 
252*3117ece4Schristos     /* No point to call the ASM loop for tiny outputs. */
253*3117ece4Schristos     if (args->op[3] >= oend)
254*3117ece4Schristos         return 0;
255*3117ece4Schristos 
256*3117ece4Schristos     /* bits[] is the bit container.
257*3117ece4Schristos         * It is read from the MSB down to the LSB.
258*3117ece4Schristos         * It is shifted left as it is read, and zeros are
259*3117ece4Schristos         * shifted in. After the lowest valid bit a 1 is
260*3117ece4Schristos         * set, so that CountTrailingZeros(bits[]) can be used
261*3117ece4Schristos         * to count how many bits we've consumed.
262*3117ece4Schristos         */
263*3117ece4Schristos     args->bits[0] = HUF_initFastDStream(args->ip[0]);
264*3117ece4Schristos     args->bits[1] = HUF_initFastDStream(args->ip[1]);
265*3117ece4Schristos     args->bits[2] = HUF_initFastDStream(args->ip[2]);
266*3117ece4Schristos     args->bits[3] = HUF_initFastDStream(args->ip[3]);
267*3117ece4Schristos 
268*3117ece4Schristos     /* The decoders must be sure to never read beyond ilowest.
269*3117ece4Schristos      * This is lower than iend[0], but allowing decoders to read
270*3117ece4Schristos      * down to ilowest can allow an extra iteration or two in the
271*3117ece4Schristos      * fast loop.
272*3117ece4Schristos      */
273*3117ece4Schristos     args->ilowest = istart;
274*3117ece4Schristos 
275*3117ece4Schristos     args->oend = oend;
276*3117ece4Schristos     args->dt = dt;
277*3117ece4Schristos 
278*3117ece4Schristos     return 1;
279*3117ece4Schristos }
280*3117ece4Schristos 
281*3117ece4Schristos static size_t HUF_initRemainingDStream(BIT_DStream_t* bit, HUF_DecompressFastArgs const* args, int stream, BYTE* segmentEnd)
282*3117ece4Schristos {
283*3117ece4Schristos     /* Validate that we haven't overwritten. */
284*3117ece4Schristos     if (args->op[stream] > segmentEnd)
285*3117ece4Schristos         return ERROR(corruption_detected);
286*3117ece4Schristos     /* Validate that we haven't read beyond iend[].
287*3117ece4Schristos         * Note that ip[] may be < iend[] because the MSB is
288*3117ece4Schristos         * the next bit to read, and we may have consumed 100%
289*3117ece4Schristos         * of the stream, so down to iend[i] - 8 is valid.
290*3117ece4Schristos         */
291*3117ece4Schristos     if (args->ip[stream] < args->iend[stream] - 8)
292*3117ece4Schristos         return ERROR(corruption_detected);
293*3117ece4Schristos 
294*3117ece4Schristos     /* Construct the BIT_DStream_t. */
295*3117ece4Schristos     assert(sizeof(size_t) == 8);
296*3117ece4Schristos     bit->bitContainer = MEM_readLEST(args->ip[stream]);
297*3117ece4Schristos     bit->bitsConsumed = ZSTD_countTrailingZeros64(args->bits[stream]);
298*3117ece4Schristos     bit->start = (const char*)args->ilowest;
299*3117ece4Schristos     bit->limitPtr = bit->start + sizeof(size_t);
300*3117ece4Schristos     bit->ptr = (const char*)args->ip[stream];
301*3117ece4Schristos 
302*3117ece4Schristos     return 0;
303*3117ece4Schristos }
304*3117ece4Schristos 
305*3117ece4Schristos /* Calls X(N) for each stream 0, 1, 2, 3. */
306*3117ece4Schristos #define HUF_4X_FOR_EACH_STREAM(X) \
307*3117ece4Schristos     do {                          \
308*3117ece4Schristos         X(0);                     \
309*3117ece4Schristos         X(1);                     \
310*3117ece4Schristos         X(2);                     \
311*3117ece4Schristos         X(3);                     \
312*3117ece4Schristos     } while (0)
313*3117ece4Schristos 
314*3117ece4Schristos /* Calls X(N, var) for each stream 0, 1, 2, 3. */
315*3117ece4Schristos #define HUF_4X_FOR_EACH_STREAM_WITH_VAR(X, var) \
316*3117ece4Schristos     do {                                        \
317*3117ece4Schristos         X(0, (var));                            \
318*3117ece4Schristos         X(1, (var));                            \
319*3117ece4Schristos         X(2, (var));                            \
320*3117ece4Schristos         X(3, (var));                            \
321*3117ece4Schristos     } while (0)
322*3117ece4Schristos 
323*3117ece4Schristos 
324*3117ece4Schristos #ifndef HUF_FORCE_DECOMPRESS_X2
325*3117ece4Schristos 
326*3117ece4Schristos /*-***************************/
327*3117ece4Schristos /*  single-symbol decoding   */
328*3117ece4Schristos /*-***************************/
329*3117ece4Schristos typedef struct { BYTE nbBits; BYTE byte; } HUF_DEltX1;   /* single-symbol decoding */
330*3117ece4Schristos 
331*3117ece4Schristos /**
332*3117ece4Schristos  * Packs 4 HUF_DEltX1 structs into a U64. This is used to lay down 4 entries at
333*3117ece4Schristos  * a time.
334*3117ece4Schristos  */
335*3117ece4Schristos static U64 HUF_DEltX1_set4(BYTE symbol, BYTE nbBits) {
336*3117ece4Schristos     U64 D4;
337*3117ece4Schristos     if (MEM_isLittleEndian()) {
338*3117ece4Schristos         D4 = (U64)((symbol << 8) + nbBits);
339*3117ece4Schristos     } else {
340*3117ece4Schristos         D4 = (U64)(symbol + (nbBits << 8));
341*3117ece4Schristos     }
342*3117ece4Schristos     assert(D4 < (1U << 16));
343*3117ece4Schristos     D4 *= 0x0001000100010001ULL;
344*3117ece4Schristos     return D4;
345*3117ece4Schristos }
346*3117ece4Schristos 
347*3117ece4Schristos /**
348*3117ece4Schristos  * Increase the tableLog to targetTableLog and rescales the stats.
349*3117ece4Schristos  * If tableLog > targetTableLog this is a no-op.
350*3117ece4Schristos  * @returns New tableLog
351*3117ece4Schristos  */
352*3117ece4Schristos static U32 HUF_rescaleStats(BYTE* huffWeight, U32* rankVal, U32 nbSymbols, U32 tableLog, U32 targetTableLog)
353*3117ece4Schristos {
354*3117ece4Schristos     if (tableLog > targetTableLog)
355*3117ece4Schristos         return tableLog;
356*3117ece4Schristos     if (tableLog < targetTableLog) {
357*3117ece4Schristos         U32 const scale = targetTableLog - tableLog;
358*3117ece4Schristos         U32 s;
359*3117ece4Schristos         /* Increase the weight for all non-zero probability symbols by scale. */
360*3117ece4Schristos         for (s = 0; s < nbSymbols; ++s) {
361*3117ece4Schristos             huffWeight[s] += (BYTE)((huffWeight[s] == 0) ? 0 : scale);
362*3117ece4Schristos         }
363*3117ece4Schristos         /* Update rankVal to reflect the new weights.
364*3117ece4Schristos          * All weights except 0 get moved to weight + scale.
365*3117ece4Schristos          * Weights [1, scale] are empty.
366*3117ece4Schristos          */
367*3117ece4Schristos         for (s = targetTableLog; s > scale; --s) {
368*3117ece4Schristos             rankVal[s] = rankVal[s - scale];
369*3117ece4Schristos         }
370*3117ece4Schristos         for (s = scale; s > 0; --s) {
371*3117ece4Schristos             rankVal[s] = 0;
372*3117ece4Schristos         }
373*3117ece4Schristos     }
374*3117ece4Schristos     return targetTableLog;
375*3117ece4Schristos }
376*3117ece4Schristos 
377*3117ece4Schristos typedef struct {
378*3117ece4Schristos         U32 rankVal[HUF_TABLELOG_ABSOLUTEMAX + 1];
379*3117ece4Schristos         U32 rankStart[HUF_TABLELOG_ABSOLUTEMAX + 1];
380*3117ece4Schristos         U32 statsWksp[HUF_READ_STATS_WORKSPACE_SIZE_U32];
381*3117ece4Schristos         BYTE symbols[HUF_SYMBOLVALUE_MAX + 1];
382*3117ece4Schristos         BYTE huffWeight[HUF_SYMBOLVALUE_MAX + 1];
383*3117ece4Schristos } HUF_ReadDTableX1_Workspace;
384*3117ece4Schristos 
385*3117ece4Schristos size_t HUF_readDTableX1_wksp(HUF_DTable* DTable, const void* src, size_t srcSize, void* workSpace, size_t wkspSize, int flags)
386*3117ece4Schristos {
387*3117ece4Schristos     U32 tableLog = 0;
388*3117ece4Schristos     U32 nbSymbols = 0;
389*3117ece4Schristos     size_t iSize;
390*3117ece4Schristos     void* const dtPtr = DTable + 1;
391*3117ece4Schristos     HUF_DEltX1* const dt = (HUF_DEltX1*)dtPtr;
392*3117ece4Schristos     HUF_ReadDTableX1_Workspace* wksp = (HUF_ReadDTableX1_Workspace*)workSpace;
393*3117ece4Schristos 
394*3117ece4Schristos     DEBUG_STATIC_ASSERT(HUF_DECOMPRESS_WORKSPACE_SIZE >= sizeof(*wksp));
395*3117ece4Schristos     if (sizeof(*wksp) > wkspSize) return ERROR(tableLog_tooLarge);
396*3117ece4Schristos 
397*3117ece4Schristos     DEBUG_STATIC_ASSERT(sizeof(DTableDesc) == sizeof(HUF_DTable));
398*3117ece4Schristos     /* ZSTD_memset(huffWeight, 0, sizeof(huffWeight)); */   /* is not necessary, even though some analyzer complain ... */
399*3117ece4Schristos 
400*3117ece4Schristos     iSize = HUF_readStats_wksp(wksp->huffWeight, HUF_SYMBOLVALUE_MAX + 1, wksp->rankVal, &nbSymbols, &tableLog, src, srcSize, wksp->statsWksp, sizeof(wksp->statsWksp), flags);
401*3117ece4Schristos     if (HUF_isError(iSize)) return iSize;
402*3117ece4Schristos 
403*3117ece4Schristos 
404*3117ece4Schristos     /* Table header */
405*3117ece4Schristos     {   DTableDesc dtd = HUF_getDTableDesc(DTable);
406*3117ece4Schristos         U32 const maxTableLog = dtd.maxTableLog + 1;
407*3117ece4Schristos         U32 const targetTableLog = MIN(maxTableLog, HUF_DECODER_FAST_TABLELOG);
408*3117ece4Schristos         tableLog = HUF_rescaleStats(wksp->huffWeight, wksp->rankVal, nbSymbols, tableLog, targetTableLog);
409*3117ece4Schristos         if (tableLog > (U32)(dtd.maxTableLog+1)) return ERROR(tableLog_tooLarge);   /* DTable too small, Huffman tree cannot fit in */
410*3117ece4Schristos         dtd.tableType = 0;
411*3117ece4Schristos         dtd.tableLog = (BYTE)tableLog;
412*3117ece4Schristos         ZSTD_memcpy(DTable, &dtd, sizeof(dtd));
413*3117ece4Schristos     }
414*3117ece4Schristos 
415*3117ece4Schristos     /* Compute symbols and rankStart given rankVal:
416*3117ece4Schristos      *
417*3117ece4Schristos      * rankVal already contains the number of values of each weight.
418*3117ece4Schristos      *
419*3117ece4Schristos      * symbols contains the symbols ordered by weight. First are the rankVal[0]
420*3117ece4Schristos      * weight 0 symbols, followed by the rankVal[1] weight 1 symbols, and so on.
421*3117ece4Schristos      * symbols[0] is filled (but unused) to avoid a branch.
422*3117ece4Schristos      *
423*3117ece4Schristos      * rankStart contains the offset where each rank belongs in the DTable.
424*3117ece4Schristos      * rankStart[0] is not filled because there are no entries in the table for
425*3117ece4Schristos      * weight 0.
426*3117ece4Schristos      */
427*3117ece4Schristos     {   int n;
428*3117ece4Schristos         U32 nextRankStart = 0;
429*3117ece4Schristos         int const unroll = 4;
430*3117ece4Schristos         int const nLimit = (int)nbSymbols - unroll + 1;
431*3117ece4Schristos         for (n=0; n<(int)tableLog+1; n++) {
432*3117ece4Schristos             U32 const curr = nextRankStart;
433*3117ece4Schristos             nextRankStart += wksp->rankVal[n];
434*3117ece4Schristos             wksp->rankStart[n] = curr;
435*3117ece4Schristos         }
436*3117ece4Schristos         for (n=0; n < nLimit; n += unroll) {
437*3117ece4Schristos             int u;
438*3117ece4Schristos             for (u=0; u < unroll; ++u) {
439*3117ece4Schristos                 size_t const w = wksp->huffWeight[n+u];
440*3117ece4Schristos                 wksp->symbols[wksp->rankStart[w]++] = (BYTE)(n+u);
441*3117ece4Schristos             }
442*3117ece4Schristos         }
443*3117ece4Schristos         for (; n < (int)nbSymbols; ++n) {
444*3117ece4Schristos             size_t const w = wksp->huffWeight[n];
445*3117ece4Schristos             wksp->symbols[wksp->rankStart[w]++] = (BYTE)n;
446*3117ece4Schristos         }
447*3117ece4Schristos     }
448*3117ece4Schristos 
449*3117ece4Schristos     /* fill DTable
450*3117ece4Schristos      * We fill all entries of each weight in order.
451*3117ece4Schristos      * That way length is a constant for each iteration of the outer loop.
452*3117ece4Schristos      * We can switch based on the length to a different inner loop which is
453*3117ece4Schristos      * optimized for that particular case.
454*3117ece4Schristos      */
455*3117ece4Schristos     {   U32 w;
456*3117ece4Schristos         int symbol = wksp->rankVal[0];
457*3117ece4Schristos         int rankStart = 0;
458*3117ece4Schristos         for (w=1; w<tableLog+1; ++w) {
459*3117ece4Schristos             int const symbolCount = wksp->rankVal[w];
460*3117ece4Schristos             int const length = (1 << w) >> 1;
461*3117ece4Schristos             int uStart = rankStart;
462*3117ece4Schristos             BYTE const nbBits = (BYTE)(tableLog + 1 - w);
463*3117ece4Schristos             int s;
464*3117ece4Schristos             int u;
465*3117ece4Schristos             switch (length) {
466*3117ece4Schristos             case 1:
467*3117ece4Schristos                 for (s=0; s<symbolCount; ++s) {
468*3117ece4Schristos                     HUF_DEltX1 D;
469*3117ece4Schristos                     D.byte = wksp->symbols[symbol + s];
470*3117ece4Schristos                     D.nbBits = nbBits;
471*3117ece4Schristos                     dt[uStart] = D;
472*3117ece4Schristos                     uStart += 1;
473*3117ece4Schristos                 }
474*3117ece4Schristos                 break;
475*3117ece4Schristos             case 2:
476*3117ece4Schristos                 for (s=0; s<symbolCount; ++s) {
477*3117ece4Schristos                     HUF_DEltX1 D;
478*3117ece4Schristos                     D.byte = wksp->symbols[symbol + s];
479*3117ece4Schristos                     D.nbBits = nbBits;
480*3117ece4Schristos                     dt[uStart+0] = D;
481*3117ece4Schristos                     dt[uStart+1] = D;
482*3117ece4Schristos                     uStart += 2;
483*3117ece4Schristos                 }
484*3117ece4Schristos                 break;
485*3117ece4Schristos             case 4:
486*3117ece4Schristos                 for (s=0; s<symbolCount; ++s) {
487*3117ece4Schristos                     U64 const D4 = HUF_DEltX1_set4(wksp->symbols[symbol + s], nbBits);
488*3117ece4Schristos                     MEM_write64(dt + uStart, D4);
489*3117ece4Schristos                     uStart += 4;
490*3117ece4Schristos                 }
491*3117ece4Schristos                 break;
492*3117ece4Schristos             case 8:
493*3117ece4Schristos                 for (s=0; s<symbolCount; ++s) {
494*3117ece4Schristos                     U64 const D4 = HUF_DEltX1_set4(wksp->symbols[symbol + s], nbBits);
495*3117ece4Schristos                     MEM_write64(dt + uStart, D4);
496*3117ece4Schristos                     MEM_write64(dt + uStart + 4, D4);
497*3117ece4Schristos                     uStart += 8;
498*3117ece4Schristos                 }
499*3117ece4Schristos                 break;
500*3117ece4Schristos             default:
501*3117ece4Schristos                 for (s=0; s<symbolCount; ++s) {
502*3117ece4Schristos                     U64 const D4 = HUF_DEltX1_set4(wksp->symbols[symbol + s], nbBits);
503*3117ece4Schristos                     for (u=0; u < length; u += 16) {
504*3117ece4Schristos                         MEM_write64(dt + uStart + u + 0, D4);
505*3117ece4Schristos                         MEM_write64(dt + uStart + u + 4, D4);
506*3117ece4Schristos                         MEM_write64(dt + uStart + u + 8, D4);
507*3117ece4Schristos                         MEM_write64(dt + uStart + u + 12, D4);
508*3117ece4Schristos                     }
509*3117ece4Schristos                     assert(u == length);
510*3117ece4Schristos                     uStart += length;
511*3117ece4Schristos                 }
512*3117ece4Schristos                 break;
513*3117ece4Schristos             }
514*3117ece4Schristos             symbol += symbolCount;
515*3117ece4Schristos             rankStart += symbolCount * length;
516*3117ece4Schristos         }
517*3117ece4Schristos     }
518*3117ece4Schristos     return iSize;
519*3117ece4Schristos }
520*3117ece4Schristos 
521*3117ece4Schristos FORCE_INLINE_TEMPLATE BYTE
522*3117ece4Schristos HUF_decodeSymbolX1(BIT_DStream_t* Dstream, const HUF_DEltX1* dt, const U32 dtLog)
523*3117ece4Schristos {
524*3117ece4Schristos     size_t const val = BIT_lookBitsFast(Dstream, dtLog); /* note : dtLog >= 1 */
525*3117ece4Schristos     BYTE const c = dt[val].byte;
526*3117ece4Schristos     BIT_skipBits(Dstream, dt[val].nbBits);
527*3117ece4Schristos     return c;
528*3117ece4Schristos }
529*3117ece4Schristos 
530*3117ece4Schristos #define HUF_DECODE_SYMBOLX1_0(ptr, DStreamPtr) \
531*3117ece4Schristos     do { *ptr++ = HUF_decodeSymbolX1(DStreamPtr, dt, dtLog); } while (0)
532*3117ece4Schristos 
533*3117ece4Schristos #define HUF_DECODE_SYMBOLX1_1(ptr, DStreamPtr)      \
534*3117ece4Schristos     do {                                            \
535*3117ece4Schristos         if (MEM_64bits() || (HUF_TABLELOG_MAX<=12)) \
536*3117ece4Schristos             HUF_DECODE_SYMBOLX1_0(ptr, DStreamPtr); \
537*3117ece4Schristos     } while (0)
538*3117ece4Schristos 
539*3117ece4Schristos #define HUF_DECODE_SYMBOLX1_2(ptr, DStreamPtr)      \
540*3117ece4Schristos     do {                                            \
541*3117ece4Schristos         if (MEM_64bits())                           \
542*3117ece4Schristos             HUF_DECODE_SYMBOLX1_0(ptr, DStreamPtr); \
543*3117ece4Schristos     } while (0)
544*3117ece4Schristos 
545*3117ece4Schristos HINT_INLINE size_t
546*3117ece4Schristos HUF_decodeStreamX1(BYTE* p, BIT_DStream_t* const bitDPtr, BYTE* const pEnd, const HUF_DEltX1* const dt, const U32 dtLog)
547*3117ece4Schristos {
548*3117ece4Schristos     BYTE* const pStart = p;
549*3117ece4Schristos 
550*3117ece4Schristos     /* up to 4 symbols at a time */
551*3117ece4Schristos     if ((pEnd - p) > 3) {
552*3117ece4Schristos         while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p < pEnd-3)) {
553*3117ece4Schristos             HUF_DECODE_SYMBOLX1_2(p, bitDPtr);
554*3117ece4Schristos             HUF_DECODE_SYMBOLX1_1(p, bitDPtr);
555*3117ece4Schristos             HUF_DECODE_SYMBOLX1_2(p, bitDPtr);
556*3117ece4Schristos             HUF_DECODE_SYMBOLX1_0(p, bitDPtr);
557*3117ece4Schristos         }
558*3117ece4Schristos     } else {
559*3117ece4Schristos         BIT_reloadDStream(bitDPtr);
560*3117ece4Schristos     }
561*3117ece4Schristos 
562*3117ece4Schristos     /* [0-3] symbols remaining */
563*3117ece4Schristos     if (MEM_32bits())
564*3117ece4Schristos         while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p < pEnd))
565*3117ece4Schristos             HUF_DECODE_SYMBOLX1_0(p, bitDPtr);
566*3117ece4Schristos 
567*3117ece4Schristos     /* no more data to retrieve from bitstream, no need to reload */
568*3117ece4Schristos     while (p < pEnd)
569*3117ece4Schristos         HUF_DECODE_SYMBOLX1_0(p, bitDPtr);
570*3117ece4Schristos 
571*3117ece4Schristos     return (size_t)(pEnd-pStart);
572*3117ece4Schristos }
573*3117ece4Schristos 
574*3117ece4Schristos FORCE_INLINE_TEMPLATE size_t
575*3117ece4Schristos HUF_decompress1X1_usingDTable_internal_body(
576*3117ece4Schristos           void* dst,  size_t dstSize,
577*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
578*3117ece4Schristos     const HUF_DTable* DTable)
579*3117ece4Schristos {
580*3117ece4Schristos     BYTE* op = (BYTE*)dst;
581*3117ece4Schristos     BYTE* const oend = ZSTD_maybeNullPtrAdd(op, dstSize);
582*3117ece4Schristos     const void* dtPtr = DTable + 1;
583*3117ece4Schristos     const HUF_DEltX1* const dt = (const HUF_DEltX1*)dtPtr;
584*3117ece4Schristos     BIT_DStream_t bitD;
585*3117ece4Schristos     DTableDesc const dtd = HUF_getDTableDesc(DTable);
586*3117ece4Schristos     U32 const dtLog = dtd.tableLog;
587*3117ece4Schristos 
588*3117ece4Schristos     CHECK_F( BIT_initDStream(&bitD, cSrc, cSrcSize) );
589*3117ece4Schristos 
590*3117ece4Schristos     HUF_decodeStreamX1(op, &bitD, oend, dt, dtLog);
591*3117ece4Schristos 
592*3117ece4Schristos     if (!BIT_endOfDStream(&bitD)) return ERROR(corruption_detected);
593*3117ece4Schristos 
594*3117ece4Schristos     return dstSize;
595*3117ece4Schristos }
596*3117ece4Schristos 
597*3117ece4Schristos /* HUF_decompress4X1_usingDTable_internal_body():
598*3117ece4Schristos  * Conditions :
599*3117ece4Schristos  * @dstSize >= 6
600*3117ece4Schristos  */
601*3117ece4Schristos FORCE_INLINE_TEMPLATE size_t
602*3117ece4Schristos HUF_decompress4X1_usingDTable_internal_body(
603*3117ece4Schristos           void* dst,  size_t dstSize,
604*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
605*3117ece4Schristos     const HUF_DTable* DTable)
606*3117ece4Schristos {
607*3117ece4Schristos     /* Check */
608*3117ece4Schristos     if (cSrcSize < 10) return ERROR(corruption_detected);  /* strict minimum : jump table + 1 byte per stream */
609*3117ece4Schristos     if (dstSize < 6) return ERROR(corruption_detected);         /* stream 4-split doesn't work */
610*3117ece4Schristos 
611*3117ece4Schristos     {   const BYTE* const istart = (const BYTE*) cSrc;
612*3117ece4Schristos         BYTE* const ostart = (BYTE*) dst;
613*3117ece4Schristos         BYTE* const oend = ostart + dstSize;
614*3117ece4Schristos         BYTE* const olimit = oend - 3;
615*3117ece4Schristos         const void* const dtPtr = DTable + 1;
616*3117ece4Schristos         const HUF_DEltX1* const dt = (const HUF_DEltX1*)dtPtr;
617*3117ece4Schristos 
618*3117ece4Schristos         /* Init */
619*3117ece4Schristos         BIT_DStream_t bitD1;
620*3117ece4Schristos         BIT_DStream_t bitD2;
621*3117ece4Schristos         BIT_DStream_t bitD3;
622*3117ece4Schristos         BIT_DStream_t bitD4;
623*3117ece4Schristos         size_t const length1 = MEM_readLE16(istart);
624*3117ece4Schristos         size_t const length2 = MEM_readLE16(istart+2);
625*3117ece4Schristos         size_t const length3 = MEM_readLE16(istart+4);
626*3117ece4Schristos         size_t const length4 = cSrcSize - (length1 + length2 + length3 + 6);
627*3117ece4Schristos         const BYTE* const istart1 = istart + 6;  /* jumpTable */
628*3117ece4Schristos         const BYTE* const istart2 = istart1 + length1;
629*3117ece4Schristos         const BYTE* const istart3 = istart2 + length2;
630*3117ece4Schristos         const BYTE* const istart4 = istart3 + length3;
631*3117ece4Schristos         const size_t segmentSize = (dstSize+3) / 4;
632*3117ece4Schristos         BYTE* const opStart2 = ostart + segmentSize;
633*3117ece4Schristos         BYTE* const opStart3 = opStart2 + segmentSize;
634*3117ece4Schristos         BYTE* const opStart4 = opStart3 + segmentSize;
635*3117ece4Schristos         BYTE* op1 = ostart;
636*3117ece4Schristos         BYTE* op2 = opStart2;
637*3117ece4Schristos         BYTE* op3 = opStart3;
638*3117ece4Schristos         BYTE* op4 = opStart4;
639*3117ece4Schristos         DTableDesc const dtd = HUF_getDTableDesc(DTable);
640*3117ece4Schristos         U32 const dtLog = dtd.tableLog;
641*3117ece4Schristos         U32 endSignal = 1;
642*3117ece4Schristos 
643*3117ece4Schristos         if (length4 > cSrcSize) return ERROR(corruption_detected);   /* overflow */
644*3117ece4Schristos         if (opStart4 > oend) return ERROR(corruption_detected);      /* overflow */
645*3117ece4Schristos         assert(dstSize >= 6); /* validated above */
646*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD1, istart1, length1) );
647*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD2, istart2, length2) );
648*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD3, istart3, length3) );
649*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD4, istart4, length4) );
650*3117ece4Schristos 
651*3117ece4Schristos         /* up to 16 symbols per loop (4 symbols per stream) in 64-bit mode */
652*3117ece4Schristos         if ((size_t)(oend - op4) >= sizeof(size_t)) {
653*3117ece4Schristos             for ( ; (endSignal) & (op4 < olimit) ; ) {
654*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op1, &bitD1);
655*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op2, &bitD2);
656*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op3, &bitD3);
657*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op4, &bitD4);
658*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_1(op1, &bitD1);
659*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_1(op2, &bitD2);
660*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_1(op3, &bitD3);
661*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_1(op4, &bitD4);
662*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op1, &bitD1);
663*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op2, &bitD2);
664*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op3, &bitD3);
665*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_2(op4, &bitD4);
666*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_0(op1, &bitD1);
667*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_0(op2, &bitD2);
668*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_0(op3, &bitD3);
669*3117ece4Schristos                 HUF_DECODE_SYMBOLX1_0(op4, &bitD4);
670*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD1) == BIT_DStream_unfinished;
671*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD2) == BIT_DStream_unfinished;
672*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD3) == BIT_DStream_unfinished;
673*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD4) == BIT_DStream_unfinished;
674*3117ece4Schristos             }
675*3117ece4Schristos         }
676*3117ece4Schristos 
677*3117ece4Schristos         /* check corruption */
678*3117ece4Schristos         /* note : should not be necessary : op# advance in lock step, and we control op4.
679*3117ece4Schristos          *        but curiously, binary generated by gcc 7.2 & 7.3 with -mbmi2 runs faster when >=1 test is present */
680*3117ece4Schristos         if (op1 > opStart2) return ERROR(corruption_detected);
681*3117ece4Schristos         if (op2 > opStart3) return ERROR(corruption_detected);
682*3117ece4Schristos         if (op3 > opStart4) return ERROR(corruption_detected);
683*3117ece4Schristos         /* note : op4 supposed already verified within main loop */
684*3117ece4Schristos 
685*3117ece4Schristos         /* finish bitStreams one by one */
686*3117ece4Schristos         HUF_decodeStreamX1(op1, &bitD1, opStart2, dt, dtLog);
687*3117ece4Schristos         HUF_decodeStreamX1(op2, &bitD2, opStart3, dt, dtLog);
688*3117ece4Schristos         HUF_decodeStreamX1(op3, &bitD3, opStart4, dt, dtLog);
689*3117ece4Schristos         HUF_decodeStreamX1(op4, &bitD4, oend,     dt, dtLog);
690*3117ece4Schristos 
691*3117ece4Schristos         /* check */
692*3117ece4Schristos         { U32 const endCheck = BIT_endOfDStream(&bitD1) & BIT_endOfDStream(&bitD2) & BIT_endOfDStream(&bitD3) & BIT_endOfDStream(&bitD4);
693*3117ece4Schristos           if (!endCheck) return ERROR(corruption_detected); }
694*3117ece4Schristos 
695*3117ece4Schristos         /* decoded size */
696*3117ece4Schristos         return dstSize;
697*3117ece4Schristos     }
698*3117ece4Schristos }
699*3117ece4Schristos 
700*3117ece4Schristos #if HUF_NEED_BMI2_FUNCTION
701*3117ece4Schristos static BMI2_TARGET_ATTRIBUTE
702*3117ece4Schristos size_t HUF_decompress4X1_usingDTable_internal_bmi2(void* dst, size_t dstSize, void const* cSrc,
703*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable) {
704*3117ece4Schristos     return HUF_decompress4X1_usingDTable_internal_body(dst, dstSize, cSrc, cSrcSize, DTable);
705*3117ece4Schristos }
706*3117ece4Schristos #endif
707*3117ece4Schristos 
708*3117ece4Schristos static
709*3117ece4Schristos size_t HUF_decompress4X1_usingDTable_internal_default(void* dst, size_t dstSize, void const* cSrc,
710*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable) {
711*3117ece4Schristos     return HUF_decompress4X1_usingDTable_internal_body(dst, dstSize, cSrc, cSrcSize, DTable);
712*3117ece4Schristos }
713*3117ece4Schristos 
714*3117ece4Schristos #if ZSTD_ENABLE_ASM_X86_64_BMI2
715*3117ece4Schristos 
716*3117ece4Schristos HUF_ASM_DECL void HUF_decompress4X1_usingDTable_internal_fast_asm_loop(HUF_DecompressFastArgs* args) ZSTDLIB_HIDDEN;
717*3117ece4Schristos 
718*3117ece4Schristos #endif
719*3117ece4Schristos 
720*3117ece4Schristos static HUF_FAST_BMI2_ATTRS
721*3117ece4Schristos void HUF_decompress4X1_usingDTable_internal_fast_c_loop(HUF_DecompressFastArgs* args)
722*3117ece4Schristos {
723*3117ece4Schristos     U64 bits[4];
724*3117ece4Schristos     BYTE const* ip[4];
725*3117ece4Schristos     BYTE* op[4];
726*3117ece4Schristos     U16 const* const dtable = (U16 const*)args->dt;
727*3117ece4Schristos     BYTE* const oend = args->oend;
728*3117ece4Schristos     BYTE const* const ilowest = args->ilowest;
729*3117ece4Schristos 
730*3117ece4Schristos     /* Copy the arguments to local variables */
731*3117ece4Schristos     ZSTD_memcpy(&bits, &args->bits, sizeof(bits));
732*3117ece4Schristos     ZSTD_memcpy((void*)(&ip), &args->ip, sizeof(ip));
733*3117ece4Schristos     ZSTD_memcpy(&op, &args->op, sizeof(op));
734*3117ece4Schristos 
735*3117ece4Schristos     assert(MEM_isLittleEndian());
736*3117ece4Schristos     assert(!MEM_32bits());
737*3117ece4Schristos 
738*3117ece4Schristos     for (;;) {
739*3117ece4Schristos         BYTE* olimit;
740*3117ece4Schristos         int stream;
741*3117ece4Schristos 
742*3117ece4Schristos         /* Assert loop preconditions */
743*3117ece4Schristos #ifndef NDEBUG
744*3117ece4Schristos         for (stream = 0; stream < 4; ++stream) {
745*3117ece4Schristos             assert(op[stream] <= (stream == 3 ? oend : op[stream + 1]));
746*3117ece4Schristos             assert(ip[stream] >= ilowest);
747*3117ece4Schristos         }
748*3117ece4Schristos #endif
749*3117ece4Schristos         /* Compute olimit */
750*3117ece4Schristos         {
751*3117ece4Schristos             /* Each iteration produces 5 output symbols per stream */
752*3117ece4Schristos             size_t const oiters = (size_t)(oend - op[3]) / 5;
753*3117ece4Schristos             /* Each iteration consumes up to 11 bits * 5 = 55 bits < 7 bytes
754*3117ece4Schristos              * per stream.
755*3117ece4Schristos              */
756*3117ece4Schristos             size_t const iiters = (size_t)(ip[0] - ilowest) / 7;
757*3117ece4Schristos             /* We can safely run iters iterations before running bounds checks */
758*3117ece4Schristos             size_t const iters = MIN(oiters, iiters);
759*3117ece4Schristos             size_t const symbols = iters * 5;
760*3117ece4Schristos 
761*3117ece4Schristos             /* We can simply check that op[3] < olimit, instead of checking all
762*3117ece4Schristos              * of our bounds, since we can't hit the other bounds until we've run
763*3117ece4Schristos              * iters iterations, which only happens when op[3] == olimit.
764*3117ece4Schristos              */
765*3117ece4Schristos             olimit = op[3] + symbols;
766*3117ece4Schristos 
767*3117ece4Schristos             /* Exit fast decoding loop once we reach the end. */
768*3117ece4Schristos             if (op[3] == olimit)
769*3117ece4Schristos                 break;
770*3117ece4Schristos 
771*3117ece4Schristos             /* Exit the decoding loop if any input pointer has crossed the
772*3117ece4Schristos              * previous one. This indicates corruption, and a precondition
773*3117ece4Schristos              * to our loop is that ip[i] >= ip[0].
774*3117ece4Schristos              */
775*3117ece4Schristos             for (stream = 1; stream < 4; ++stream) {
776*3117ece4Schristos                 if (ip[stream] < ip[stream - 1])
777*3117ece4Schristos                     goto _out;
778*3117ece4Schristos             }
779*3117ece4Schristos         }
780*3117ece4Schristos 
781*3117ece4Schristos #ifndef NDEBUG
782*3117ece4Schristos         for (stream = 1; stream < 4; ++stream) {
783*3117ece4Schristos             assert(ip[stream] >= ip[stream - 1]);
784*3117ece4Schristos         }
785*3117ece4Schristos #endif
786*3117ece4Schristos 
787*3117ece4Schristos #define HUF_4X1_DECODE_SYMBOL(_stream, _symbol)                 \
788*3117ece4Schristos     do {                                                        \
789*3117ece4Schristos         int const index = (int)(bits[(_stream)] >> 53);         \
790*3117ece4Schristos         int const entry = (int)dtable[index];                   \
791*3117ece4Schristos         bits[(_stream)] <<= (entry & 0x3F);                     \
792*3117ece4Schristos         op[(_stream)][(_symbol)] = (BYTE)((entry >> 8) & 0xFF); \
793*3117ece4Schristos     } while (0)
794*3117ece4Schristos 
795*3117ece4Schristos #define HUF_4X1_RELOAD_STREAM(_stream)                              \
796*3117ece4Schristos     do {                                                            \
797*3117ece4Schristos         int const ctz = ZSTD_countTrailingZeros64(bits[(_stream)]); \
798*3117ece4Schristos         int const nbBits = ctz & 7;                                 \
799*3117ece4Schristos         int const nbBytes = ctz >> 3;                               \
800*3117ece4Schristos         op[(_stream)] += 5;                                         \
801*3117ece4Schristos         ip[(_stream)] -= nbBytes;                                   \
802*3117ece4Schristos         bits[(_stream)] = MEM_read64(ip[(_stream)]) | 1;            \
803*3117ece4Schristos         bits[(_stream)] <<= nbBits;                                 \
804*3117ece4Schristos     } while (0)
805*3117ece4Schristos 
806*3117ece4Schristos         /* Manually unroll the loop because compilers don't consistently
807*3117ece4Schristos          * unroll the inner loops, which destroys performance.
808*3117ece4Schristos          */
809*3117ece4Schristos         do {
810*3117ece4Schristos             /* Decode 5 symbols in each of the 4 streams */
811*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X1_DECODE_SYMBOL, 0);
812*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X1_DECODE_SYMBOL, 1);
813*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X1_DECODE_SYMBOL, 2);
814*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X1_DECODE_SYMBOL, 3);
815*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X1_DECODE_SYMBOL, 4);
816*3117ece4Schristos 
817*3117ece4Schristos             /* Reload each of the 4 the bitstreams */
818*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM(HUF_4X1_RELOAD_STREAM);
819*3117ece4Schristos         } while (op[3] < olimit);
820*3117ece4Schristos 
821*3117ece4Schristos #undef HUF_4X1_DECODE_SYMBOL
822*3117ece4Schristos #undef HUF_4X1_RELOAD_STREAM
823*3117ece4Schristos     }
824*3117ece4Schristos 
825*3117ece4Schristos _out:
826*3117ece4Schristos 
827*3117ece4Schristos     /* Save the final values of each of the state variables back to args. */
828*3117ece4Schristos     ZSTD_memcpy(&args->bits, &bits, sizeof(bits));
829*3117ece4Schristos     ZSTD_memcpy((void*)(&args->ip), &ip, sizeof(ip));
830*3117ece4Schristos     ZSTD_memcpy(&args->op, &op, sizeof(op));
831*3117ece4Schristos }
832*3117ece4Schristos 
833*3117ece4Schristos /**
834*3117ece4Schristos  * @returns @p dstSize on success (>= 6)
835*3117ece4Schristos  *          0 if the fallback implementation should be used
836*3117ece4Schristos  *          An error if an error occurred
837*3117ece4Schristos  */
838*3117ece4Schristos static HUF_FAST_BMI2_ATTRS
839*3117ece4Schristos size_t
840*3117ece4Schristos HUF_decompress4X1_usingDTable_internal_fast(
841*3117ece4Schristos           void* dst,  size_t dstSize,
842*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
843*3117ece4Schristos     const HUF_DTable* DTable,
844*3117ece4Schristos     HUF_DecompressFastLoopFn loopFn)
845*3117ece4Schristos {
846*3117ece4Schristos     void const* dt = DTable + 1;
847*3117ece4Schristos     BYTE const* const ilowest = (BYTE const*)cSrc;
848*3117ece4Schristos     BYTE* const oend = ZSTD_maybeNullPtrAdd((BYTE*)dst, dstSize);
849*3117ece4Schristos     HUF_DecompressFastArgs args;
850*3117ece4Schristos     {   size_t const ret = HUF_DecompressFastArgs_init(&args, dst, dstSize, cSrc, cSrcSize, DTable);
851*3117ece4Schristos         FORWARD_IF_ERROR(ret, "Failed to init fast loop args");
852*3117ece4Schristos         if (ret == 0)
853*3117ece4Schristos             return 0;
854*3117ece4Schristos     }
855*3117ece4Schristos 
856*3117ece4Schristos     assert(args.ip[0] >= args.ilowest);
857*3117ece4Schristos     loopFn(&args);
858*3117ece4Schristos 
859*3117ece4Schristos     /* Our loop guarantees that ip[] >= ilowest and that we haven't
860*3117ece4Schristos     * overwritten any op[].
861*3117ece4Schristos     */
862*3117ece4Schristos     assert(args.ip[0] >= ilowest);
863*3117ece4Schristos     assert(args.ip[0] >= ilowest);
864*3117ece4Schristos     assert(args.ip[1] >= ilowest);
865*3117ece4Schristos     assert(args.ip[2] >= ilowest);
866*3117ece4Schristos     assert(args.ip[3] >= ilowest);
867*3117ece4Schristos     assert(args.op[3] <= oend);
868*3117ece4Schristos 
869*3117ece4Schristos     assert(ilowest == args.ilowest);
870*3117ece4Schristos     assert(ilowest + 6 == args.iend[0]);
871*3117ece4Schristos     (void)ilowest;
872*3117ece4Schristos 
873*3117ece4Schristos     /* finish bit streams one by one. */
874*3117ece4Schristos     {   size_t const segmentSize = (dstSize+3) / 4;
875*3117ece4Schristos         BYTE* segmentEnd = (BYTE*)dst;
876*3117ece4Schristos         int i;
877*3117ece4Schristos         for (i = 0; i < 4; ++i) {
878*3117ece4Schristos             BIT_DStream_t bit;
879*3117ece4Schristos             if (segmentSize <= (size_t)(oend - segmentEnd))
880*3117ece4Schristos                 segmentEnd += segmentSize;
881*3117ece4Schristos             else
882*3117ece4Schristos                 segmentEnd = oend;
883*3117ece4Schristos             FORWARD_IF_ERROR(HUF_initRemainingDStream(&bit, &args, i, segmentEnd), "corruption");
884*3117ece4Schristos             /* Decompress and validate that we've produced exactly the expected length. */
885*3117ece4Schristos             args.op[i] += HUF_decodeStreamX1(args.op[i], &bit, segmentEnd, (HUF_DEltX1 const*)dt, HUF_DECODER_FAST_TABLELOG);
886*3117ece4Schristos             if (args.op[i] != segmentEnd) return ERROR(corruption_detected);
887*3117ece4Schristos         }
888*3117ece4Schristos     }
889*3117ece4Schristos 
890*3117ece4Schristos     /* decoded size */
891*3117ece4Schristos     assert(dstSize != 0);
892*3117ece4Schristos     return dstSize;
893*3117ece4Schristos }
894*3117ece4Schristos 
895*3117ece4Schristos HUF_DGEN(HUF_decompress1X1_usingDTable_internal)
896*3117ece4Schristos 
897*3117ece4Schristos static size_t HUF_decompress4X1_usingDTable_internal(void* dst, size_t dstSize, void const* cSrc,
898*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable, int flags)
899*3117ece4Schristos {
900*3117ece4Schristos     HUF_DecompressUsingDTableFn fallbackFn = HUF_decompress4X1_usingDTable_internal_default;
901*3117ece4Schristos     HUF_DecompressFastLoopFn loopFn = HUF_decompress4X1_usingDTable_internal_fast_c_loop;
902*3117ece4Schristos 
903*3117ece4Schristos #if DYNAMIC_BMI2
904*3117ece4Schristos     if (flags & HUF_flags_bmi2) {
905*3117ece4Schristos         fallbackFn = HUF_decompress4X1_usingDTable_internal_bmi2;
906*3117ece4Schristos # if ZSTD_ENABLE_ASM_X86_64_BMI2
907*3117ece4Schristos         if (!(flags & HUF_flags_disableAsm)) {
908*3117ece4Schristos             loopFn = HUF_decompress4X1_usingDTable_internal_fast_asm_loop;
909*3117ece4Schristos         }
910*3117ece4Schristos # endif
911*3117ece4Schristos     } else {
912*3117ece4Schristos         return fallbackFn(dst, dstSize, cSrc, cSrcSize, DTable);
913*3117ece4Schristos     }
914*3117ece4Schristos #endif
915*3117ece4Schristos 
916*3117ece4Schristos #if ZSTD_ENABLE_ASM_X86_64_BMI2 && defined(__BMI2__)
917*3117ece4Schristos     if (!(flags & HUF_flags_disableAsm)) {
918*3117ece4Schristos         loopFn = HUF_decompress4X1_usingDTable_internal_fast_asm_loop;
919*3117ece4Schristos     }
920*3117ece4Schristos #endif
921*3117ece4Schristos 
922*3117ece4Schristos     if (HUF_ENABLE_FAST_DECODE && !(flags & HUF_flags_disableFast)) {
923*3117ece4Schristos         size_t const ret = HUF_decompress4X1_usingDTable_internal_fast(dst, dstSize, cSrc, cSrcSize, DTable, loopFn);
924*3117ece4Schristos         if (ret != 0)
925*3117ece4Schristos             return ret;
926*3117ece4Schristos     }
927*3117ece4Schristos     return fallbackFn(dst, dstSize, cSrc, cSrcSize, DTable);
928*3117ece4Schristos }
929*3117ece4Schristos 
930*3117ece4Schristos static size_t HUF_decompress4X1_DCtx_wksp(HUF_DTable* dctx, void* dst, size_t dstSize,
931*3117ece4Schristos                                    const void* cSrc, size_t cSrcSize,
932*3117ece4Schristos                                    void* workSpace, size_t wkspSize, int flags)
933*3117ece4Schristos {
934*3117ece4Schristos     const BYTE* ip = (const BYTE*) cSrc;
935*3117ece4Schristos 
936*3117ece4Schristos     size_t const hSize = HUF_readDTableX1_wksp(dctx, cSrc, cSrcSize, workSpace, wkspSize, flags);
937*3117ece4Schristos     if (HUF_isError(hSize)) return hSize;
938*3117ece4Schristos     if (hSize >= cSrcSize) return ERROR(srcSize_wrong);
939*3117ece4Schristos     ip += hSize; cSrcSize -= hSize;
940*3117ece4Schristos 
941*3117ece4Schristos     return HUF_decompress4X1_usingDTable_internal(dst, dstSize, ip, cSrcSize, dctx, flags);
942*3117ece4Schristos }
943*3117ece4Schristos 
944*3117ece4Schristos #endif /* HUF_FORCE_DECOMPRESS_X2 */
945*3117ece4Schristos 
946*3117ece4Schristos 
947*3117ece4Schristos #ifndef HUF_FORCE_DECOMPRESS_X1
948*3117ece4Schristos 
949*3117ece4Schristos /* *************************/
950*3117ece4Schristos /* double-symbols decoding */
951*3117ece4Schristos /* *************************/
952*3117ece4Schristos 
953*3117ece4Schristos typedef struct { U16 sequence; BYTE nbBits; BYTE length; } HUF_DEltX2;  /* double-symbols decoding */
954*3117ece4Schristos typedef struct { BYTE symbol; } sortedSymbol_t;
955*3117ece4Schristos typedef U32 rankValCol_t[HUF_TABLELOG_MAX + 1];
956*3117ece4Schristos typedef rankValCol_t rankVal_t[HUF_TABLELOG_MAX];
957*3117ece4Schristos 
958*3117ece4Schristos /**
959*3117ece4Schristos  * Constructs a HUF_DEltX2 in a U32.
960*3117ece4Schristos  */
961*3117ece4Schristos static U32 HUF_buildDEltX2U32(U32 symbol, U32 nbBits, U32 baseSeq, int level)
962*3117ece4Schristos {
963*3117ece4Schristos     U32 seq;
964*3117ece4Schristos     DEBUG_STATIC_ASSERT(offsetof(HUF_DEltX2, sequence) == 0);
965*3117ece4Schristos     DEBUG_STATIC_ASSERT(offsetof(HUF_DEltX2, nbBits) == 2);
966*3117ece4Schristos     DEBUG_STATIC_ASSERT(offsetof(HUF_DEltX2, length) == 3);
967*3117ece4Schristos     DEBUG_STATIC_ASSERT(sizeof(HUF_DEltX2) == sizeof(U32));
968*3117ece4Schristos     if (MEM_isLittleEndian()) {
969*3117ece4Schristos         seq = level == 1 ? symbol : (baseSeq + (symbol << 8));
970*3117ece4Schristos         return seq + (nbBits << 16) + ((U32)level << 24);
971*3117ece4Schristos     } else {
972*3117ece4Schristos         seq = level == 1 ? (symbol << 8) : ((baseSeq << 8) + symbol);
973*3117ece4Schristos         return (seq << 16) + (nbBits << 8) + (U32)level;
974*3117ece4Schristos     }
975*3117ece4Schristos }
976*3117ece4Schristos 
977*3117ece4Schristos /**
978*3117ece4Schristos  * Constructs a HUF_DEltX2.
979*3117ece4Schristos  */
980*3117ece4Schristos static HUF_DEltX2 HUF_buildDEltX2(U32 symbol, U32 nbBits, U32 baseSeq, int level)
981*3117ece4Schristos {
982*3117ece4Schristos     HUF_DEltX2 DElt;
983*3117ece4Schristos     U32 const val = HUF_buildDEltX2U32(symbol, nbBits, baseSeq, level);
984*3117ece4Schristos     DEBUG_STATIC_ASSERT(sizeof(DElt) == sizeof(val));
985*3117ece4Schristos     ZSTD_memcpy(&DElt, &val, sizeof(val));
986*3117ece4Schristos     return DElt;
987*3117ece4Schristos }
988*3117ece4Schristos 
989*3117ece4Schristos /**
990*3117ece4Schristos  * Constructs 2 HUF_DEltX2s and packs them into a U64.
991*3117ece4Schristos  */
992*3117ece4Schristos static U64 HUF_buildDEltX2U64(U32 symbol, U32 nbBits, U16 baseSeq, int level)
993*3117ece4Schristos {
994*3117ece4Schristos     U32 DElt = HUF_buildDEltX2U32(symbol, nbBits, baseSeq, level);
995*3117ece4Schristos     return (U64)DElt + ((U64)DElt << 32);
996*3117ece4Schristos }
997*3117ece4Schristos 
998*3117ece4Schristos /**
999*3117ece4Schristos  * Fills the DTable rank with all the symbols from [begin, end) that are each
1000*3117ece4Schristos  * nbBits long.
1001*3117ece4Schristos  *
1002*3117ece4Schristos  * @param DTableRank The start of the rank in the DTable.
1003*3117ece4Schristos  * @param begin The first symbol to fill (inclusive).
1004*3117ece4Schristos  * @param end The last symbol to fill (exclusive).
1005*3117ece4Schristos  * @param nbBits Each symbol is nbBits long.
1006*3117ece4Schristos  * @param tableLog The table log.
1007*3117ece4Schristos  * @param baseSeq If level == 1 { 0 } else { the first level symbol }
1008*3117ece4Schristos  * @param level The level in the table. Must be 1 or 2.
1009*3117ece4Schristos  */
1010*3117ece4Schristos static void HUF_fillDTableX2ForWeight(
1011*3117ece4Schristos     HUF_DEltX2* DTableRank,
1012*3117ece4Schristos     sortedSymbol_t const* begin, sortedSymbol_t const* end,
1013*3117ece4Schristos     U32 nbBits, U32 tableLog,
1014*3117ece4Schristos     U16 baseSeq, int const level)
1015*3117ece4Schristos {
1016*3117ece4Schristos     U32 const length = 1U << ((tableLog - nbBits) & 0x1F /* quiet static-analyzer */);
1017*3117ece4Schristos     const sortedSymbol_t* ptr;
1018*3117ece4Schristos     assert(level >= 1 && level <= 2);
1019*3117ece4Schristos     switch (length) {
1020*3117ece4Schristos     case 1:
1021*3117ece4Schristos         for (ptr = begin; ptr != end; ++ptr) {
1022*3117ece4Schristos             HUF_DEltX2 const DElt = HUF_buildDEltX2(ptr->symbol, nbBits, baseSeq, level);
1023*3117ece4Schristos             *DTableRank++ = DElt;
1024*3117ece4Schristos         }
1025*3117ece4Schristos         break;
1026*3117ece4Schristos     case 2:
1027*3117ece4Schristos         for (ptr = begin; ptr != end; ++ptr) {
1028*3117ece4Schristos             HUF_DEltX2 const DElt = HUF_buildDEltX2(ptr->symbol, nbBits, baseSeq, level);
1029*3117ece4Schristos             DTableRank[0] = DElt;
1030*3117ece4Schristos             DTableRank[1] = DElt;
1031*3117ece4Schristos             DTableRank += 2;
1032*3117ece4Schristos         }
1033*3117ece4Schristos         break;
1034*3117ece4Schristos     case 4:
1035*3117ece4Schristos         for (ptr = begin; ptr != end; ++ptr) {
1036*3117ece4Schristos             U64 const DEltX2 = HUF_buildDEltX2U64(ptr->symbol, nbBits, baseSeq, level);
1037*3117ece4Schristos             ZSTD_memcpy(DTableRank + 0, &DEltX2, sizeof(DEltX2));
1038*3117ece4Schristos             ZSTD_memcpy(DTableRank + 2, &DEltX2, sizeof(DEltX2));
1039*3117ece4Schristos             DTableRank += 4;
1040*3117ece4Schristos         }
1041*3117ece4Schristos         break;
1042*3117ece4Schristos     case 8:
1043*3117ece4Schristos         for (ptr = begin; ptr != end; ++ptr) {
1044*3117ece4Schristos             U64 const DEltX2 = HUF_buildDEltX2U64(ptr->symbol, nbBits, baseSeq, level);
1045*3117ece4Schristos             ZSTD_memcpy(DTableRank + 0, &DEltX2, sizeof(DEltX2));
1046*3117ece4Schristos             ZSTD_memcpy(DTableRank + 2, &DEltX2, sizeof(DEltX2));
1047*3117ece4Schristos             ZSTD_memcpy(DTableRank + 4, &DEltX2, sizeof(DEltX2));
1048*3117ece4Schristos             ZSTD_memcpy(DTableRank + 6, &DEltX2, sizeof(DEltX2));
1049*3117ece4Schristos             DTableRank += 8;
1050*3117ece4Schristos         }
1051*3117ece4Schristos         break;
1052*3117ece4Schristos     default:
1053*3117ece4Schristos         for (ptr = begin; ptr != end; ++ptr) {
1054*3117ece4Schristos             U64 const DEltX2 = HUF_buildDEltX2U64(ptr->symbol, nbBits, baseSeq, level);
1055*3117ece4Schristos             HUF_DEltX2* const DTableRankEnd = DTableRank + length;
1056*3117ece4Schristos             for (; DTableRank != DTableRankEnd; DTableRank += 8) {
1057*3117ece4Schristos                 ZSTD_memcpy(DTableRank + 0, &DEltX2, sizeof(DEltX2));
1058*3117ece4Schristos                 ZSTD_memcpy(DTableRank + 2, &DEltX2, sizeof(DEltX2));
1059*3117ece4Schristos                 ZSTD_memcpy(DTableRank + 4, &DEltX2, sizeof(DEltX2));
1060*3117ece4Schristos                 ZSTD_memcpy(DTableRank + 6, &DEltX2, sizeof(DEltX2));
1061*3117ece4Schristos             }
1062*3117ece4Schristos         }
1063*3117ece4Schristos         break;
1064*3117ece4Schristos     }
1065*3117ece4Schristos }
1066*3117ece4Schristos 
1067*3117ece4Schristos /* HUF_fillDTableX2Level2() :
1068*3117ece4Schristos  * `rankValOrigin` must be a table of at least (HUF_TABLELOG_MAX + 1) U32 */
1069*3117ece4Schristos static void HUF_fillDTableX2Level2(HUF_DEltX2* DTable, U32 targetLog, const U32 consumedBits,
1070*3117ece4Schristos                            const U32* rankVal, const int minWeight, const int maxWeight1,
1071*3117ece4Schristos                            const sortedSymbol_t* sortedSymbols, U32 const* rankStart,
1072*3117ece4Schristos                            U32 nbBitsBaseline, U16 baseSeq)
1073*3117ece4Schristos {
1074*3117ece4Schristos     /* Fill skipped values (all positions up to rankVal[minWeight]).
1075*3117ece4Schristos      * These are positions only get a single symbol because the combined weight
1076*3117ece4Schristos      * is too large.
1077*3117ece4Schristos      */
1078*3117ece4Schristos     if (minWeight>1) {
1079*3117ece4Schristos         U32 const length = 1U << ((targetLog - consumedBits) & 0x1F /* quiet static-analyzer */);
1080*3117ece4Schristos         U64 const DEltX2 = HUF_buildDEltX2U64(baseSeq, consumedBits, /* baseSeq */ 0, /* level */ 1);
1081*3117ece4Schristos         int const skipSize = rankVal[minWeight];
1082*3117ece4Schristos         assert(length > 1);
1083*3117ece4Schristos         assert((U32)skipSize < length);
1084*3117ece4Schristos         switch (length) {
1085*3117ece4Schristos         case 2:
1086*3117ece4Schristos             assert(skipSize == 1);
1087*3117ece4Schristos             ZSTD_memcpy(DTable, &DEltX2, sizeof(DEltX2));
1088*3117ece4Schristos             break;
1089*3117ece4Schristos         case 4:
1090*3117ece4Schristos             assert(skipSize <= 4);
1091*3117ece4Schristos             ZSTD_memcpy(DTable + 0, &DEltX2, sizeof(DEltX2));
1092*3117ece4Schristos             ZSTD_memcpy(DTable + 2, &DEltX2, sizeof(DEltX2));
1093*3117ece4Schristos             break;
1094*3117ece4Schristos         default:
1095*3117ece4Schristos             {
1096*3117ece4Schristos                 int i;
1097*3117ece4Schristos                 for (i = 0; i < skipSize; i += 8) {
1098*3117ece4Schristos                     ZSTD_memcpy(DTable + i + 0, &DEltX2, sizeof(DEltX2));
1099*3117ece4Schristos                     ZSTD_memcpy(DTable + i + 2, &DEltX2, sizeof(DEltX2));
1100*3117ece4Schristos                     ZSTD_memcpy(DTable + i + 4, &DEltX2, sizeof(DEltX2));
1101*3117ece4Schristos                     ZSTD_memcpy(DTable + i + 6, &DEltX2, sizeof(DEltX2));
1102*3117ece4Schristos                 }
1103*3117ece4Schristos             }
1104*3117ece4Schristos         }
1105*3117ece4Schristos     }
1106*3117ece4Schristos 
1107*3117ece4Schristos     /* Fill each of the second level symbols by weight. */
1108*3117ece4Schristos     {
1109*3117ece4Schristos         int w;
1110*3117ece4Schristos         for (w = minWeight; w < maxWeight1; ++w) {
1111*3117ece4Schristos             int const begin = rankStart[w];
1112*3117ece4Schristos             int const end = rankStart[w+1];
1113*3117ece4Schristos             U32 const nbBits = nbBitsBaseline - w;
1114*3117ece4Schristos             U32 const totalBits = nbBits + consumedBits;
1115*3117ece4Schristos             HUF_fillDTableX2ForWeight(
1116*3117ece4Schristos                 DTable + rankVal[w],
1117*3117ece4Schristos                 sortedSymbols + begin, sortedSymbols + end,
1118*3117ece4Schristos                 totalBits, targetLog,
1119*3117ece4Schristos                 baseSeq, /* level */ 2);
1120*3117ece4Schristos         }
1121*3117ece4Schristos     }
1122*3117ece4Schristos }
1123*3117ece4Schristos 
1124*3117ece4Schristos static void HUF_fillDTableX2(HUF_DEltX2* DTable, const U32 targetLog,
1125*3117ece4Schristos                            const sortedSymbol_t* sortedList,
1126*3117ece4Schristos                            const U32* rankStart, rankValCol_t* rankValOrigin, const U32 maxWeight,
1127*3117ece4Schristos                            const U32 nbBitsBaseline)
1128*3117ece4Schristos {
1129*3117ece4Schristos     U32* const rankVal = rankValOrigin[0];
1130*3117ece4Schristos     const int scaleLog = nbBitsBaseline - targetLog;   /* note : targetLog >= srcLog, hence scaleLog <= 1 */
1131*3117ece4Schristos     const U32 minBits  = nbBitsBaseline - maxWeight;
1132*3117ece4Schristos     int w;
1133*3117ece4Schristos     int const wEnd = (int)maxWeight + 1;
1134*3117ece4Schristos 
1135*3117ece4Schristos     /* Fill DTable in order of weight. */
1136*3117ece4Schristos     for (w = 1; w < wEnd; ++w) {
1137*3117ece4Schristos         int const begin = (int)rankStart[w];
1138*3117ece4Schristos         int const end = (int)rankStart[w+1];
1139*3117ece4Schristos         U32 const nbBits = nbBitsBaseline - w;
1140*3117ece4Schristos 
1141*3117ece4Schristos         if (targetLog-nbBits >= minBits) {
1142*3117ece4Schristos             /* Enough room for a second symbol. */
1143*3117ece4Schristos             int start = rankVal[w];
1144*3117ece4Schristos             U32 const length = 1U << ((targetLog - nbBits) & 0x1F /* quiet static-analyzer */);
1145*3117ece4Schristos             int minWeight = nbBits + scaleLog;
1146*3117ece4Schristos             int s;
1147*3117ece4Schristos             if (minWeight < 1) minWeight = 1;
1148*3117ece4Schristos             /* Fill the DTable for every symbol of weight w.
1149*3117ece4Schristos              * These symbols get at least 1 second symbol.
1150*3117ece4Schristos              */
1151*3117ece4Schristos             for (s = begin; s != end; ++s) {
1152*3117ece4Schristos                 HUF_fillDTableX2Level2(
1153*3117ece4Schristos                     DTable + start, targetLog, nbBits,
1154*3117ece4Schristos                     rankValOrigin[nbBits], minWeight, wEnd,
1155*3117ece4Schristos                     sortedList, rankStart,
1156*3117ece4Schristos                     nbBitsBaseline, sortedList[s].symbol);
1157*3117ece4Schristos                 start += length;
1158*3117ece4Schristos             }
1159*3117ece4Schristos         } else {
1160*3117ece4Schristos             /* Only a single symbol. */
1161*3117ece4Schristos             HUF_fillDTableX2ForWeight(
1162*3117ece4Schristos                 DTable + rankVal[w],
1163*3117ece4Schristos                 sortedList + begin, sortedList + end,
1164*3117ece4Schristos                 nbBits, targetLog,
1165*3117ece4Schristos                 /* baseSeq */ 0, /* level */ 1);
1166*3117ece4Schristos         }
1167*3117ece4Schristos     }
1168*3117ece4Schristos }
1169*3117ece4Schristos 
1170*3117ece4Schristos typedef struct {
1171*3117ece4Schristos     rankValCol_t rankVal[HUF_TABLELOG_MAX];
1172*3117ece4Schristos     U32 rankStats[HUF_TABLELOG_MAX + 1];
1173*3117ece4Schristos     U32 rankStart0[HUF_TABLELOG_MAX + 3];
1174*3117ece4Schristos     sortedSymbol_t sortedSymbol[HUF_SYMBOLVALUE_MAX + 1];
1175*3117ece4Schristos     BYTE weightList[HUF_SYMBOLVALUE_MAX + 1];
1176*3117ece4Schristos     U32 calleeWksp[HUF_READ_STATS_WORKSPACE_SIZE_U32];
1177*3117ece4Schristos } HUF_ReadDTableX2_Workspace;
1178*3117ece4Schristos 
1179*3117ece4Schristos size_t HUF_readDTableX2_wksp(HUF_DTable* DTable,
1180*3117ece4Schristos                        const void* src, size_t srcSize,
1181*3117ece4Schristos                              void* workSpace, size_t wkspSize, int flags)
1182*3117ece4Schristos {
1183*3117ece4Schristos     U32 tableLog, maxW, nbSymbols;
1184*3117ece4Schristos     DTableDesc dtd = HUF_getDTableDesc(DTable);
1185*3117ece4Schristos     U32 maxTableLog = dtd.maxTableLog;
1186*3117ece4Schristos     size_t iSize;
1187*3117ece4Schristos     void* dtPtr = DTable+1;   /* force compiler to avoid strict-aliasing */
1188*3117ece4Schristos     HUF_DEltX2* const dt = (HUF_DEltX2*)dtPtr;
1189*3117ece4Schristos     U32 *rankStart;
1190*3117ece4Schristos 
1191*3117ece4Schristos     HUF_ReadDTableX2_Workspace* const wksp = (HUF_ReadDTableX2_Workspace*)workSpace;
1192*3117ece4Schristos 
1193*3117ece4Schristos     if (sizeof(*wksp) > wkspSize) return ERROR(GENERIC);
1194*3117ece4Schristos 
1195*3117ece4Schristos     rankStart = wksp->rankStart0 + 1;
1196*3117ece4Schristos     ZSTD_memset(wksp->rankStats, 0, sizeof(wksp->rankStats));
1197*3117ece4Schristos     ZSTD_memset(wksp->rankStart0, 0, sizeof(wksp->rankStart0));
1198*3117ece4Schristos 
1199*3117ece4Schristos     DEBUG_STATIC_ASSERT(sizeof(HUF_DEltX2) == sizeof(HUF_DTable));   /* if compiler fails here, assertion is wrong */
1200*3117ece4Schristos     if (maxTableLog > HUF_TABLELOG_MAX) return ERROR(tableLog_tooLarge);
1201*3117ece4Schristos     /* ZSTD_memset(weightList, 0, sizeof(weightList)); */  /* is not necessary, even though some analyzer complain ... */
1202*3117ece4Schristos 
1203*3117ece4Schristos     iSize = HUF_readStats_wksp(wksp->weightList, HUF_SYMBOLVALUE_MAX + 1, wksp->rankStats, &nbSymbols, &tableLog, src, srcSize, wksp->calleeWksp, sizeof(wksp->calleeWksp), flags);
1204*3117ece4Schristos     if (HUF_isError(iSize)) return iSize;
1205*3117ece4Schristos 
1206*3117ece4Schristos     /* check result */
1207*3117ece4Schristos     if (tableLog > maxTableLog) return ERROR(tableLog_tooLarge);   /* DTable can't fit code depth */
1208*3117ece4Schristos     if (tableLog <= HUF_DECODER_FAST_TABLELOG && maxTableLog > HUF_DECODER_FAST_TABLELOG) maxTableLog = HUF_DECODER_FAST_TABLELOG;
1209*3117ece4Schristos 
1210*3117ece4Schristos     /* find maxWeight */
1211*3117ece4Schristos     for (maxW = tableLog; wksp->rankStats[maxW]==0; maxW--) {}  /* necessarily finds a solution before 0 */
1212*3117ece4Schristos 
1213*3117ece4Schristos     /* Get start index of each weight */
1214*3117ece4Schristos     {   U32 w, nextRankStart = 0;
1215*3117ece4Schristos         for (w=1; w<maxW+1; w++) {
1216*3117ece4Schristos             U32 curr = nextRankStart;
1217*3117ece4Schristos             nextRankStart += wksp->rankStats[w];
1218*3117ece4Schristos             rankStart[w] = curr;
1219*3117ece4Schristos         }
1220*3117ece4Schristos         rankStart[0] = nextRankStart;   /* put all 0w symbols at the end of sorted list*/
1221*3117ece4Schristos         rankStart[maxW+1] = nextRankStart;
1222*3117ece4Schristos     }
1223*3117ece4Schristos 
1224*3117ece4Schristos     /* sort symbols by weight */
1225*3117ece4Schristos     {   U32 s;
1226*3117ece4Schristos         for (s=0; s<nbSymbols; s++) {
1227*3117ece4Schristos             U32 const w = wksp->weightList[s];
1228*3117ece4Schristos             U32 const r = rankStart[w]++;
1229*3117ece4Schristos             wksp->sortedSymbol[r].symbol = (BYTE)s;
1230*3117ece4Schristos         }
1231*3117ece4Schristos         rankStart[0] = 0;   /* forget 0w symbols; this is beginning of weight(1) */
1232*3117ece4Schristos     }
1233*3117ece4Schristos 
1234*3117ece4Schristos     /* Build rankVal */
1235*3117ece4Schristos     {   U32* const rankVal0 = wksp->rankVal[0];
1236*3117ece4Schristos         {   int const rescale = (maxTableLog-tableLog) - 1;   /* tableLog <= maxTableLog */
1237*3117ece4Schristos             U32 nextRankVal = 0;
1238*3117ece4Schristos             U32 w;
1239*3117ece4Schristos             for (w=1; w<maxW+1; w++) {
1240*3117ece4Schristos                 U32 curr = nextRankVal;
1241*3117ece4Schristos                 nextRankVal += wksp->rankStats[w] << (w+rescale);
1242*3117ece4Schristos                 rankVal0[w] = curr;
1243*3117ece4Schristos         }   }
1244*3117ece4Schristos         {   U32 const minBits = tableLog+1 - maxW;
1245*3117ece4Schristos             U32 consumed;
1246*3117ece4Schristos             for (consumed = minBits; consumed < maxTableLog - minBits + 1; consumed++) {
1247*3117ece4Schristos                 U32* const rankValPtr = wksp->rankVal[consumed];
1248*3117ece4Schristos                 U32 w;
1249*3117ece4Schristos                 for (w = 1; w < maxW+1; w++) {
1250*3117ece4Schristos                     rankValPtr[w] = rankVal0[w] >> consumed;
1251*3117ece4Schristos     }   }   }   }
1252*3117ece4Schristos 
1253*3117ece4Schristos     HUF_fillDTableX2(dt, maxTableLog,
1254*3117ece4Schristos                    wksp->sortedSymbol,
1255*3117ece4Schristos                    wksp->rankStart0, wksp->rankVal, maxW,
1256*3117ece4Schristos                    tableLog+1);
1257*3117ece4Schristos 
1258*3117ece4Schristos     dtd.tableLog = (BYTE)maxTableLog;
1259*3117ece4Schristos     dtd.tableType = 1;
1260*3117ece4Schristos     ZSTD_memcpy(DTable, &dtd, sizeof(dtd));
1261*3117ece4Schristos     return iSize;
1262*3117ece4Schristos }
1263*3117ece4Schristos 
1264*3117ece4Schristos 
1265*3117ece4Schristos FORCE_INLINE_TEMPLATE U32
1266*3117ece4Schristos HUF_decodeSymbolX2(void* op, BIT_DStream_t* DStream, const HUF_DEltX2* dt, const U32 dtLog)
1267*3117ece4Schristos {
1268*3117ece4Schristos     size_t const val = BIT_lookBitsFast(DStream, dtLog);   /* note : dtLog >= 1 */
1269*3117ece4Schristos     ZSTD_memcpy(op, &dt[val].sequence, 2);
1270*3117ece4Schristos     BIT_skipBits(DStream, dt[val].nbBits);
1271*3117ece4Schristos     return dt[val].length;
1272*3117ece4Schristos }
1273*3117ece4Schristos 
1274*3117ece4Schristos FORCE_INLINE_TEMPLATE U32
1275*3117ece4Schristos HUF_decodeLastSymbolX2(void* op, BIT_DStream_t* DStream, const HUF_DEltX2* dt, const U32 dtLog)
1276*3117ece4Schristos {
1277*3117ece4Schristos     size_t const val = BIT_lookBitsFast(DStream, dtLog);   /* note : dtLog >= 1 */
1278*3117ece4Schristos     ZSTD_memcpy(op, &dt[val].sequence, 1);
1279*3117ece4Schristos     if (dt[val].length==1) {
1280*3117ece4Schristos         BIT_skipBits(DStream, dt[val].nbBits);
1281*3117ece4Schristos     } else {
1282*3117ece4Schristos         if (DStream->bitsConsumed < (sizeof(DStream->bitContainer)*8)) {
1283*3117ece4Schristos             BIT_skipBits(DStream, dt[val].nbBits);
1284*3117ece4Schristos             if (DStream->bitsConsumed > (sizeof(DStream->bitContainer)*8))
1285*3117ece4Schristos                 /* ugly hack; works only because it's the last symbol. Note : can't easily extract nbBits from just this symbol */
1286*3117ece4Schristos                 DStream->bitsConsumed = (sizeof(DStream->bitContainer)*8);
1287*3117ece4Schristos         }
1288*3117ece4Schristos     }
1289*3117ece4Schristos     return 1;
1290*3117ece4Schristos }
1291*3117ece4Schristos 
1292*3117ece4Schristos #define HUF_DECODE_SYMBOLX2_0(ptr, DStreamPtr) \
1293*3117ece4Schristos     do { ptr += HUF_decodeSymbolX2(ptr, DStreamPtr, dt, dtLog); } while (0)
1294*3117ece4Schristos 
1295*3117ece4Schristos #define HUF_DECODE_SYMBOLX2_1(ptr, DStreamPtr)                     \
1296*3117ece4Schristos     do {                                                           \
1297*3117ece4Schristos         if (MEM_64bits() || (HUF_TABLELOG_MAX<=12))                \
1298*3117ece4Schristos             ptr += HUF_decodeSymbolX2(ptr, DStreamPtr, dt, dtLog); \
1299*3117ece4Schristos     } while (0)
1300*3117ece4Schristos 
1301*3117ece4Schristos #define HUF_DECODE_SYMBOLX2_2(ptr, DStreamPtr)                     \
1302*3117ece4Schristos     do {                                                           \
1303*3117ece4Schristos         if (MEM_64bits())                                          \
1304*3117ece4Schristos             ptr += HUF_decodeSymbolX2(ptr, DStreamPtr, dt, dtLog); \
1305*3117ece4Schristos     } while (0)
1306*3117ece4Schristos 
1307*3117ece4Schristos HINT_INLINE size_t
1308*3117ece4Schristos HUF_decodeStreamX2(BYTE* p, BIT_DStream_t* bitDPtr, BYTE* const pEnd,
1309*3117ece4Schristos                 const HUF_DEltX2* const dt, const U32 dtLog)
1310*3117ece4Schristos {
1311*3117ece4Schristos     BYTE* const pStart = p;
1312*3117ece4Schristos 
1313*3117ece4Schristos     /* up to 8 symbols at a time */
1314*3117ece4Schristos     if ((size_t)(pEnd - p) >= sizeof(bitDPtr->bitContainer)) {
1315*3117ece4Schristos         if (dtLog <= 11 && MEM_64bits()) {
1316*3117ece4Schristos             /* up to 10 symbols at a time */
1317*3117ece4Schristos             while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p < pEnd-9)) {
1318*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1319*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1320*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1321*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1322*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1323*3117ece4Schristos             }
1324*3117ece4Schristos         } else {
1325*3117ece4Schristos             /* up to 8 symbols at a time */
1326*3117ece4Schristos             while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p < pEnd-(sizeof(bitDPtr->bitContainer)-1))) {
1327*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(p, bitDPtr);
1328*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(p, bitDPtr);
1329*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(p, bitDPtr);
1330*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1331*3117ece4Schristos             }
1332*3117ece4Schristos         }
1333*3117ece4Schristos     } else {
1334*3117ece4Schristos         BIT_reloadDStream(bitDPtr);
1335*3117ece4Schristos     }
1336*3117ece4Schristos 
1337*3117ece4Schristos     /* closer to end : up to 2 symbols at a time */
1338*3117ece4Schristos     if ((size_t)(pEnd - p) >= 2) {
1339*3117ece4Schristos         while ((BIT_reloadDStream(bitDPtr) == BIT_DStream_unfinished) & (p <= pEnd-2))
1340*3117ece4Schristos             HUF_DECODE_SYMBOLX2_0(p, bitDPtr);
1341*3117ece4Schristos 
1342*3117ece4Schristos         while (p <= pEnd-2)
1343*3117ece4Schristos             HUF_DECODE_SYMBOLX2_0(p, bitDPtr);   /* no need to reload : reached the end of DStream */
1344*3117ece4Schristos     }
1345*3117ece4Schristos 
1346*3117ece4Schristos     if (p < pEnd)
1347*3117ece4Schristos         p += HUF_decodeLastSymbolX2(p, bitDPtr, dt, dtLog);
1348*3117ece4Schristos 
1349*3117ece4Schristos     return p-pStart;
1350*3117ece4Schristos }
1351*3117ece4Schristos 
1352*3117ece4Schristos FORCE_INLINE_TEMPLATE size_t
1353*3117ece4Schristos HUF_decompress1X2_usingDTable_internal_body(
1354*3117ece4Schristos           void* dst,  size_t dstSize,
1355*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
1356*3117ece4Schristos     const HUF_DTable* DTable)
1357*3117ece4Schristos {
1358*3117ece4Schristos     BIT_DStream_t bitD;
1359*3117ece4Schristos 
1360*3117ece4Schristos     /* Init */
1361*3117ece4Schristos     CHECK_F( BIT_initDStream(&bitD, cSrc, cSrcSize) );
1362*3117ece4Schristos 
1363*3117ece4Schristos     /* decode */
1364*3117ece4Schristos     {   BYTE* const ostart = (BYTE*) dst;
1365*3117ece4Schristos         BYTE* const oend = ZSTD_maybeNullPtrAdd(ostart, dstSize);
1366*3117ece4Schristos         const void* const dtPtr = DTable+1;   /* force compiler to not use strict-aliasing */
1367*3117ece4Schristos         const HUF_DEltX2* const dt = (const HUF_DEltX2*)dtPtr;
1368*3117ece4Schristos         DTableDesc const dtd = HUF_getDTableDesc(DTable);
1369*3117ece4Schristos         HUF_decodeStreamX2(ostart, &bitD, oend, dt, dtd.tableLog);
1370*3117ece4Schristos     }
1371*3117ece4Schristos 
1372*3117ece4Schristos     /* check */
1373*3117ece4Schristos     if (!BIT_endOfDStream(&bitD)) return ERROR(corruption_detected);
1374*3117ece4Schristos 
1375*3117ece4Schristos     /* decoded size */
1376*3117ece4Schristos     return dstSize;
1377*3117ece4Schristos }
1378*3117ece4Schristos 
1379*3117ece4Schristos /* HUF_decompress4X2_usingDTable_internal_body():
1380*3117ece4Schristos  * Conditions:
1381*3117ece4Schristos  * @dstSize >= 6
1382*3117ece4Schristos  */
1383*3117ece4Schristos FORCE_INLINE_TEMPLATE size_t
1384*3117ece4Schristos HUF_decompress4X2_usingDTable_internal_body(
1385*3117ece4Schristos           void* dst,  size_t dstSize,
1386*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
1387*3117ece4Schristos     const HUF_DTable* DTable)
1388*3117ece4Schristos {
1389*3117ece4Schristos     if (cSrcSize < 10) return ERROR(corruption_detected);   /* strict minimum : jump table + 1 byte per stream */
1390*3117ece4Schristos     if (dstSize < 6) return ERROR(corruption_detected);         /* stream 4-split doesn't work */
1391*3117ece4Schristos 
1392*3117ece4Schristos     {   const BYTE* const istart = (const BYTE*) cSrc;
1393*3117ece4Schristos         BYTE* const ostart = (BYTE*) dst;
1394*3117ece4Schristos         BYTE* const oend = ostart + dstSize;
1395*3117ece4Schristos         BYTE* const olimit = oend - (sizeof(size_t)-1);
1396*3117ece4Schristos         const void* const dtPtr = DTable+1;
1397*3117ece4Schristos         const HUF_DEltX2* const dt = (const HUF_DEltX2*)dtPtr;
1398*3117ece4Schristos 
1399*3117ece4Schristos         /* Init */
1400*3117ece4Schristos         BIT_DStream_t bitD1;
1401*3117ece4Schristos         BIT_DStream_t bitD2;
1402*3117ece4Schristos         BIT_DStream_t bitD3;
1403*3117ece4Schristos         BIT_DStream_t bitD4;
1404*3117ece4Schristos         size_t const length1 = MEM_readLE16(istart);
1405*3117ece4Schristos         size_t const length2 = MEM_readLE16(istart+2);
1406*3117ece4Schristos         size_t const length3 = MEM_readLE16(istart+4);
1407*3117ece4Schristos         size_t const length4 = cSrcSize - (length1 + length2 + length3 + 6);
1408*3117ece4Schristos         const BYTE* const istart1 = istart + 6;  /* jumpTable */
1409*3117ece4Schristos         const BYTE* const istart2 = istart1 + length1;
1410*3117ece4Schristos         const BYTE* const istart3 = istart2 + length2;
1411*3117ece4Schristos         const BYTE* const istart4 = istart3 + length3;
1412*3117ece4Schristos         size_t const segmentSize = (dstSize+3) / 4;
1413*3117ece4Schristos         BYTE* const opStart2 = ostart + segmentSize;
1414*3117ece4Schristos         BYTE* const opStart3 = opStart2 + segmentSize;
1415*3117ece4Schristos         BYTE* const opStart4 = opStart3 + segmentSize;
1416*3117ece4Schristos         BYTE* op1 = ostart;
1417*3117ece4Schristos         BYTE* op2 = opStart2;
1418*3117ece4Schristos         BYTE* op3 = opStart3;
1419*3117ece4Schristos         BYTE* op4 = opStart4;
1420*3117ece4Schristos         U32 endSignal = 1;
1421*3117ece4Schristos         DTableDesc const dtd = HUF_getDTableDesc(DTable);
1422*3117ece4Schristos         U32 const dtLog = dtd.tableLog;
1423*3117ece4Schristos 
1424*3117ece4Schristos         if (length4 > cSrcSize) return ERROR(corruption_detected);  /* overflow */
1425*3117ece4Schristos         if (opStart4 > oend) return ERROR(corruption_detected);     /* overflow */
1426*3117ece4Schristos         assert(dstSize >= 6 /* validated above */);
1427*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD1, istart1, length1) );
1428*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD2, istart2, length2) );
1429*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD3, istart3, length3) );
1430*3117ece4Schristos         CHECK_F( BIT_initDStream(&bitD4, istart4, length4) );
1431*3117ece4Schristos 
1432*3117ece4Schristos         /* 16-32 symbols per loop (4-8 symbols per stream) */
1433*3117ece4Schristos         if ((size_t)(oend - op4) >= sizeof(size_t)) {
1434*3117ece4Schristos             for ( ; (endSignal) & (op4 < olimit); ) {
1435*3117ece4Schristos #if defined(__clang__) && (defined(__x86_64__) || defined(__i386__))
1436*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op1, &bitD1);
1437*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op1, &bitD1);
1438*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op1, &bitD1);
1439*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op1, &bitD1);
1440*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op2, &bitD2);
1441*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op2, &bitD2);
1442*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op2, &bitD2);
1443*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op2, &bitD2);
1444*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD1) == BIT_DStream_unfinished;
1445*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD2) == BIT_DStream_unfinished;
1446*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op3, &bitD3);
1447*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op3, &bitD3);
1448*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op3, &bitD3);
1449*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op3, &bitD3);
1450*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op4, &bitD4);
1451*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op4, &bitD4);
1452*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op4, &bitD4);
1453*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op4, &bitD4);
1454*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD3) == BIT_DStream_unfinished;
1455*3117ece4Schristos                 endSignal &= BIT_reloadDStreamFast(&bitD4) == BIT_DStream_unfinished;
1456*3117ece4Schristos #else
1457*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op1, &bitD1);
1458*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op2, &bitD2);
1459*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op3, &bitD3);
1460*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op4, &bitD4);
1461*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op1, &bitD1);
1462*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op2, &bitD2);
1463*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op3, &bitD3);
1464*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_1(op4, &bitD4);
1465*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op1, &bitD1);
1466*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op2, &bitD2);
1467*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op3, &bitD3);
1468*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_2(op4, &bitD4);
1469*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op1, &bitD1);
1470*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op2, &bitD2);
1471*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op3, &bitD3);
1472*3117ece4Schristos                 HUF_DECODE_SYMBOLX2_0(op4, &bitD4);
1473*3117ece4Schristos                 endSignal = (U32)LIKELY((U32)
1474*3117ece4Schristos                             (BIT_reloadDStreamFast(&bitD1) == BIT_DStream_unfinished)
1475*3117ece4Schristos                         & (BIT_reloadDStreamFast(&bitD2) == BIT_DStream_unfinished)
1476*3117ece4Schristos                         & (BIT_reloadDStreamFast(&bitD3) == BIT_DStream_unfinished)
1477*3117ece4Schristos                         & (BIT_reloadDStreamFast(&bitD4) == BIT_DStream_unfinished));
1478*3117ece4Schristos #endif
1479*3117ece4Schristos             }
1480*3117ece4Schristos         }
1481*3117ece4Schristos 
1482*3117ece4Schristos         /* check corruption */
1483*3117ece4Schristos         if (op1 > opStart2) return ERROR(corruption_detected);
1484*3117ece4Schristos         if (op2 > opStart3) return ERROR(corruption_detected);
1485*3117ece4Schristos         if (op3 > opStart4) return ERROR(corruption_detected);
1486*3117ece4Schristos         /* note : op4 already verified within main loop */
1487*3117ece4Schristos 
1488*3117ece4Schristos         /* finish bitStreams one by one */
1489*3117ece4Schristos         HUF_decodeStreamX2(op1, &bitD1, opStart2, dt, dtLog);
1490*3117ece4Schristos         HUF_decodeStreamX2(op2, &bitD2, opStart3, dt, dtLog);
1491*3117ece4Schristos         HUF_decodeStreamX2(op3, &bitD3, opStart4, dt, dtLog);
1492*3117ece4Schristos         HUF_decodeStreamX2(op4, &bitD4, oend,     dt, dtLog);
1493*3117ece4Schristos 
1494*3117ece4Schristos         /* check */
1495*3117ece4Schristos         { U32 const endCheck = BIT_endOfDStream(&bitD1) & BIT_endOfDStream(&bitD2) & BIT_endOfDStream(&bitD3) & BIT_endOfDStream(&bitD4);
1496*3117ece4Schristos           if (!endCheck) return ERROR(corruption_detected); }
1497*3117ece4Schristos 
1498*3117ece4Schristos         /* decoded size */
1499*3117ece4Schristos         return dstSize;
1500*3117ece4Schristos     }
1501*3117ece4Schristos }
1502*3117ece4Schristos 
1503*3117ece4Schristos #if HUF_NEED_BMI2_FUNCTION
1504*3117ece4Schristos static BMI2_TARGET_ATTRIBUTE
1505*3117ece4Schristos size_t HUF_decompress4X2_usingDTable_internal_bmi2(void* dst, size_t dstSize, void const* cSrc,
1506*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable) {
1507*3117ece4Schristos     return HUF_decompress4X2_usingDTable_internal_body(dst, dstSize, cSrc, cSrcSize, DTable);
1508*3117ece4Schristos }
1509*3117ece4Schristos #endif
1510*3117ece4Schristos 
1511*3117ece4Schristos static
1512*3117ece4Schristos size_t HUF_decompress4X2_usingDTable_internal_default(void* dst, size_t dstSize, void const* cSrc,
1513*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable) {
1514*3117ece4Schristos     return HUF_decompress4X2_usingDTable_internal_body(dst, dstSize, cSrc, cSrcSize, DTable);
1515*3117ece4Schristos }
1516*3117ece4Schristos 
1517*3117ece4Schristos #if ZSTD_ENABLE_ASM_X86_64_BMI2
1518*3117ece4Schristos 
1519*3117ece4Schristos HUF_ASM_DECL void HUF_decompress4X2_usingDTable_internal_fast_asm_loop(HUF_DecompressFastArgs* args) ZSTDLIB_HIDDEN;
1520*3117ece4Schristos 
1521*3117ece4Schristos #endif
1522*3117ece4Schristos 
1523*3117ece4Schristos static HUF_FAST_BMI2_ATTRS
1524*3117ece4Schristos void HUF_decompress4X2_usingDTable_internal_fast_c_loop(HUF_DecompressFastArgs* args)
1525*3117ece4Schristos {
1526*3117ece4Schristos     U64 bits[4];
1527*3117ece4Schristos     BYTE const* ip[4];
1528*3117ece4Schristos     BYTE* op[4];
1529*3117ece4Schristos     BYTE* oend[4];
1530*3117ece4Schristos     HUF_DEltX2 const* const dtable = (HUF_DEltX2 const*)args->dt;
1531*3117ece4Schristos     BYTE const* const ilowest = args->ilowest;
1532*3117ece4Schristos 
1533*3117ece4Schristos     /* Copy the arguments to local registers. */
1534*3117ece4Schristos     ZSTD_memcpy(&bits, &args->bits, sizeof(bits));
1535*3117ece4Schristos     ZSTD_memcpy((void*)(&ip), &args->ip, sizeof(ip));
1536*3117ece4Schristos     ZSTD_memcpy(&op, &args->op, sizeof(op));
1537*3117ece4Schristos 
1538*3117ece4Schristos     oend[0] = op[1];
1539*3117ece4Schristos     oend[1] = op[2];
1540*3117ece4Schristos     oend[2] = op[3];
1541*3117ece4Schristos     oend[3] = args->oend;
1542*3117ece4Schristos 
1543*3117ece4Schristos     assert(MEM_isLittleEndian());
1544*3117ece4Schristos     assert(!MEM_32bits());
1545*3117ece4Schristos 
1546*3117ece4Schristos     for (;;) {
1547*3117ece4Schristos         BYTE* olimit;
1548*3117ece4Schristos         int stream;
1549*3117ece4Schristos 
1550*3117ece4Schristos         /* Assert loop preconditions */
1551*3117ece4Schristos #ifndef NDEBUG
1552*3117ece4Schristos         for (stream = 0; stream < 4; ++stream) {
1553*3117ece4Schristos             assert(op[stream] <= oend[stream]);
1554*3117ece4Schristos             assert(ip[stream] >= ilowest);
1555*3117ece4Schristos         }
1556*3117ece4Schristos #endif
1557*3117ece4Schristos         /* Compute olimit */
1558*3117ece4Schristos         {
1559*3117ece4Schristos             /* Each loop does 5 table lookups for each of the 4 streams.
1560*3117ece4Schristos              * Each table lookup consumes up to 11 bits of input, and produces
1561*3117ece4Schristos              * up to 2 bytes of output.
1562*3117ece4Schristos              */
1563*3117ece4Schristos             /* We can consume up to 7 bytes of input per iteration per stream.
1564*3117ece4Schristos              * We also know that each input pointer is >= ip[0]. So we can run
1565*3117ece4Schristos              * iters loops before running out of input.
1566*3117ece4Schristos              */
1567*3117ece4Schristos             size_t iters = (size_t)(ip[0] - ilowest) / 7;
1568*3117ece4Schristos             /* Each iteration can produce up to 10 bytes of output per stream.
1569*3117ece4Schristos              * Each output stream my advance at different rates. So take the
1570*3117ece4Schristos              * minimum number of safe iterations among all the output streams.
1571*3117ece4Schristos              */
1572*3117ece4Schristos             for (stream = 0; stream < 4; ++stream) {
1573*3117ece4Schristos                 size_t const oiters = (size_t)(oend[stream] - op[stream]) / 10;
1574*3117ece4Schristos                 iters = MIN(iters, oiters);
1575*3117ece4Schristos             }
1576*3117ece4Schristos 
1577*3117ece4Schristos             /* Each iteration produces at least 5 output symbols. So until
1578*3117ece4Schristos              * op[3] crosses olimit, we know we haven't executed iters
1579*3117ece4Schristos              * iterations yet. This saves us maintaining an iters counter,
1580*3117ece4Schristos              * at the expense of computing the remaining # of iterations
1581*3117ece4Schristos              * more frequently.
1582*3117ece4Schristos              */
1583*3117ece4Schristos             olimit = op[3] + (iters * 5);
1584*3117ece4Schristos 
1585*3117ece4Schristos             /* Exit the fast decoding loop once we reach the end. */
1586*3117ece4Schristos             if (op[3] == olimit)
1587*3117ece4Schristos                 break;
1588*3117ece4Schristos 
1589*3117ece4Schristos             /* Exit the decoding loop if any input pointer has crossed the
1590*3117ece4Schristos              * previous one. This indicates corruption, and a precondition
1591*3117ece4Schristos              * to our loop is that ip[i] >= ip[0].
1592*3117ece4Schristos              */
1593*3117ece4Schristos             for (stream = 1; stream < 4; ++stream) {
1594*3117ece4Schristos                 if (ip[stream] < ip[stream - 1])
1595*3117ece4Schristos                     goto _out;
1596*3117ece4Schristos             }
1597*3117ece4Schristos         }
1598*3117ece4Schristos 
1599*3117ece4Schristos #ifndef NDEBUG
1600*3117ece4Schristos         for (stream = 1; stream < 4; ++stream) {
1601*3117ece4Schristos             assert(ip[stream] >= ip[stream - 1]);
1602*3117ece4Schristos         }
1603*3117ece4Schristos #endif
1604*3117ece4Schristos 
1605*3117ece4Schristos #define HUF_4X2_DECODE_SYMBOL(_stream, _decode3)                      \
1606*3117ece4Schristos     do {                                                              \
1607*3117ece4Schristos         if ((_decode3) || (_stream) != 3) {                           \
1608*3117ece4Schristos             int const index = (int)(bits[(_stream)] >> 53);           \
1609*3117ece4Schristos             HUF_DEltX2 const entry = dtable[index];                   \
1610*3117ece4Schristos             MEM_write16(op[(_stream)], entry.sequence); \
1611*3117ece4Schristos             bits[(_stream)] <<= (entry.nbBits) & 0x3F;                \
1612*3117ece4Schristos             op[(_stream)] += (entry.length);                          \
1613*3117ece4Schristos         }                                                             \
1614*3117ece4Schristos     } while (0)
1615*3117ece4Schristos 
1616*3117ece4Schristos #define HUF_4X2_RELOAD_STREAM(_stream)                                  \
1617*3117ece4Schristos     do {                                                                \
1618*3117ece4Schristos         HUF_4X2_DECODE_SYMBOL(3, 1);                                    \
1619*3117ece4Schristos         {                                                               \
1620*3117ece4Schristos             int const ctz = ZSTD_countTrailingZeros64(bits[(_stream)]); \
1621*3117ece4Schristos             int const nbBits = ctz & 7;                                 \
1622*3117ece4Schristos             int const nbBytes = ctz >> 3;                               \
1623*3117ece4Schristos             ip[(_stream)] -= nbBytes;                                   \
1624*3117ece4Schristos             bits[(_stream)] = MEM_read64(ip[(_stream)]) | 1;            \
1625*3117ece4Schristos             bits[(_stream)] <<= nbBits;                                 \
1626*3117ece4Schristos         }                                                               \
1627*3117ece4Schristos     } while (0)
1628*3117ece4Schristos 
1629*3117ece4Schristos         /* Manually unroll the loop because compilers don't consistently
1630*3117ece4Schristos          * unroll the inner loops, which destroys performance.
1631*3117ece4Schristos          */
1632*3117ece4Schristos         do {
1633*3117ece4Schristos             /* Decode 5 symbols from each of the first 3 streams.
1634*3117ece4Schristos              * The final stream will be decoded during the reload phase
1635*3117ece4Schristos              * to reduce register pressure.
1636*3117ece4Schristos              */
1637*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X2_DECODE_SYMBOL, 0);
1638*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X2_DECODE_SYMBOL, 0);
1639*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X2_DECODE_SYMBOL, 0);
1640*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X2_DECODE_SYMBOL, 0);
1641*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM_WITH_VAR(HUF_4X2_DECODE_SYMBOL, 0);
1642*3117ece4Schristos 
1643*3117ece4Schristos             /* Decode one symbol from the final stream */
1644*3117ece4Schristos             HUF_4X2_DECODE_SYMBOL(3, 1);
1645*3117ece4Schristos 
1646*3117ece4Schristos             /* Decode 4 symbols from the final stream & reload bitstreams.
1647*3117ece4Schristos              * The final stream is reloaded last, meaning that all 5 symbols
1648*3117ece4Schristos              * are decoded from the final stream before it is reloaded.
1649*3117ece4Schristos              */
1650*3117ece4Schristos             HUF_4X_FOR_EACH_STREAM(HUF_4X2_RELOAD_STREAM);
1651*3117ece4Schristos         } while (op[3] < olimit);
1652*3117ece4Schristos     }
1653*3117ece4Schristos 
1654*3117ece4Schristos #undef HUF_4X2_DECODE_SYMBOL
1655*3117ece4Schristos #undef HUF_4X2_RELOAD_STREAM
1656*3117ece4Schristos 
1657*3117ece4Schristos _out:
1658*3117ece4Schristos 
1659*3117ece4Schristos     /* Save the final values of each of the state variables back to args. */
1660*3117ece4Schristos     ZSTD_memcpy(&args->bits, &bits, sizeof(bits));
1661*3117ece4Schristos     ZSTD_memcpy((void*)(&args->ip), &ip, sizeof(ip));
1662*3117ece4Schristos     ZSTD_memcpy(&args->op, &op, sizeof(op));
1663*3117ece4Schristos }
1664*3117ece4Schristos 
1665*3117ece4Schristos 
1666*3117ece4Schristos static HUF_FAST_BMI2_ATTRS size_t
1667*3117ece4Schristos HUF_decompress4X2_usingDTable_internal_fast(
1668*3117ece4Schristos           void* dst,  size_t dstSize,
1669*3117ece4Schristos     const void* cSrc, size_t cSrcSize,
1670*3117ece4Schristos     const HUF_DTable* DTable,
1671*3117ece4Schristos     HUF_DecompressFastLoopFn loopFn) {
1672*3117ece4Schristos     void const* dt = DTable + 1;
1673*3117ece4Schristos     const BYTE* const ilowest = (const BYTE*)cSrc;
1674*3117ece4Schristos     BYTE* const oend = ZSTD_maybeNullPtrAdd((BYTE*)dst, dstSize);
1675*3117ece4Schristos     HUF_DecompressFastArgs args;
1676*3117ece4Schristos     {
1677*3117ece4Schristos         size_t const ret = HUF_DecompressFastArgs_init(&args, dst, dstSize, cSrc, cSrcSize, DTable);
1678*3117ece4Schristos         FORWARD_IF_ERROR(ret, "Failed to init asm args");
1679*3117ece4Schristos         if (ret == 0)
1680*3117ece4Schristos             return 0;
1681*3117ece4Schristos     }
1682*3117ece4Schristos 
1683*3117ece4Schristos     assert(args.ip[0] >= args.ilowest);
1684*3117ece4Schristos     loopFn(&args);
1685*3117ece4Schristos 
1686*3117ece4Schristos     /* note : op4 already verified within main loop */
1687*3117ece4Schristos     assert(args.ip[0] >= ilowest);
1688*3117ece4Schristos     assert(args.ip[1] >= ilowest);
1689*3117ece4Schristos     assert(args.ip[2] >= ilowest);
1690*3117ece4Schristos     assert(args.ip[3] >= ilowest);
1691*3117ece4Schristos     assert(args.op[3] <= oend);
1692*3117ece4Schristos 
1693*3117ece4Schristos     assert(ilowest == args.ilowest);
1694*3117ece4Schristos     assert(ilowest + 6 == args.iend[0]);
1695*3117ece4Schristos     (void)ilowest;
1696*3117ece4Schristos 
1697*3117ece4Schristos     /* finish bitStreams one by one */
1698*3117ece4Schristos     {
1699*3117ece4Schristos         size_t const segmentSize = (dstSize+3) / 4;
1700*3117ece4Schristos         BYTE* segmentEnd = (BYTE*)dst;
1701*3117ece4Schristos         int i;
1702*3117ece4Schristos         for (i = 0; i < 4; ++i) {
1703*3117ece4Schristos             BIT_DStream_t bit;
1704*3117ece4Schristos             if (segmentSize <= (size_t)(oend - segmentEnd))
1705*3117ece4Schristos                 segmentEnd += segmentSize;
1706*3117ece4Schristos             else
1707*3117ece4Schristos                 segmentEnd = oend;
1708*3117ece4Schristos             FORWARD_IF_ERROR(HUF_initRemainingDStream(&bit, &args, i, segmentEnd), "corruption");
1709*3117ece4Schristos             args.op[i] += HUF_decodeStreamX2(args.op[i], &bit, segmentEnd, (HUF_DEltX2 const*)dt, HUF_DECODER_FAST_TABLELOG);
1710*3117ece4Schristos             if (args.op[i] != segmentEnd)
1711*3117ece4Schristos                 return ERROR(corruption_detected);
1712*3117ece4Schristos         }
1713*3117ece4Schristos     }
1714*3117ece4Schristos 
1715*3117ece4Schristos     /* decoded size */
1716*3117ece4Schristos     return dstSize;
1717*3117ece4Schristos }
1718*3117ece4Schristos 
1719*3117ece4Schristos static size_t HUF_decompress4X2_usingDTable_internal(void* dst, size_t dstSize, void const* cSrc,
1720*3117ece4Schristos                     size_t cSrcSize, HUF_DTable const* DTable, int flags)
1721*3117ece4Schristos {
1722*3117ece4Schristos     HUF_DecompressUsingDTableFn fallbackFn = HUF_decompress4X2_usingDTable_internal_default;
1723*3117ece4Schristos     HUF_DecompressFastLoopFn loopFn = HUF_decompress4X2_usingDTable_internal_fast_c_loop;
1724*3117ece4Schristos 
1725*3117ece4Schristos #if DYNAMIC_BMI2
1726*3117ece4Schristos     if (flags & HUF_flags_bmi2) {
1727*3117ece4Schristos         fallbackFn = HUF_decompress4X2_usingDTable_internal_bmi2;
1728*3117ece4Schristos # if ZSTD_ENABLE_ASM_X86_64_BMI2
1729*3117ece4Schristos         if (!(flags & HUF_flags_disableAsm)) {
1730*3117ece4Schristos             loopFn = HUF_decompress4X2_usingDTable_internal_fast_asm_loop;
1731*3117ece4Schristos         }
1732*3117ece4Schristos # endif
1733*3117ece4Schristos     } else {
1734*3117ece4Schristos         return fallbackFn(dst, dstSize, cSrc, cSrcSize, DTable);
1735*3117ece4Schristos     }
1736*3117ece4Schristos #endif
1737*3117ece4Schristos 
1738*3117ece4Schristos #if ZSTD_ENABLE_ASM_X86_64_BMI2 && defined(__BMI2__)
1739*3117ece4Schristos     if (!(flags & HUF_flags_disableAsm)) {
1740*3117ece4Schristos         loopFn = HUF_decompress4X2_usingDTable_internal_fast_asm_loop;
1741*3117ece4Schristos     }
1742*3117ece4Schristos #endif
1743*3117ece4Schristos 
1744*3117ece4Schristos     if (HUF_ENABLE_FAST_DECODE && !(flags & HUF_flags_disableFast)) {
1745*3117ece4Schristos         size_t const ret = HUF_decompress4X2_usingDTable_internal_fast(dst, dstSize, cSrc, cSrcSize, DTable, loopFn);
1746*3117ece4Schristos         if (ret != 0)
1747*3117ece4Schristos             return ret;
1748*3117ece4Schristos     }
1749*3117ece4Schristos     return fallbackFn(dst, dstSize, cSrc, cSrcSize, DTable);
1750*3117ece4Schristos }
1751*3117ece4Schristos 
1752*3117ece4Schristos HUF_DGEN(HUF_decompress1X2_usingDTable_internal)
1753*3117ece4Schristos 
1754*3117ece4Schristos size_t HUF_decompress1X2_DCtx_wksp(HUF_DTable* DCtx, void* dst, size_t dstSize,
1755*3117ece4Schristos                                    const void* cSrc, size_t cSrcSize,
1756*3117ece4Schristos                                    void* workSpace, size_t wkspSize, int flags)
1757*3117ece4Schristos {
1758*3117ece4Schristos     const BYTE* ip = (const BYTE*) cSrc;
1759*3117ece4Schristos 
1760*3117ece4Schristos     size_t const hSize = HUF_readDTableX2_wksp(DCtx, cSrc, cSrcSize,
1761*3117ece4Schristos                                                workSpace, wkspSize, flags);
1762*3117ece4Schristos     if (HUF_isError(hSize)) return hSize;
1763*3117ece4Schristos     if (hSize >= cSrcSize) return ERROR(srcSize_wrong);
1764*3117ece4Schristos     ip += hSize; cSrcSize -= hSize;
1765*3117ece4Schristos 
1766*3117ece4Schristos     return HUF_decompress1X2_usingDTable_internal(dst, dstSize, ip, cSrcSize, DCtx, flags);
1767*3117ece4Schristos }
1768*3117ece4Schristos 
1769*3117ece4Schristos static size_t HUF_decompress4X2_DCtx_wksp(HUF_DTable* dctx, void* dst, size_t dstSize,
1770*3117ece4Schristos                                    const void* cSrc, size_t cSrcSize,
1771*3117ece4Schristos                                    void* workSpace, size_t wkspSize, int flags)
1772*3117ece4Schristos {
1773*3117ece4Schristos     const BYTE* ip = (const BYTE*) cSrc;
1774*3117ece4Schristos 
1775*3117ece4Schristos     size_t hSize = HUF_readDTableX2_wksp(dctx, cSrc, cSrcSize,
1776*3117ece4Schristos                                          workSpace, wkspSize, flags);
1777*3117ece4Schristos     if (HUF_isError(hSize)) return hSize;
1778*3117ece4Schristos     if (hSize >= cSrcSize) return ERROR(srcSize_wrong);
1779*3117ece4Schristos     ip += hSize; cSrcSize -= hSize;
1780*3117ece4Schristos 
1781*3117ece4Schristos     return HUF_decompress4X2_usingDTable_internal(dst, dstSize, ip, cSrcSize, dctx, flags);
1782*3117ece4Schristos }
1783*3117ece4Schristos 
1784*3117ece4Schristos #endif /* HUF_FORCE_DECOMPRESS_X1 */
1785*3117ece4Schristos 
1786*3117ece4Schristos 
1787*3117ece4Schristos /* ***********************************/
1788*3117ece4Schristos /* Universal decompression selectors */
1789*3117ece4Schristos /* ***********************************/
1790*3117ece4Schristos 
1791*3117ece4Schristos 
1792*3117ece4Schristos #if !defined(HUF_FORCE_DECOMPRESS_X1) && !defined(HUF_FORCE_DECOMPRESS_X2)
1793*3117ece4Schristos typedef struct { U32 tableTime; U32 decode256Time; } algo_time_t;
1794*3117ece4Schristos static const algo_time_t algoTime[16 /* Quantization */][2 /* single, double */] =
1795*3117ece4Schristos {
1796*3117ece4Schristos     /* single, double, quad */
1797*3117ece4Schristos     {{0,0}, {1,1}},  /* Q==0 : impossible */
1798*3117ece4Schristos     {{0,0}, {1,1}},  /* Q==1 : impossible */
1799*3117ece4Schristos     {{ 150,216}, { 381,119}},   /* Q == 2 : 12-18% */
1800*3117ece4Schristos     {{ 170,205}, { 514,112}},   /* Q == 3 : 18-25% */
1801*3117ece4Schristos     {{ 177,199}, { 539,110}},   /* Q == 4 : 25-32% */
1802*3117ece4Schristos     {{ 197,194}, { 644,107}},   /* Q == 5 : 32-38% */
1803*3117ece4Schristos     {{ 221,192}, { 735,107}},   /* Q == 6 : 38-44% */
1804*3117ece4Schristos     {{ 256,189}, { 881,106}},   /* Q == 7 : 44-50% */
1805*3117ece4Schristos     {{ 359,188}, {1167,109}},   /* Q == 8 : 50-56% */
1806*3117ece4Schristos     {{ 582,187}, {1570,114}},   /* Q == 9 : 56-62% */
1807*3117ece4Schristos     {{ 688,187}, {1712,122}},   /* Q ==10 : 62-69% */
1808*3117ece4Schristos     {{ 825,186}, {1965,136}},   /* Q ==11 : 69-75% */
1809*3117ece4Schristos     {{ 976,185}, {2131,150}},   /* Q ==12 : 75-81% */
1810*3117ece4Schristos     {{1180,186}, {2070,175}},   /* Q ==13 : 81-87% */
1811*3117ece4Schristos     {{1377,185}, {1731,202}},   /* Q ==14 : 87-93% */
1812*3117ece4Schristos     {{1412,185}, {1695,202}},   /* Q ==15 : 93-99% */
1813*3117ece4Schristos };
1814*3117ece4Schristos #endif
1815*3117ece4Schristos 
1816*3117ece4Schristos /** HUF_selectDecoder() :
1817*3117ece4Schristos  *  Tells which decoder is likely to decode faster,
1818*3117ece4Schristos  *  based on a set of pre-computed metrics.
1819*3117ece4Schristos  * @return : 0==HUF_decompress4X1, 1==HUF_decompress4X2 .
1820*3117ece4Schristos  *  Assumption : 0 < dstSize <= 128 KB */
1821*3117ece4Schristos U32 HUF_selectDecoder (size_t dstSize, size_t cSrcSize)
1822*3117ece4Schristos {
1823*3117ece4Schristos     assert(dstSize > 0);
1824*3117ece4Schristos     assert(dstSize <= 128*1024);
1825*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1)
1826*3117ece4Schristos     (void)dstSize;
1827*3117ece4Schristos     (void)cSrcSize;
1828*3117ece4Schristos     return 0;
1829*3117ece4Schristos #elif defined(HUF_FORCE_DECOMPRESS_X2)
1830*3117ece4Schristos     (void)dstSize;
1831*3117ece4Schristos     (void)cSrcSize;
1832*3117ece4Schristos     return 1;
1833*3117ece4Schristos #else
1834*3117ece4Schristos     /* decoder timing evaluation */
1835*3117ece4Schristos     {   U32 const Q = (cSrcSize >= dstSize) ? 15 : (U32)(cSrcSize * 16 / dstSize);   /* Q < 16 */
1836*3117ece4Schristos         U32 const D256 = (U32)(dstSize >> 8);
1837*3117ece4Schristos         U32 const DTime0 = algoTime[Q][0].tableTime + (algoTime[Q][0].decode256Time * D256);
1838*3117ece4Schristos         U32 DTime1 = algoTime[Q][1].tableTime + (algoTime[Q][1].decode256Time * D256);
1839*3117ece4Schristos         DTime1 += DTime1 >> 5;  /* small advantage to algorithm using less memory, to reduce cache eviction */
1840*3117ece4Schristos         return DTime1 < DTime0;
1841*3117ece4Schristos     }
1842*3117ece4Schristos #endif
1843*3117ece4Schristos }
1844*3117ece4Schristos 
1845*3117ece4Schristos size_t HUF_decompress1X_DCtx_wksp(HUF_DTable* dctx, void* dst, size_t dstSize,
1846*3117ece4Schristos                                   const void* cSrc, size_t cSrcSize,
1847*3117ece4Schristos                                   void* workSpace, size_t wkspSize, int flags)
1848*3117ece4Schristos {
1849*3117ece4Schristos     /* validation checks */
1850*3117ece4Schristos     if (dstSize == 0) return ERROR(dstSize_tooSmall);
1851*3117ece4Schristos     if (cSrcSize > dstSize) return ERROR(corruption_detected);   /* invalid */
1852*3117ece4Schristos     if (cSrcSize == dstSize) { ZSTD_memcpy(dst, cSrc, dstSize); return dstSize; }   /* not compressed */
1853*3117ece4Schristos     if (cSrcSize == 1) { ZSTD_memset(dst, *(const BYTE*)cSrc, dstSize); return dstSize; }   /* RLE */
1854*3117ece4Schristos 
1855*3117ece4Schristos     {   U32 const algoNb = HUF_selectDecoder(dstSize, cSrcSize);
1856*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1)
1857*3117ece4Schristos         (void)algoNb;
1858*3117ece4Schristos         assert(algoNb == 0);
1859*3117ece4Schristos         return HUF_decompress1X1_DCtx_wksp(dctx, dst, dstSize, cSrc,
1860*3117ece4Schristos                                 cSrcSize, workSpace, wkspSize, flags);
1861*3117ece4Schristos #elif defined(HUF_FORCE_DECOMPRESS_X2)
1862*3117ece4Schristos         (void)algoNb;
1863*3117ece4Schristos         assert(algoNb == 1);
1864*3117ece4Schristos         return HUF_decompress1X2_DCtx_wksp(dctx, dst, dstSize, cSrc,
1865*3117ece4Schristos                                 cSrcSize, workSpace, wkspSize, flags);
1866*3117ece4Schristos #else
1867*3117ece4Schristos         return algoNb ? HUF_decompress1X2_DCtx_wksp(dctx, dst, dstSize, cSrc,
1868*3117ece4Schristos                                 cSrcSize, workSpace, wkspSize, flags):
1869*3117ece4Schristos                         HUF_decompress1X1_DCtx_wksp(dctx, dst, dstSize, cSrc,
1870*3117ece4Schristos                                 cSrcSize, workSpace, wkspSize, flags);
1871*3117ece4Schristos #endif
1872*3117ece4Schristos     }
1873*3117ece4Schristos }
1874*3117ece4Schristos 
1875*3117ece4Schristos 
1876*3117ece4Schristos size_t HUF_decompress1X_usingDTable(void* dst, size_t maxDstSize, const void* cSrc, size_t cSrcSize, const HUF_DTable* DTable, int flags)
1877*3117ece4Schristos {
1878*3117ece4Schristos     DTableDesc const dtd = HUF_getDTableDesc(DTable);
1879*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1)
1880*3117ece4Schristos     (void)dtd;
1881*3117ece4Schristos     assert(dtd.tableType == 0);
1882*3117ece4Schristos     return HUF_decompress1X1_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1883*3117ece4Schristos #elif defined(HUF_FORCE_DECOMPRESS_X2)
1884*3117ece4Schristos     (void)dtd;
1885*3117ece4Schristos     assert(dtd.tableType == 1);
1886*3117ece4Schristos     return HUF_decompress1X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1887*3117ece4Schristos #else
1888*3117ece4Schristos     return dtd.tableType ? HUF_decompress1X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags) :
1889*3117ece4Schristos                            HUF_decompress1X1_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1890*3117ece4Schristos #endif
1891*3117ece4Schristos }
1892*3117ece4Schristos 
1893*3117ece4Schristos #ifndef HUF_FORCE_DECOMPRESS_X2
1894*3117ece4Schristos size_t HUF_decompress1X1_DCtx_wksp(HUF_DTable* dctx, void* dst, size_t dstSize, const void* cSrc, size_t cSrcSize, void* workSpace, size_t wkspSize, int flags)
1895*3117ece4Schristos {
1896*3117ece4Schristos     const BYTE* ip = (const BYTE*) cSrc;
1897*3117ece4Schristos 
1898*3117ece4Schristos     size_t const hSize = HUF_readDTableX1_wksp(dctx, cSrc, cSrcSize, workSpace, wkspSize, flags);
1899*3117ece4Schristos     if (HUF_isError(hSize)) return hSize;
1900*3117ece4Schristos     if (hSize >= cSrcSize) return ERROR(srcSize_wrong);
1901*3117ece4Schristos     ip += hSize; cSrcSize -= hSize;
1902*3117ece4Schristos 
1903*3117ece4Schristos     return HUF_decompress1X1_usingDTable_internal(dst, dstSize, ip, cSrcSize, dctx, flags);
1904*3117ece4Schristos }
1905*3117ece4Schristos #endif
1906*3117ece4Schristos 
1907*3117ece4Schristos size_t HUF_decompress4X_usingDTable(void* dst, size_t maxDstSize, const void* cSrc, size_t cSrcSize, const HUF_DTable* DTable, int flags)
1908*3117ece4Schristos {
1909*3117ece4Schristos     DTableDesc const dtd = HUF_getDTableDesc(DTable);
1910*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1)
1911*3117ece4Schristos     (void)dtd;
1912*3117ece4Schristos     assert(dtd.tableType == 0);
1913*3117ece4Schristos     return HUF_decompress4X1_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1914*3117ece4Schristos #elif defined(HUF_FORCE_DECOMPRESS_X2)
1915*3117ece4Schristos     (void)dtd;
1916*3117ece4Schristos     assert(dtd.tableType == 1);
1917*3117ece4Schristos     return HUF_decompress4X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1918*3117ece4Schristos #else
1919*3117ece4Schristos     return dtd.tableType ? HUF_decompress4X2_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags) :
1920*3117ece4Schristos                            HUF_decompress4X1_usingDTable_internal(dst, maxDstSize, cSrc, cSrcSize, DTable, flags);
1921*3117ece4Schristos #endif
1922*3117ece4Schristos }
1923*3117ece4Schristos 
1924*3117ece4Schristos size_t HUF_decompress4X_hufOnly_wksp(HUF_DTable* dctx, void* dst, size_t dstSize, const void* cSrc, size_t cSrcSize, void* workSpace, size_t wkspSize, int flags)
1925*3117ece4Schristos {
1926*3117ece4Schristos     /* validation checks */
1927*3117ece4Schristos     if (dstSize == 0) return ERROR(dstSize_tooSmall);
1928*3117ece4Schristos     if (cSrcSize == 0) return ERROR(corruption_detected);
1929*3117ece4Schristos 
1930*3117ece4Schristos     {   U32 const algoNb = HUF_selectDecoder(dstSize, cSrcSize);
1931*3117ece4Schristos #if defined(HUF_FORCE_DECOMPRESS_X1)
1932*3117ece4Schristos         (void)algoNb;
1933*3117ece4Schristos         assert(algoNb == 0);
1934*3117ece4Schristos         return HUF_decompress4X1_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workSpace, wkspSize, flags);
1935*3117ece4Schristos #elif defined(HUF_FORCE_DECOMPRESS_X2)
1936*3117ece4Schristos         (void)algoNb;
1937*3117ece4Schristos         assert(algoNb == 1);
1938*3117ece4Schristos         return HUF_decompress4X2_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workSpace, wkspSize, flags);
1939*3117ece4Schristos #else
1940*3117ece4Schristos         return algoNb ? HUF_decompress4X2_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workSpace, wkspSize, flags) :
1941*3117ece4Schristos                         HUF_decompress4X1_DCtx_wksp(dctx, dst, dstSize, cSrc, cSrcSize, workSpace, wkspSize, flags);
1942*3117ece4Schristos #endif
1943*3117ece4Schristos     }
1944*3117ece4Schristos }
1945