Coverage Report

Created: 2026-08-14 06:54

next uncovered line (L), next uncovered region (R), next uncovered branch (B)
/src/opencv/3rdparty/openjpeg/openjp2/ht_dec.c
Line
Count
Source
1
//***************************************************************************/
2
// This software is released under the 2-Clause BSD license, included
3
// below.
4
//
5
// Copyright (c) 2021, Aous Naman
6
// Copyright (c) 2021, Kakadu Software Pty Ltd, Australia
7
// Copyright (c) 2021, The University of New South Wales, Australia
8
//
9
// Redistribution and use in source and binary forms, with or without
10
// modification, are permitted provided that the following conditions are
11
// met:
12
//
13
// 1. Redistributions of source code must retain the above copyright
14
// notice, this list of conditions and the following disclaimer.
15
//
16
// 2. Redistributions in binary form must reproduce the above copyright
17
// notice, this list of conditions and the following disclaimer in the
18
// documentation and/or other materials provided with the distribution.
19
//
20
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
21
// IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22
// TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
23
// PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
24
// HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
25
// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
26
// TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
27
// PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
28
// LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
29
// NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30
// SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31
//***************************************************************************/
32
// This file is part of the OpenJpeg software implementation.
33
// File: ht_dec.c
34
// Author: Aous Naman
35
// Date: 01 September 2021
36
//***************************************************************************/
37
38
//***************************************************************************/
39
/** @file ht_dec.c
40
 *  @brief implements HTJ2K block decoder
41
 */
42
43
#include <assert.h>
44
#include <string.h>
45
#include "opj_includes.h"
46
47
#include "t1_ht_luts.h"
48
49
/////////////////////////////////////////////////////////////////////////////
50
// compiler detection
51
/////////////////////////////////////////////////////////////////////////////
52
#ifdef _MSC_VER
53
#define OPJ_COMPILER_MSVC
54
#elif (defined __GNUC__)
55
#define OPJ_COMPILER_GNUC
56
#endif
57
58
#if defined(OPJ_COMPILER_MSVC) && defined(_M_ARM64) \
59
    && !defined(_M_ARM64EC) && !defined(_M_CEE_PURE) && !defined(__CUDACC__) \
60
    && !defined(__INTEL_COMPILER) && !defined(__clang__)
61
#define MSVC_NEON_INTRINSICS
62
#endif
63
64
#ifdef MSVC_NEON_INTRINSICS
65
#include <arm64_neon.h>
66
#endif
67
68
//************************************************************************/
69
/** @brief Displays the error message for disabling the decoding of SPP and
70
  * MRP passes
71
  */
72
static OPJ_BOOL only_cleanup_pass_is_decoded = OPJ_FALSE;
73
74
//************************************************************************/
75
/** @brief Generates population count (i.e., the number of set bits)
76
  *
77
  *   @param [in]  val is the value for which population count is sought
78
  */
79
static INLINE
80
OPJ_UINT32 population_count(OPJ_UINT32 val)
81
9.45k
{
82
#if defined(OPJ_COMPILER_MSVC) && (defined(_M_IX86) || defined(_M_AMD64))
83
    return (OPJ_UINT32)__popcnt(val);
84
#elif defined(OPJ_COMPILER_MSVC) && defined(MSVC_NEON_INTRINSICS)
85
    const __n64 temp = neon_cnt(__uint64ToN64_v(val));
86
    return neon_addv8(temp).n8_i8[0];
87
#elif (defined OPJ_COMPILER_GNUC)
88
    return (OPJ_UINT32)__builtin_popcount(val);
89
#else
90
    val -= ((val >> 1) & 0x55555555);
91
    val = (((val >> 2) & 0x33333333) + (val & 0x33333333));
92
    val = (((val >> 4) + val) & 0x0f0f0f0f);
93
    val += (val >> 8);
94
    val += (val >> 16);
95
    return (OPJ_UINT32)(val & 0x0000003f);
96
#endif
97
9.45k
}
98
99
//************************************************************************/
100
/** @brief Counts the number of leading zeros
101
  *
102
  *   @param [in]  val is the value for which leading zero count is sought
103
  */
104
#ifdef OPJ_COMPILER_MSVC
105
#pragma intrinsic(_BitScanReverse)
106
#endif
107
static INLINE
108
OPJ_UINT32 count_leading_zeros(OPJ_UINT32 val)
109
7.87k
{
110
#ifdef OPJ_COMPILER_MSVC
111
    unsigned long result = 0;
112
    _BitScanReverse(&result, val);
113
    return 31U ^ (OPJ_UINT32)result;
114
#elif (defined OPJ_COMPILER_GNUC)
115
    return (OPJ_UINT32)__builtin_clz(val);
116
#else
117
    val |= (val >> 1);
118
    val |= (val >> 2);
119
    val |= (val >> 4);
120
    val |= (val >> 8);
121
    val |= (val >> 16);
122
    return 32U - population_count(val);
123
#endif
124
7.87k
}
125
126
//************************************************************************/
127
/** @brief Read a little-endian serialized UINT32.
128
  *
129
  *   @param [in]  dataIn pointer to byte stream to read from
130
  */
131
static INLINE OPJ_UINT32 read_le_uint32(const void* dataIn)
132
2.41k
{
133
#if defined(OPJ_BIG_ENDIAN)
134
    const OPJ_UINT8* data = (const OPJ_UINT8*)dataIn;
135
    return ((OPJ_UINT32)data[0]) | (OPJ_UINT32)(data[1] << 8) | (OPJ_UINT32)(
136
               data[2] << 16) | (((
137
                                      OPJ_UINT32)data[3]) <<
138
                                 24U);
139
#else
140
2.41k
    return *(OPJ_UINT32*)dataIn;
141
2.41k
#endif
142
2.41k
}
143
144
//************************************************************************/
145
/** @brief MEL state structure for reading and decoding the MEL bitstream
146
  *
147
  *  A number of events is decoded from the MEL bitstream ahead of time
148
  *  and stored in run/num_runs.
149
  *  Each run represents the number of zero events before a one event.
150
  */
151
typedef struct dec_mel {
152
    // data decoding machinery
153
    OPJ_UINT8* data;  //!<the address of data (or bitstream)
154
    OPJ_UINT64 tmp;   //!<temporary buffer for read data
155
    int bits;         //!<number of bits stored in tmp
156
    int size;         //!<number of bytes in MEL code
157
    OPJ_BOOL unstuff; //!<true if the next bit needs to be unstuffed
158
    int k;            //!<state of MEL decoder
159
160
    // queue of decoded runs
161
    int num_runs;    //!<number of decoded runs left in runs (maximum 8)
162
    OPJ_UINT64 runs; //!<runs of decoded MEL codewords (7 bits/run)
163
} dec_mel_t;
164
165
//************************************************************************/
166
/** @brief Reads and unstuffs the MEL bitstream
167
  *
168
  *  This design needs more bytes in the codeblock buffer than the length
169
  *  of the cleanup pass by up to 2 bytes.
170
  *
171
  *  Unstuffing removes the MSB of the byte following a byte whose
172
  *  value is 0xFF; this prevents sequences larger than 0xFF7F in value
173
  *  from appearing the bitstream.
174
  *
175
  *  @param [in]  melp is a pointer to dec_mel_t structure
176
  */
177
static INLINE
178
void mel_read(dec_mel_t *melp)
179
817
{
180
817
    OPJ_UINT32 val;
181
817
    int bits;
182
817
    OPJ_UINT32 t;
183
817
    OPJ_BOOL unstuff;
184
185
817
    if (melp->bits > 32) { //there are enough bits in the tmp variable
186
0
        return;    // return without reading new data
187
0
    }
188
189
817
    val = 0xFFFFFFFF;      // feed in 0xFF if buffer is exhausted
190
817
    if (melp->size > 4) {  // if there is more than 4 bytes the MEL segment
191
46
        val = read_le_uint32(melp->data);  // read 32 bits from MEL data
192
46
        melp->data += 4;           // advance pointer
193
46
        melp->size -= 4;           // reduce counter
194
771
    } else if (melp->size > 0) { // 4 or less
195
18
        OPJ_UINT32 m, v;
196
18
        int i = 0;
197
35
        while (melp->size > 1) {
198
17
            OPJ_UINT32 v = *melp->data++; // read one byte at a time
199
17
            OPJ_UINT32 m = ~(0xFFu << i); // mask of location
200
17
            val = (val & m) | (v << i);   // put byte in its correct location
201
17
            --melp->size;
202
17
            i += 8;
203
17
        }
204
        // size equal to 1
205
18
        v = *melp->data++;  // the one before the last is different
206
18
        v |= 0xF;                         // MEL and VLC segments can overlap
207
18
        m = ~(0xFFu << i);
208
18
        val = (val & m) | (v << i);
209
18
        --melp->size;
210
18
    }
211
212
    // next we unstuff them before adding them to the buffer
213
817
    bits = 32 - melp->unstuff;      // number of bits in val, subtract 1 if
214
    // the previously read byte requires
215
    // unstuffing
216
217
    // data is unstuffed and accumulated in t
218
    // bits has the number of bits in t
219
817
    t = val & 0xFF;
220
817
    unstuff = ((val & 0xFF) == 0xFF); // true if the byte needs unstuffing
221
817
    bits -= unstuff; // there is one less bit in t if unstuffing is needed
222
817
    t = t << (8 - unstuff); // move up to make room for the next byte
223
224
    //this is a repeat of the above
225
817
    t |= (val >> 8) & 0xFF;
226
817
    unstuff = (((val >> 8) & 0xFF) == 0xFF);
227
817
    bits -= unstuff;
228
817
    t = t << (8 - unstuff);
229
230
817
    t |= (val >> 16) & 0xFF;
231
817
    unstuff = (((val >> 16) & 0xFF) == 0xFF);
232
817
    bits -= unstuff;
233
817
    t = t << (8 - unstuff);
234
235
817
    t |= (val >> 24) & 0xFF;
236
817
    melp->unstuff = (((val >> 24) & 0xFF) == 0xFF);
237
238
    // move t to tmp, and push the result all the way up, so we read from
239
    // the MSB
240
817
    melp->tmp |= ((OPJ_UINT64)t) << (64 - bits - melp->bits);
241
817
    melp->bits += bits; //increment the number of bits in tmp
242
817
}
243
244
//************************************************************************/
245
/** @brief Decodes unstuffed MEL segment bits stored in tmp to runs
246
  *
247
  *  Runs are stored in "runs" and the number of runs in "num_runs".
248
  *  Each run represents a number of zero events that may or may not
249
  *  terminate in a 1 event.
250
  *  Each run is stored in 7 bits.  The LSB is 1 if the run terminates in
251
  *  a 1 event, 0 otherwise.  The next 6 bits, for the case terminating
252
  *  with 1, contain the number of consecutive 0 zero events * 2; for the
253
  *  case terminating with 0, they store (number of consecutive 0 zero
254
  *  events - 1) * 2.
255
  *  A total of 6 bits (made up of 1 + 5) should have been enough.
256
  *
257
  *  @param [in]  melp is a pointer to dec_mel_t structure
258
  */
259
static INLINE
260
void mel_decode(dec_mel_t *melp)
261
3.66k
{
262
3.66k
    static const int mel_exp[13] = { //MEL exponents
263
3.66k
        0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 4, 5
264
3.66k
    };
265
266
3.66k
    if (melp->bits < 6) { // if there are less than 6 bits in tmp
267
817
        mel_read(melp);    // then read from the MEL bitstream
268
817
    }
269
    // 6 bits is the largest decodable MEL cwd
270
271
    //repeat so long that there is enough decodable bits in tmp,
272
    // and the runs store is not full (num_runs < 8)
273
29.0k
    while (melp->bits >= 6 && melp->num_runs < 8) {
274
25.3k
        int eval = mel_exp[melp->k]; // number of bits associated with state
275
25.3k
        int run = 0;
276
25.3k
        if (melp->tmp & (1ull << 63)) { //The next bit to decode (stored in MSB)
277
            //one is found
278
19.7k
            run = 1 << eval;
279
19.7k
            run--; // consecutive runs of 0 events - 1
280
19.7k
            melp->k = melp->k + 1 < 12 ? melp->k + 1 : 12;//increment, max is 12
281
19.7k
            melp->tmp <<= 1; // consume one bit from tmp
282
19.7k
            melp->bits -= 1;
283
19.7k
            run = run << 1; // a stretch of zeros not terminating in one
284
19.7k
        } else {
285
            //0 is found
286
5.62k
            run = (int)(melp->tmp >> (63 - eval)) & ((1 << eval) - 1);
287
5.62k
            melp->k = melp->k - 1 > 0 ? melp->k - 1 : 0; //decrement, min is 0
288
5.62k
            melp->tmp <<= eval + 1; //consume eval + 1 bits (max is 6)
289
5.62k
            melp->bits -= eval + 1;
290
5.62k
            run = (run << 1) + 1; // a stretch of zeros terminating with one
291
5.62k
        }
292
25.3k
        eval = melp->num_runs * 7;                 // 7 bits per run
293
25.3k
        melp->runs &= ~((OPJ_UINT64)0x3F << eval); // 6 bits are sufficient
294
25.3k
        melp->runs |= ((OPJ_UINT64)run) << eval;   // store the value in runs
295
25.3k
        melp->num_runs++;                          // increment count
296
25.3k
    }
297
3.66k
}
298
299
//************************************************************************/
300
/** @brief Initiates a dec_mel_t structure for MEL decoding and reads
301
  *         some bytes in order to get the read address to a multiple
302
  *         of 4
303
  *
304
  *  @param [in]  melp is a pointer to dec_mel_t structure
305
  *  @param [in]  bbuf is a pointer to byte buffer
306
  *  @param [in]  lcup is the length of MagSgn+MEL+VLC segments
307
  *  @param [in]  scup is the length of MEL+VLC segments
308
  */
309
static INLINE
310
OPJ_BOOL mel_init(dec_mel_t *melp, OPJ_UINT8* bbuf, int lcup, int scup)
311
1.40k
{
312
1.40k
    int num;
313
1.40k
    int i;
314
315
1.40k
    melp->data = bbuf + lcup - scup; // move the pointer to the start of MEL
316
1.40k
    melp->bits = 0;                  // 0 bits in tmp
317
1.40k
    melp->tmp = 0;                   //
318
1.40k
    melp->unstuff = OPJ_FALSE;       // no unstuffing
319
1.40k
    melp->size = scup - 1;           // size is the length of MEL+VLC-1
320
1.40k
    melp->k = 0;                     // 0 for state
321
1.40k
    melp->num_runs = 0;              // num_runs is 0
322
1.40k
    melp->runs = 0;                  //
323
324
    //This code is borrowed; original is for a different architecture
325
    //These few lines take care of the case where data is not at a multiple
326
    // of 4 boundary.  It reads 1,2,3 up to 4 bytes from the MEL segment
327
1.40k
    num = 4 - (int)((intptr_t)(melp->data) & 0x3);
328
4.60k
    for (i = 0; i < num; ++i) { // this code is similar to mel_read
329
3.19k
        OPJ_UINT64 d;
330
3.19k
        int d_bits;
331
332
3.19k
        if (melp->unstuff == OPJ_TRUE && melp->data[0] > 0x8F) {
333
0
            return OPJ_FALSE;
334
0
        }
335
3.19k
        d = (melp->size > 0) ? *melp->data : 0xFF; // if buffer is consumed
336
        // set data to 0xFF
337
3.19k
        if (melp->size == 1) {
338
1.35k
            d |= 0xF;    //if this is MEL+VLC-1, set LSBs to 0xF
339
1.35k
        }
340
        // see the standard
341
3.19k
        melp->data += melp->size-- > 0; //increment if the end is not reached
342
3.19k
        d_bits = 8 - melp->unstuff; //if unstuffing is needed, reduce by 1
343
3.19k
        melp->tmp = (melp->tmp << d_bits) | d; //store bits in tmp
344
3.19k
        melp->bits += d_bits;  //increment tmp by number of bits
345
3.19k
        melp->unstuff = ((d & 0xFF) == 0xFF); //true of next byte needs
346
        //unstuffing
347
3.19k
    }
348
1.40k
    melp->tmp <<= (64 - melp->bits); //push all the way up so the first bit
349
    // is the MSB
350
1.40k
    return OPJ_TRUE;
351
1.40k
}
352
353
//************************************************************************/
354
/** @brief Retrieves one run from dec_mel_t; if there are no runs stored
355
  *         MEL segment is decoded
356
  *
357
  * @param [in]  melp is a pointer to dec_mel_t structure
358
  */
359
static INLINE
360
int mel_get_run(dec_mel_t *melp)
361
20.0k
{
362
20.0k
    int t;
363
20.0k
    if (melp->num_runs == 0) { //if no runs, decode more bit from MEL segment
364
3.66k
        mel_decode(melp);
365
3.66k
    }
366
367
20.0k
    t = melp->runs & 0x7F; //retrieve one run
368
20.0k
    melp->runs >>= 7;  // remove the retrieved run
369
20.0k
    melp->num_runs--;
370
20.0k
    return t; // return run
371
20.0k
}
372
373
//************************************************************************/
374
/** @brief A structure for reading and unstuffing a segment that grows
375
  *         backward, such as VLC and MRP
376
  */
377
typedef struct rev_struct {
378
    //storage
379
    OPJ_UINT8* data;  //!<pointer to where to read data
380
    OPJ_UINT64 tmp;     //!<temporary buffer of read data
381
    OPJ_UINT32 bits;  //!<number of bits stored in tmp
382
    int size;         //!<number of bytes left
383
    OPJ_BOOL unstuff; //!<true if the last byte is more than 0x8F
384
    //!<then the current byte is unstuffed if it is 0x7F
385
} rev_struct_t;
386
387
//************************************************************************/
388
/** @brief Read and unstuff data from a backwardly-growing segment
389
  *
390
  *  This reader can read up to 8 bytes from before the VLC segment.
391
  *  Care must be taken not read from unreadable memory, causing a
392
  *  segmentation fault.
393
  *
394
  *  Note that there is another subroutine rev_read_mrp that is slightly
395
  *  different.  The other one fills zeros when the buffer is exhausted.
396
  *  This one basically does not care if the bytes are consumed, because
397
  *  any extra data should not be used in the actual decoding.
398
  *
399
  *  Unstuffing is needed to prevent sequences more than 0xFF8F from
400
  *  appearing in the bits stream; since we are reading backward, we keep
401
  *  watch when a value larger than 0x8F appears in the bitstream.
402
  *  If the byte following this is 0x7F, we unstuff this byte (ignore the
403
  *  MSB of that byte, which should be 0).
404
  *
405
  *  @param [in]  vlcp is a pointer to rev_struct_t structure
406
  */
407
static INLINE
408
void rev_read(rev_struct_t *vlcp)
409
3.50k
{
410
3.50k
    OPJ_UINT32 val;
411
3.50k
    OPJ_UINT32 tmp;
412
3.50k
    OPJ_UINT32 bits;
413
3.50k
    OPJ_BOOL unstuff;
414
415
    //process 4 bytes at a time
416
3.50k
    if (vlcp->bits > 32) { // if there are more than 32 bits in tmp, then
417
1
        return;    // reading 32 bits can overflow vlcp->tmp
418
1
    }
419
3.50k
    val = 0;
420
    //the next line (the if statement) needs to be tested first
421
3.50k
    if (vlcp->size > 3) { // if there are more than 3 bytes left in VLC
422
        // (vlcp->data - 3) move pointer back to read 32 bits at once
423
710
        val = read_le_uint32(vlcp->data - 3); // then read 32 bits
424
710
        vlcp->data -= 4;                // move data pointer back by 4
425
710
        vlcp->size -= 4;                // reduce available byte by 4
426
2.79k
    } else if (vlcp->size > 0) { // 4 or less
427
10
        int i = 24;
428
20
        while (vlcp->size > 0) {
429
10
            OPJ_UINT32 v = *vlcp->data--; // read one byte at a time
430
10
            val |= (v << i);              // put byte in its correct location
431
10
            --vlcp->size;
432
10
            i -= 8;
433
10
        }
434
10
    }
435
436
    //accumulate in tmp, number of bits in tmp are stored in bits
437
3.50k
    tmp = val >> 24;  //start with the MSB byte
438
439
    // test unstuff (previous byte is >0x8F), and this byte is 0x7F
440
3.50k
    bits = 8u - ((vlcp->unstuff && (((val >> 24) & 0x7F) == 0x7F)) ? 1u : 0u);
441
3.50k
    unstuff = (val >> 24) > 0x8F; //this is for the next byte
442
443
3.50k
    tmp |= ((val >> 16) & 0xFF) << bits; //process the next byte
444
3.50k
    bits += 8u - ((unstuff && (((val >> 16) & 0x7F) == 0x7F)) ? 1u : 0u);
445
3.50k
    unstuff = ((val >> 16) & 0xFF) > 0x8F;
446
447
3.50k
    tmp |= ((val >> 8) & 0xFF) << bits;
448
3.50k
    bits += 8u - ((unstuff && (((val >> 8) & 0x7F) == 0x7F)) ? 1u : 0u);
449
3.50k
    unstuff = ((val >> 8) & 0xFF) > 0x8F;
450
451
3.50k
    tmp |= (val & 0xFF) << bits;
452
3.50k
    bits += 8u - ((unstuff && ((val & 0x7F) == 0x7F)) ? 1u : 0u);
453
3.50k
    unstuff = (val & 0xFF) > 0x8F;
454
455
    // now move the read and unstuffed bits into vlcp->tmp
456
3.50k
    vlcp->tmp |= (OPJ_UINT64)tmp << vlcp->bits;
457
3.50k
    vlcp->bits += bits;
458
3.50k
    vlcp->unstuff = unstuff; // this for the next read
459
3.50k
}
460
461
//************************************************************************/
462
/** @brief Initiates the rev_struct_t structure and reads a few bytes to
463
  *         move the read address to multiple of 4
464
  *
465
  *  There is another similar rev_init_mrp subroutine.  The difference is
466
  *  that this one, rev_init, discards the first 12 bits (they have the
467
  *  sum of the lengths of VLC and MEL segments), and first unstuff depends
468
  *  on first 4 bits.
469
  *
470
  *  @param [in]  vlcp is a pointer to rev_struct_t structure
471
  *  @param [in]  data is a pointer to byte at the start of the cleanup pass
472
  *  @param [in]  lcup is the length of MagSgn+MEL+VLC segments
473
  *  @param [in]  scup is the length of MEL+VLC segments
474
  */
475
static INLINE
476
void rev_init(rev_struct_t *vlcp, OPJ_UINT8* data, int lcup, int scup)
477
1.40k
{
478
1.40k
    OPJ_UINT32 d;
479
1.40k
    int num, tnum, i;
480
481
    //first byte has only the upper 4 bits
482
1.40k
    vlcp->data = data + lcup - 2;
483
484
    //size can not be larger than this, in fact it should be smaller
485
1.40k
    vlcp->size = scup - 2;
486
487
1.40k
    d = *vlcp->data--;            // read one byte (this is a half byte)
488
1.40k
    vlcp->tmp = d >> 4;           // both initialize and set
489
1.40k
    vlcp->bits = 4 - ((vlcp->tmp & 7) == 7); //check standard
490
1.40k
    vlcp->unstuff = (d | 0xF) > 0x8F; //this is useful for the next byte
491
492
    //This code is designed for an architecture that read address should
493
    // align to the read size (address multiple of 4 if read size is 4)
494
    //These few lines take care of the case where data is not at a multiple
495
    // of 4 boundary. It reads 1,2,3 up to 4 bytes from the VLC bitstream.
496
    // To read 32 bits, read from (vlcp->data - 3)
497
1.40k
    num = 1 + (int)((intptr_t)(vlcp->data) & 0x3);
498
1.40k
    tnum = num < vlcp->size ? num : vlcp->size;
499
1.56k
    for (i = 0; i < tnum; ++i) {
500
156
        OPJ_UINT64 d;
501
156
        OPJ_UINT32 d_bits;
502
156
        d = *vlcp->data--;  // read one byte and move read pointer
503
        //check if the last byte was >0x8F (unstuff == true) and this is 0x7F
504
156
        d_bits = 8u - ((vlcp->unstuff && ((d & 0x7F) == 0x7F)) ? 1u : 0u);
505
156
        vlcp->tmp |= d << vlcp->bits; // move data to vlcp->tmp
506
156
        vlcp->bits += d_bits;
507
156
        vlcp->unstuff = d > 0x8F; // for next byte
508
156
    }
509
1.40k
    vlcp->size -= tnum;
510
1.40k
    rev_read(vlcp);  // read another 32 buts
511
1.40k
}
512
513
//************************************************************************/
514
/** @brief Retrieves 32 bits from the head of a rev_struct structure
515
  *
516
  *  By the end of this call, vlcp->tmp must have no less than 33 bits
517
  *
518
  *  @param [in]  vlcp is a pointer to rev_struct structure
519
  */
520
static INLINE
521
OPJ_UINT32 rev_fetch(rev_struct_t *vlcp)
522
29.3k
{
523
29.3k
    if (vlcp->bits < 32) { // if there are less then 32 bits, read more
524
2.10k
        rev_read(vlcp);     // read 32 bits, but unstuffing might reduce this
525
2.10k
        if (vlcp->bits < 32) { // if there is still space in vlcp->tmp for 32 bits
526
0
            rev_read(vlcp);    // read another 32
527
0
        }
528
2.10k
    }
529
29.3k
    return (OPJ_UINT32)vlcp->tmp; // return the head (bottom-most) of vlcp->tmp
530
29.3k
}
531
532
//************************************************************************/
533
/** @brief Consumes num_bits from a rev_struct structure
534
  *
535
  *  @param [in]  vlcp is a pointer to rev_struct structure
536
  *  @param [in]  num_bits is the number of bits to be removed
537
  */
538
static INLINE
539
OPJ_UINT32 rev_advance(rev_struct_t *vlcp, OPJ_UINT32 num_bits)
540
78.4k
{
541
78.4k
    assert(num_bits <= vlcp->bits); // vlcp->tmp must have more than num_bits
542
78.4k
    vlcp->tmp >>= num_bits;         // remove bits
543
78.4k
    vlcp->bits -= num_bits;         // decrement the number of bits
544
78.4k
    return (OPJ_UINT32)vlcp->tmp;
545
78.4k
}
546
547
//************************************************************************/
548
/** @brief Reads and unstuffs from rev_struct
549
  *
550
  *  This is different than rev_read in that this fills in zeros when the
551
  *  the available data is consumed.  The other does not care about the
552
  *  values when all data is consumed.
553
  *
554
  *  See rev_read for more information about unstuffing
555
  *
556
  *  @param [in]  mrp is a pointer to rev_struct structure
557
  */
558
static INLINE
559
void rev_read_mrp(rev_struct_t *mrp)
560
1.12k
{
561
1.12k
    OPJ_UINT32 val;
562
1.12k
    OPJ_UINT32 tmp;
563
1.12k
    OPJ_UINT32 bits;
564
1.12k
    OPJ_BOOL unstuff;
565
566
    //process 4 bytes at a time
567
1.12k
    if (mrp->bits > 32) {
568
0
        return;
569
0
    }
570
1.12k
    val = 0;
571
1.12k
    if (mrp->size > 3) { // If there are 3 byte or more
572
        // (mrp->data - 3) move pointer back to read 32 bits at once
573
360
        val = read_le_uint32(mrp->data - 3); // read 32 bits
574
360
        mrp->data -= 4;                      // move back pointer
575
360
        mrp->size -= 4;                      // reduce count
576
760
    } else if (mrp->size > 0) {
577
534
        int i = 24;
578
2.13k
        while (mrp->size > 0) {
579
1.60k
            OPJ_UINT32 v = *mrp->data--; // read one byte at a time
580
1.60k
            val |= (v << i);             // put byte in its correct location
581
1.60k
            --mrp->size;
582
1.60k
            i -= 8;
583
1.60k
        }
584
534
    }
585
586
587
    //accumulate in tmp, and keep count in bits
588
1.12k
    tmp = val >> 24;
589
590
    //test if the last byte > 0x8F (unstuff must be true) and this is 0x7F
591
1.12k
    bits = 8u - ((mrp->unstuff && (((val >> 24) & 0x7F) == 0x7F)) ? 1u : 0u);
592
1.12k
    unstuff = (val >> 24) > 0x8F;
593
594
    //process the next byte
595
1.12k
    tmp |= ((val >> 16) & 0xFF) << bits;
596
1.12k
    bits += 8u - ((unstuff && (((val >> 16) & 0x7F) == 0x7F)) ? 1u : 0u);
597
1.12k
    unstuff = ((val >> 16) & 0xFF) > 0x8F;
598
599
1.12k
    tmp |= ((val >> 8) & 0xFF) << bits;
600
1.12k
    bits += 8u - ((unstuff && (((val >> 8) & 0x7F) == 0x7F)) ? 1u : 0u);
601
1.12k
    unstuff = ((val >> 8) & 0xFF) > 0x8F;
602
603
1.12k
    tmp |= (val & 0xFF) << bits;
604
1.12k
    bits += 8u - ((unstuff && ((val & 0x7F) == 0x7F)) ? 1u : 0u);
605
1.12k
    unstuff = (val & 0xFF) > 0x8F;
606
607
1.12k
    mrp->tmp |= (OPJ_UINT64)tmp << mrp->bits; // move data to mrp pointer
608
1.12k
    mrp->bits += bits;
609
1.12k
    mrp->unstuff = unstuff;                   // next byte
610
1.12k
}
611
612
//************************************************************************/
613
/** @brief Initialized rev_struct structure for MRP segment, and reads
614
  *         a number of bytes such that the next 32 bits read are from
615
  *         an address that is a multiple of 4. Note this is designed for
616
  *         an architecture that read size must be compatible with the
617
  *         alignment of the read address
618
  *
619
  *  There is another similar subroutine rev_init.  This subroutine does
620
  *  NOT skip the first 12 bits, and starts with unstuff set to true.
621
  *
622
  *  @param [in]  mrp is a pointer to rev_struct structure
623
  *  @param [in]  data is a pointer to byte at the start of the cleanup pass
624
  *  @param [in]  lcup is the length of MagSgn+MEL+VLC segments
625
  *  @param [in]  len2 is the length of SPP+MRP segments
626
  */
627
static INLINE
628
void rev_init_mrp(rev_struct_t *mrp, OPJ_UINT8* data, int lcup, int len2)
629
879
{
630
879
    int num, i;
631
632
879
    mrp->data = data + lcup + len2 - 1;
633
879
    mrp->size = len2;
634
879
    mrp->unstuff = OPJ_TRUE;
635
879
    mrp->bits = 0;
636
879
    mrp->tmp = 0;
637
638
    //This code is designed for an architecture that read address should
639
    // align to the read size (address multiple of 4 if read size is 4)
640
    //These few lines take care of the case where data is not at a multiple
641
    // of 4 boundary.  It reads 1,2,3 up to 4 bytes from the MRP stream
642
879
    num = 1 + (int)((intptr_t)(mrp->data) & 0x3);
643
3.26k
    for (i = 0; i < num; ++i) {
644
2.38k
        OPJ_UINT64 d;
645
2.38k
        OPJ_UINT32 d_bits;
646
647
        //read a byte, 0 if no more data
648
2.38k
        d = (mrp->size-- > 0) ? *mrp->data-- : 0;
649
        //check if unstuffing is needed
650
2.38k
        d_bits = 8u - ((mrp->unstuff && ((d & 0x7F) == 0x7F)) ? 1u : 0u);
651
2.38k
        mrp->tmp |= d << mrp->bits; // move data to vlcp->tmp
652
2.38k
        mrp->bits += d_bits;
653
2.38k
        mrp->unstuff = d > 0x8F; // for next byte
654
2.38k
    }
655
879
    rev_read_mrp(mrp);
656
879
}
657
658
//************************************************************************/
659
/** @brief Retrieves 32 bits from the head of a rev_struct structure
660
  *
661
  *  By the end of this call, mrp->tmp must have no less than 33 bits
662
  *
663
  *  @param [in]  mrp is a pointer to rev_struct structure
664
  */
665
static INLINE
666
OPJ_UINT32 rev_fetch_mrp(rev_struct_t *mrp)
667
9.45k
{
668
9.45k
    if (mrp->bits < 32) { // if there are less than 32 bits in mrp->tmp
669
241
        rev_read_mrp(mrp);    // read 30-32 bits from mrp
670
241
        if (mrp->bits < 32) { // if there is a space of 32 bits
671
0
            rev_read_mrp(mrp);    // read more
672
0
        }
673
241
    }
674
9.45k
    return (OPJ_UINT32)mrp->tmp;  // return the head of mrp->tmp
675
9.45k
}
676
677
//************************************************************************/
678
/** @brief Consumes num_bits from a rev_struct structure
679
  *
680
  *  @param [in]  mrp is a pointer to rev_struct structure
681
  *  @param [in]  num_bits is the number of bits to be removed
682
  */
683
static INLINE
684
OPJ_UINT32 rev_advance_mrp(rev_struct_t *mrp, OPJ_UINT32 num_bits)
685
9.45k
{
686
9.45k
    assert(num_bits <= mrp->bits); // we must not consume more than mrp->bits
687
9.45k
    mrp->tmp >>= num_bits;         // discard the lowest num_bits bits
688
9.45k
    mrp->bits -= num_bits;
689
9.45k
    return (OPJ_UINT32)mrp->tmp;   // return data after consumption
690
9.45k
}
691
692
//************************************************************************/
693
/** @brief Decode initial UVLC to get the u value (or u_q)
694
  *
695
  *  @param [in]  vlc is the head of the VLC bitstream
696
  *  @param [in]  mode is 0, 1, 2, 3, or 4. Values in 0 to 3 are composed of
697
  *               u_off of 1st quad and 2nd quad of a quad pair.  The value
698
  *               4 occurs when both bits are 1, and the event decoded
699
  *               from MEL bitstream is also 1.
700
  *  @param [out] u is the u value (or u_q) + 1.  Note: we produce u + 1;
701
  *               this value is a partial calculation of u + kappa.
702
  */
703
static INLINE
704
OPJ_UINT32 decode_init_uvlc(OPJ_UINT32 vlc, OPJ_UINT32 mode, OPJ_UINT32 *u)
705
16.7k
{
706
    //table stores possible decoding three bits from vlc
707
    // there are 8 entries for xx1, x10, 100, 000, where x means do not care
708
    // table value is made up of
709
    // 2 bits in the LSB for prefix length
710
    // 3 bits for suffix length
711
    // 3 bits in the MSB for prefix value (u_pfx in Table 3 of ITU T.814)
712
16.7k
    static const OPJ_UINT8 dec[8] = { // the index is the prefix codeword
713
16.7k
        3 | (5 << 2) | (5 << 5),        //000 == 000, prefix codeword "000"
714
16.7k
        1 | (0 << 2) | (1 << 5),        //001 == xx1, prefix codeword "1"
715
16.7k
        2 | (0 << 2) | (2 << 5),        //010 == x10, prefix codeword "01"
716
16.7k
        1 | (0 << 2) | (1 << 5),        //011 == xx1, prefix codeword "1"
717
16.7k
        3 | (1 << 2) | (3 << 5),        //100 == 100, prefix codeword "001"
718
16.7k
        1 | (0 << 2) | (1 << 5),        //101 == xx1, prefix codeword "1"
719
16.7k
        2 | (0 << 2) | (2 << 5),        //110 == x10, prefix codeword "01"
720
16.7k
        1 | (0 << 2) | (1 << 5)         //111 == xx1, prefix codeword "1"
721
16.7k
    };
722
723
16.7k
    OPJ_UINT32 consumed_bits = 0;
724
16.7k
    if (mode == 0) { // both u_off are 0
725
16.6k
        u[0] = u[1] = 1; //Kappa is 1 for initial line
726
16.6k
    } else if (mode <= 2) { // u_off are either 01 or 10
727
82
        OPJ_UINT32 d;
728
82
        OPJ_UINT32 suffix_len;
729
730
82
        d = dec[vlc & 0x7];   //look at the least significant 3 bits
731
82
        vlc >>= d & 0x3;                 //prefix length
732
82
        consumed_bits += d & 0x3;
733
734
82
        suffix_len = ((d >> 2) & 0x7);
735
82
        consumed_bits += suffix_len;
736
737
82
        d = (d >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
738
82
        u[0] = (mode == 1) ? d + 1 : 1; // kappa is 1 for initial line
739
82
        u[1] = (mode == 1) ? 1 : d + 1; // kappa is 1 for initial line
740
82
    } else if (mode == 3) { // both u_off are 1, and MEL event is 0
741
42
        OPJ_UINT32 d1 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
742
42
        vlc >>= d1 & 0x3;                // Consume bits
743
42
        consumed_bits += d1 & 0x3;
744
745
42
        if ((d1 & 0x3) > 2) {
746
8
            OPJ_UINT32 suffix_len;
747
748
            //u_{q_2} prefix
749
8
            u[1] = (vlc & 1) + 1 + 1; //Kappa is 1 for initial line
750
8
            ++consumed_bits;
751
8
            vlc >>= 1;
752
753
8
            suffix_len = ((d1 >> 2) & 0x7);
754
8
            consumed_bits += suffix_len;
755
8
            d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
756
8
            u[0] = d1 + 1; //Kappa is 1 for initial line
757
34
        } else {
758
34
            OPJ_UINT32 d2;
759
34
            OPJ_UINT32 suffix_len;
760
761
34
            d2 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
762
34
            vlc >>= d2 & 0x3;                // Consume bits
763
34
            consumed_bits += d2 & 0x3;
764
765
34
            suffix_len = ((d1 >> 2) & 0x7);
766
34
            consumed_bits += suffix_len;
767
768
34
            d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
769
34
            u[0] = d1 + 1; //Kappa is 1 for initial line
770
34
            vlc >>= suffix_len;
771
772
34
            suffix_len = ((d2 >> 2) & 0x7);
773
34
            consumed_bits += suffix_len;
774
775
34
            d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
776
34
            u[1] = d2 + 1; //Kappa is 1 for initial line
777
34
        }
778
42
    } else if (mode == 4) { // both u_off are 1, and MEL event is 1
779
6
        OPJ_UINT32 d1;
780
6
        OPJ_UINT32 d2;
781
6
        OPJ_UINT32 suffix_len;
782
783
6
        d1 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
784
6
        vlc >>= d1 & 0x3;                // Consume bits
785
6
        consumed_bits += d1 & 0x3;
786
787
6
        d2 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
788
6
        vlc >>= d2 & 0x3;                // Consume bits
789
6
        consumed_bits += d2 & 0x3;
790
791
6
        suffix_len = ((d1 >> 2) & 0x7);
792
6
        consumed_bits += suffix_len;
793
794
6
        d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
795
6
        u[0] = d1 + 3; // add 2+kappa
796
6
        vlc >>= suffix_len;
797
798
6
        suffix_len = ((d2 >> 2) & 0x7);
799
6
        consumed_bits += suffix_len;
800
801
6
        d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
802
6
        u[1] = d2 + 3; // add 2+kappa
803
6
    }
804
16.7k
    return consumed_bits;
805
16.7k
}
806
807
//************************************************************************/
808
/** @brief Decode non-initial UVLC to get the u value (or u_q)
809
  *
810
  *  @param [in]  vlc is the head of the VLC bitstream
811
  *  @param [in]  mode is 0, 1, 2, or 3. The 1st bit is u_off of 1st quad
812
  *               and 2nd for 2nd quad of a quad pair
813
  *  @param [out] u is the u value (or u_q) + 1.  Note: we produce u + 1;
814
  *               this value is a partial calculation of u + kappa.
815
  */
816
static INLINE
817
OPJ_UINT32 decode_noninit_uvlc(OPJ_UINT32 vlc, OPJ_UINT32 mode, OPJ_UINT32 *u)
818
12.6k
{
819
    //table stores possible decoding three bits from vlc
820
    // there are 8 entries for xx1, x10, 100, 000, where x means do not care
821
    // table value is made up of
822
    // 2 bits in the LSB for prefix length
823
    // 3 bits for suffix length
824
    // 3 bits in the MSB for prefix value (u_pfx in Table 3 of ITU T.814)
825
12.6k
    static const OPJ_UINT8 dec[8] = {
826
12.6k
        3 | (5 << 2) | (5 << 5), //000 == 000, prefix codeword "000"
827
12.6k
        1 | (0 << 2) | (1 << 5), //001 == xx1, prefix codeword "1"
828
12.6k
        2 | (0 << 2) | (2 << 5), //010 == x10, prefix codeword "01"
829
12.6k
        1 | (0 << 2) | (1 << 5), //011 == xx1, prefix codeword "1"
830
12.6k
        3 | (1 << 2) | (3 << 5), //100 == 100, prefix codeword "001"
831
12.6k
        1 | (0 << 2) | (1 << 5), //101 == xx1, prefix codeword "1"
832
12.6k
        2 | (0 << 2) | (2 << 5), //110 == x10, prefix codeword "01"
833
12.6k
        1 | (0 << 2) | (1 << 5)  //111 == xx1, prefix codeword "1"
834
12.6k
    };
835
836
12.6k
    OPJ_UINT32 consumed_bits = 0;
837
12.6k
    if (mode == 0) {
838
11.4k
        u[0] = u[1] = 1; //for kappa
839
11.4k
    } else if (mode <= 2) { //u_off are either 01 or 10
840
791
        OPJ_UINT32 d;
841
791
        OPJ_UINT32 suffix_len;
842
843
791
        d = dec[vlc & 0x7];  //look at the least significant 3 bits
844
791
        vlc >>= d & 0x3;                //prefix length
845
791
        consumed_bits += d & 0x3;
846
847
791
        suffix_len = ((d >> 2) & 0x7);
848
791
        consumed_bits += suffix_len;
849
850
791
        d = (d >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
851
791
        u[0] = (mode == 1) ? d + 1 : 1; //for kappa
852
791
        u[1] = (mode == 1) ? 1 : d + 1; //for kappa
853
791
    } else if (mode == 3) { // both u_off are 1
854
367
        OPJ_UINT32 d1;
855
367
        OPJ_UINT32 d2;
856
367
        OPJ_UINT32 suffix_len;
857
858
367
        d1 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
859
367
        vlc >>= d1 & 0x3;                // Consume bits
860
367
        consumed_bits += d1 & 0x3;
861
862
367
        d2 = dec[vlc & 0x7];  // LSBs of VLC are prefix codeword
863
367
        vlc >>= d2 & 0x3;                // Consume bits
864
367
        consumed_bits += d2 & 0x3;
865
866
367
        suffix_len = ((d1 >> 2) & 0x7);
867
367
        consumed_bits += suffix_len;
868
869
367
        d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
870
367
        u[0] = d1 + 1;  //1 for kappa
871
367
        vlc >>= suffix_len;
872
873
367
        suffix_len = ((d2 >> 2) & 0x7);
874
367
        consumed_bits += suffix_len;
875
876
367
        d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); // u value
877
367
        u[1] = d2 + 1;  //1 for kappa
878
367
    }
879
12.6k
    return consumed_bits;
880
12.6k
}
881
882
//************************************************************************/
883
/** @brief State structure for reading and unstuffing of forward-growing
884
  *         bitstreams; these are: MagSgn and SPP bitstreams
885
  */
886
typedef struct frwd_struct {
887
    const OPJ_UINT8* data; //!<pointer to bitstream
888
    OPJ_UINT64 tmp;        //!<temporary buffer of read data
889
    OPJ_UINT32 bits;       //!<number of bits stored in tmp
890
    OPJ_BOOL unstuff;      //!<true if a bit needs to be unstuffed from next byte
891
    int size;              //!<size of data
892
    OPJ_UINT32 X;          //!<0 or 0xFF, X's are inserted at end of bitstream
893
} frwd_struct_t;
894
895
//************************************************************************/
896
/** @brief Read and unstuffs 32 bits from forward-growing bitstream
897
  *
898
  *  A subroutine to read from both the MagSgn or SPP bitstreams;
899
  *  in particular, when MagSgn bitstream is consumed, 0xFF's are fed,
900
  *  while when SPP is exhausted 0's are fed in.
901
  *  X controls this value.
902
  *
903
  *  Unstuffing prevent sequences that are more than 0xFF7F from appearing
904
  *  in the compressed sequence.  So whenever a value of 0xFF is coded, the
905
  *  MSB of the next byte is set 0 and must be ignored during decoding.
906
  *
907
  *  Reading can go beyond the end of buffer by up to 3 bytes.
908
  *
909
  *  @param  [in]  msp is a pointer to frwd_struct_t structure
910
  *
911
  */
912
static INLINE
913
void frwd_read(frwd_struct_t *msp)
914
4.52k
{
915
4.52k
    OPJ_UINT32 val;
916
4.52k
    OPJ_UINT32 bits;
917
4.52k
    OPJ_UINT32 t;
918
4.52k
    OPJ_BOOL unstuff;
919
920
4.52k
    assert(msp->bits <= 32); // assert that there is a space for 32 bits
921
922
4.52k
    val = 0u;
923
4.52k
    if (msp->size > 3) {
924
1.29k
        val = read_le_uint32(msp->data);  // read 32 bits
925
1.29k
        msp->data += 4;           // increment pointer
926
1.29k
        msp->size -= 4;           // reduce size
927
3.23k
    } else if (msp->size > 0) {
928
740
        int i = 0;
929
740
        val = msp->X != 0 ? 0xFFFFFFFFu : 0;
930
2.10k
        while (msp->size > 0) {
931
1.36k
            OPJ_UINT32 v = *msp->data++;  // read one byte at a time
932
1.36k
            OPJ_UINT32 m = ~(0xFFu << i); // mask of location
933
1.36k
            val = (val & m) | (v << i);   // put one byte in its correct location
934
1.36k
            --msp->size;
935
1.36k
            i += 8;
936
1.36k
        }
937
2.49k
    } else {
938
2.49k
        val = msp->X != 0 ? 0xFFFFFFFFu : 0;
939
2.49k
    }
940
941
    // we accumulate in t and keep a count of the number of bits in bits
942
4.52k
    bits = 8u - (msp->unstuff ? 1u : 0u);
943
4.52k
    t = val & 0xFF;
944
4.52k
    unstuff = ((val & 0xFF) == 0xFF);  // Do we need unstuffing next?
945
946
4.52k
    t |= ((val >> 8) & 0xFF) << bits;
947
4.52k
    bits += 8u - (unstuff ? 1u : 0u);
948
4.52k
    unstuff = (((val >> 8) & 0xFF) == 0xFF);
949
950
4.52k
    t |= ((val >> 16) & 0xFF) << bits;
951
4.52k
    bits += 8u - (unstuff ? 1u : 0u);
952
4.52k
    unstuff = (((val >> 16) & 0xFF) == 0xFF);
953
954
4.52k
    t |= ((val >> 24) & 0xFF) << bits;
955
4.52k
    bits += 8u - (unstuff ? 1u : 0u);
956
4.52k
    msp->unstuff = (((val >> 24) & 0xFF) == 0xFF); // for next byte
957
958
4.52k
    msp->tmp |= ((OPJ_UINT64)t) << msp->bits;  // move data to msp->tmp
959
4.52k
    msp->bits += bits;
960
4.52k
}
961
962
//************************************************************************/
963
/** @brief Initialize frwd_struct_t struct and reads some bytes
964
  *
965
  *  @param [in]  msp is a pointer to frwd_struct_t
966
  *  @param [in]  data is a pointer to the start of data
967
  *  @param [in]  size is the number of byte in the bitstream
968
  *  @param [in]  X is the value fed in when the bitstream is exhausted.
969
  *               See frwd_read.
970
  */
971
static INLINE
972
void frwd_init(frwd_struct_t *msp, const OPJ_UINT8* data, int size,
973
               OPJ_UINT32 X)
974
2.31k
{
975
2.31k
    int num, i;
976
977
2.31k
    msp->data = data;
978
2.31k
    msp->tmp = 0;
979
2.31k
    msp->bits = 0;
980
2.31k
    msp->unstuff = OPJ_FALSE;
981
2.31k
    msp->size = size;
982
2.31k
    msp->X = X;
983
2.31k
    assert(msp->X == 0 || msp->X == 0xFF);
984
985
    //This code is designed for an architecture that read address should
986
    // align to the read size (address multiple of 4 if read size is 4)
987
    //These few lines take care of the case where data is not at a multiple
988
    // of 4 boundary.  It reads 1,2,3 up to 4 bytes from the bitstream
989
2.31k
    num = 4 - (int)((intptr_t)(msp->data) & 0x3);
990
9.70k
    for (i = 0; i < num; ++i) {
991
7.38k
        OPJ_UINT64 d;
992
        //read a byte if the buffer is not exhausted, otherwise set it to X
993
7.38k
        d = msp->size-- > 0 ? *msp->data++ : msp->X;
994
7.38k
        msp->tmp |= (d << msp->bits);      // store data in msp->tmp
995
7.38k
        msp->bits += 8u - (msp->unstuff ? 1u : 0u); // number of bits added to msp->tmp
996
7.38k
        msp->unstuff = ((d & 0xFF) == 0xFF); // unstuffing for next byte
997
7.38k
    }
998
2.31k
    frwd_read(msp); // read 32 bits more
999
2.31k
}
1000
1001
//************************************************************************/
1002
/** @brief Consume num_bits bits from the bitstream of frwd_struct_t
1003
  *
1004
  *  @param [in]  msp is a pointer to frwd_struct_t
1005
  *  @param [in]  num_bits is the number of bit to consume
1006
  */
1007
static INLINE
1008
void frwd_advance(frwd_struct_t *msp, OPJ_UINT32 num_bits)
1009
21.5k
{
1010
21.5k
    assert(num_bits <= msp->bits);
1011
21.5k
    msp->tmp >>= num_bits;  // consume num_bits
1012
21.5k
    msp->bits -= num_bits;
1013
21.5k
}
1014
1015
//************************************************************************/
1016
/** @brief Fetches 32 bits from the frwd_struct_t bitstream
1017
  *
1018
  *  @param [in]  msp is a pointer to frwd_struct_t
1019
  */
1020
static INLINE
1021
OPJ_UINT32 frwd_fetch(frwd_struct_t *msp)
1022
21.5k
{
1023
21.5k
    if (msp->bits < 32) {
1024
2.21k
        frwd_read(msp);
1025
2.21k
        if (msp->bits < 32) { //need to test
1026
0
            frwd_read(msp);
1027
0
        }
1028
2.21k
    }
1029
21.5k
    return (OPJ_UINT32)msp->tmp;
1030
21.5k
}
1031
1032
//************************************************************************/
1033
/** @brief Allocates T1 buffers
1034
  *
1035
  *  @param [in, out]  t1 is codeblock coefficients storage
1036
  *  @param [in]       w is codeblock width
1037
  *  @param [in]       h is codeblock height
1038
  */
1039
static OPJ_BOOL opj_t1_allocate_buffers(
1040
    opj_t1_t *t1,
1041
    OPJ_UINT32 w,
1042
    OPJ_UINT32 h)
1043
9.20k
{
1044
9.20k
    OPJ_UINT32 flagssize;
1045
1046
    /* No risk of overflow. Prior checks ensure those assert are met */
1047
    /* They are per the specification */
1048
9.20k
    assert(w <= 1024);
1049
9.20k
    assert(h <= 1024);
1050
9.20k
    assert(w * h <= 4096);
1051
1052
    /* encoder uses tile buffer, so no need to allocate */
1053
9.20k
    {
1054
9.20k
        OPJ_UINT32 datasize = w * h;
1055
1056
9.20k
        if (datasize > t1->datasize) {
1057
49
            opj_aligned_free(t1->data);
1058
49
            t1->data = (OPJ_INT32*)
1059
49
                       opj_aligned_malloc(datasize * sizeof(OPJ_INT32));
1060
49
            if (!t1->data) {
1061
                /* FIXME event manager error callback */
1062
0
                return OPJ_FALSE;
1063
0
            }
1064
49
            t1->datasize = datasize;
1065
49
        }
1066
        /* memset first arg is declared to never be null by gcc */
1067
9.20k
        if (t1->data != NULL) {
1068
9.20k
            memset(t1->data, 0, datasize * sizeof(OPJ_INT32));
1069
9.20k
        }
1070
9.20k
    }
1071
1072
    // We expand these buffers to multiples of 16 bytes.
1073
    // We need 4 buffers of 129 integers each, expanded to 132 integers each
1074
    // We also need 514 bytes of buffer, expanded to 528 bytes
1075
0
    flagssize = 132U * sizeof(OPJ_UINT32) * 4U; // expanded to multiple of 16
1076
9.20k
    flagssize += 528U; // 514 expanded to multiples of 16
1077
1078
9.20k
    {
1079
9.20k
        if (flagssize > t1->flagssize) {
1080
1081
28
            opj_aligned_free(t1->flags);
1082
28
            t1->flags = (opj_flag_t*) opj_aligned_malloc(flagssize * sizeof(opj_flag_t));
1083
28
            if (!t1->flags) {
1084
                /* FIXME event manager error callback */
1085
0
                return OPJ_FALSE;
1086
0
            }
1087
28
        }
1088
9.20k
        t1->flagssize = flagssize;
1089
1090
9.20k
        memset(t1->flags, 0, flagssize * sizeof(opj_flag_t));
1091
9.20k
    }
1092
1093
0
    t1->w = w;
1094
9.20k
    t1->h = h;
1095
1096
9.20k
    return OPJ_TRUE;
1097
9.20k
}
1098
1099
/**
1100
Decode 1 HT code-block
1101
@param t1 T1 handle
1102
@param cblk Code-block coding parameters
1103
@param orient
1104
@param roishift Region of interest shifting value
1105
@param cblksty Code-block style
1106
@param p_manager the event manager
1107
@param p_manager_mutex mutex for the event manager
1108
@param check_pterm whether PTERM correct termination should be checked
1109
*/
1110
OPJ_BOOL opj_t1_ht_decode_cblk(opj_t1_t *t1,
1111
                               opj_tcd_cblk_dec_t* cblk,
1112
                               OPJ_UINT32 orient,
1113
                               OPJ_UINT32 roishift,
1114
                               OPJ_UINT32 cblksty,
1115
                               opj_event_mgr_t *p_manager,
1116
                               opj_mutex_t* p_manager_mutex,
1117
                               OPJ_BOOL check_pterm);
1118
1119
//************************************************************************/
1120
/** @brief Decodes one codeblock, processing the cleanup, siginificance
1121
  *         propagation, and magnitude refinement pass
1122
  *
1123
  *  @param [in, out]  t1 is codeblock coefficients storage
1124
  *  @param [in]       cblk is codeblock properties
1125
  *  @param [in]       orient is the subband to which the codeblock belongs (not needed)
1126
  *  @param [in]       roishift is region of interest shift
1127
  *  @param [in]       cblksty is codeblock style
1128
  *  @param [in]       p_manager is events print manager
1129
  *  @param [in]       p_manager_mutex a mutex to control access to p_manager
1130
  *  @param [in]       check_pterm: check termination (not used)
1131
  */
1132
OPJ_BOOL opj_t1_ht_decode_cblk(opj_t1_t *t1,
1133
                               opj_tcd_cblk_dec_t* cblk,
1134
                               OPJ_UINT32 orient,
1135
                               OPJ_UINT32 roishift,
1136
                               OPJ_UINT32 cblksty,
1137
                               opj_event_mgr_t *p_manager,
1138
                               opj_mutex_t* p_manager_mutex,
1139
                               OPJ_BOOL check_pterm)
1140
9.20k
{
1141
9.20k
    OPJ_BYTE* cblkdata = NULL;
1142
9.20k
    OPJ_UINT8* coded_data;
1143
9.20k
    OPJ_UINT32* decoded_data;
1144
9.20k
    OPJ_UINT32 zero_bplanes;
1145
9.20k
    OPJ_UINT32 num_passes;
1146
9.20k
    OPJ_UINT32 lengths1;
1147
9.20k
    OPJ_UINT32 lengths2;
1148
9.20k
    OPJ_INT32 width;
1149
9.20k
    OPJ_INT32 height;
1150
9.20k
    OPJ_INT32 stride;
1151
9.20k
    OPJ_UINT32 *pflags, *sigma1, *sigma2, *mbr1, *mbr2, *sip, sip_shift;
1152
9.20k
    OPJ_UINT32 p;
1153
9.20k
    OPJ_UINT32 zero_bplanes_p1;
1154
9.20k
    int lcup, scup;
1155
9.20k
    dec_mel_t mel;
1156
9.20k
    rev_struct_t vlc;
1157
9.20k
    frwd_struct_t magsgn;
1158
9.20k
    frwd_struct_t sigprop;
1159
9.20k
    rev_struct_t magref;
1160
9.20k
    OPJ_UINT8 *lsp, *line_state;
1161
9.20k
    int run;
1162
9.20k
    OPJ_UINT32 vlc_val;              // fetched data from VLC bitstream
1163
9.20k
    OPJ_UINT32 qinf[2];
1164
9.20k
    OPJ_UINT32 c_q;
1165
9.20k
    OPJ_UINT32* sp;
1166
9.20k
    OPJ_INT32 x, y; // loop indices
1167
9.20k
    OPJ_BOOL stripe_causal = (cblksty & J2K_CCP_CBLKSTY_VSC) != 0;
1168
9.20k
    OPJ_UINT32 cblk_len = 0;
1169
1170
9.20k
    (void)(orient);      // stops unused parameter message
1171
9.20k
    (void)(check_pterm); // stops unused parameter message
1172
1173
    // We ignor orient, because the same decoder is used for all subbands
1174
    // We also ignore check_pterm, because I am not sure how it applies
1175
9.20k
    if (roishift != 0) {
1176
0
        if (p_manager_mutex) {
1177
0
            opj_mutex_lock(p_manager_mutex);
1178
0
        }
1179
0
        opj_event_msg(p_manager, EVT_ERROR, "We do not support ROI in decoding "
1180
0
                      "HT codeblocks\n");
1181
0
        if (p_manager_mutex) {
1182
0
            opj_mutex_unlock(p_manager_mutex);
1183
0
        }
1184
0
        return OPJ_FALSE;
1185
0
    }
1186
1187
9.20k
    if (!opj_t1_allocate_buffers(
1188
9.20k
                t1,
1189
9.20k
                (OPJ_UINT32)(cblk->x1 - cblk->x0),
1190
9.20k
                (OPJ_UINT32)(cblk->y1 - cblk->y0))) {
1191
0
        return OPJ_FALSE;
1192
0
    }
1193
1194
9.20k
    if (cblk->Mb == 0) {
1195
7.78k
        return OPJ_TRUE;
1196
7.78k
    }
1197
1198
    /* numbps = Mb + 1 - zero_bplanes, Mb = Kmax, zero_bplanes = missing_msbs */
1199
1.42k
    zero_bplanes = (cblk->Mb + 1) - cblk->numbps;
1200
1201
    /* Compute whole codeblock length from chunk lengths */
1202
1.42k
    cblk_len = 0;
1203
1.42k
    {
1204
1.42k
        OPJ_UINT32 i;
1205
5.77k
        for (i = 0; i < cblk->numchunks; i++) {
1206
4.35k
            cblk_len += cblk->chunks[i].len;
1207
4.35k
        }
1208
1.42k
    }
1209
1210
1.42k
    if (cblk->numchunks > 1 || t1->mustuse_cblkdatabuffer) {
1211
927
        OPJ_UINT32 i;
1212
1213
        /* Allocate temporary memory if needed */
1214
927
        if (cblk_len > t1->cblkdatabuffersize) {
1215
49
            cblkdata = (OPJ_BYTE*)opj_realloc(
1216
49
                           t1->cblkdatabuffer, cblk_len);
1217
49
            if (cblkdata == NULL) {
1218
0
                return OPJ_FALSE;
1219
0
            }
1220
49
            t1->cblkdatabuffer = cblkdata;
1221
49
            t1->cblkdatabuffersize = cblk_len;
1222
49
        }
1223
1224
        /* Concatenate all chunks */
1225
927
        cblkdata = t1->cblkdatabuffer;
1226
927
        if (cblkdata == NULL) {
1227
0
            return OPJ_FALSE;
1228
0
        }
1229
927
        cblk_len = 0;
1230
4.78k
        for (i = 0; i < cblk->numchunks; i++) {
1231
3.85k
            memcpy(cblkdata + cblk_len, cblk->chunks[i].data, cblk->chunks[i].len);
1232
3.85k
            cblk_len += cblk->chunks[i].len;
1233
3.85k
        }
1234
927
    } else if (cblk->numchunks == 1) {
1235
497
        cblkdata = cblk->chunks[0].data;
1236
497
    } else {
1237
        /* Not sure if that can happen in practice, but avoid Coverity to */
1238
        /* think we will dereference a null cblkdta pointer */
1239
0
        return OPJ_TRUE;
1240
0
    }
1241
1242
    // OPJ_BYTE* coded_data is a pointer to bitstream
1243
1.42k
    coded_data = cblkdata;
1244
    // OPJ_UINT32* decoded_data is a pointer to decoded codeblock data buf.
1245
1.42k
    decoded_data = (OPJ_UINT32*)t1->data;
1246
    // OPJ_UINT32 num_passes is the number of passes: 1 if CUP only, 2 for
1247
    // CUP+SPP, and 3 for CUP+SPP+MRP
1248
1.42k
    num_passes = cblk->numsegs > 0 ? cblk->segs[0].real_num_passes : 0;
1249
1.42k
    num_passes += cblk->numsegs > 1 ? cblk->segs[1].real_num_passes : 0;
1250
    // OPJ_UINT32 lengths1 is the length of cleanup pass
1251
1.42k
    lengths1 = num_passes > 0 ? cblk->segs[0].len : 0;
1252
    // OPJ_UINT32 lengths2 is the length of refinement passes (either SPP only or SPP+MRP)
1253
1.42k
    lengths2 = num_passes > 1 ? cblk->segs[1].len : 0;
1254
    // OPJ_INT32 width is the decoded codeblock width
1255
1.42k
    width = cblk->x1 - cblk->x0;
1256
    // OPJ_INT32 height is the decoded codeblock height
1257
1.42k
    height = cblk->y1 - cblk->y0;
1258
    // OPJ_INT32 stride is the decoded codeblock buffer stride
1259
1.42k
    stride = width;
1260
1261
    /*  sigma1 and sigma2 contains significant (i.e., non-zero) pixel
1262
     *  locations.  The buffers are used interchangeably, because we need
1263
     *  more than 4 rows of significance information at a given time.
1264
     *  Each 32 bits contain significance information for 4 rows of 8
1265
     *  columns each.  If we denote 32 bits by 0xaaaaaaaa, the each "a" is
1266
     *  called a nibble and has significance information for 4 rows.
1267
     *  The least significant nibble has information for the first column,
1268
     *  and so on. The nibble's LSB is for the first row, and so on.
1269
     *  Since, at most, we can have 1024 columns in a quad, we need 128
1270
     *  entries; we added 1 for convenience when propagation of signifcance
1271
     *  goes outside the structure
1272
     *  To work in OpenJPEG these buffers has been expanded to 132.
1273
     */
1274
    // OPJ_UINT32 *pflags, *sigma1, *sigma2, *mbr1, *mbr2, *sip, sip_shift;
1275
1.42k
    pflags = (OPJ_UINT32 *)t1->flags;
1276
1.42k
    sigma1 = pflags;
1277
1.42k
    sigma2 = sigma1 + 132;
1278
    // mbr arrangement is similar to sigma; mbr contains locations
1279
    // that become significant during significance propagation pass
1280
1.42k
    mbr1 = sigma2 + 132;
1281
1.42k
    mbr2 = mbr1 + 132;
1282
    //a pointer to sigma
1283
1.42k
    sip = sigma1;  //pointers to arrays to be used interchangeably
1284
1.42k
    sip_shift = 0; //the amount of shift needed for sigma
1285
1286
1.42k
    if (num_passes > 1 && lengths2 == 0) {
1287
8
        if (p_manager_mutex) {
1288
8
            opj_mutex_lock(p_manager_mutex);
1289
8
        }
1290
8
        opj_event_msg(p_manager, EVT_WARNING, "A malformed codeblock that has "
1291
8
                      "more than one coding pass, but zero length for "
1292
8
                      "2nd and potentially the 3rd pass in an HT codeblock.\n");
1293
8
        if (p_manager_mutex) {
1294
8
            opj_mutex_unlock(p_manager_mutex);
1295
8
        }
1296
8
        num_passes = 1;
1297
8
    }
1298
1.42k
    if (num_passes > 3) {
1299
7
        if (p_manager_mutex) {
1300
7
            opj_mutex_lock(p_manager_mutex);
1301
7
        }
1302
7
        opj_event_msg(p_manager, EVT_ERROR, "We do not support more than 3 "
1303
7
                      "coding passes in an HT codeblock; This codeblocks has "
1304
7
                      "%d passes.\n", num_passes);
1305
7
        if (p_manager_mutex) {
1306
7
            opj_mutex_unlock(p_manager_mutex);
1307
7
        }
1308
7
        return OPJ_FALSE;
1309
7
    }
1310
1311
1.41k
    if (cblk->Mb > 30) {
1312
        /* This check is better moved to opj_t2_read_packet_header() in t2.c
1313
           We do not have enough precision to decode any passes
1314
           The design of openjpeg assumes that the bits of a 32-bit integer are
1315
           assigned as follows:
1316
           bit 31 is for sign
1317
           bits 30-1 are for magnitude
1318
           bit 0 is for the center of the quantization bin
1319
           Therefore we can only do values of cblk->Mb <= 30
1320
         */
1321
0
        if (p_manager_mutex) {
1322
0
            opj_mutex_lock(p_manager_mutex);
1323
0
        }
1324
0
        opj_event_msg(p_manager, EVT_ERROR, "32 bits are not enough to "
1325
0
                      "decode this codeblock, since the number of "
1326
0
                      "bitplane, %d, is larger than 30.\n", cblk->Mb);
1327
0
        if (p_manager_mutex) {
1328
0
            opj_mutex_unlock(p_manager_mutex);
1329
0
        }
1330
0
        return OPJ_FALSE;
1331
0
    }
1332
1.41k
    if (zero_bplanes > cblk->Mb) {
1333
        /* This check is better moved to opj_t2_read_packet_header() in t2.c,
1334
           in the line "l_cblk->numbps = (OPJ_UINT32)l_band->numbps + 1 - i;"
1335
           where i is the zero bitplanes, and should be no larger than cblk->Mb
1336
           We cannot have more zero bitplanes than there are planes. */
1337
0
        if (p_manager_mutex) {
1338
0
            opj_mutex_lock(p_manager_mutex);
1339
0
        }
1340
0
        opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1341
0
                      "Decoding this codeblock is stopped. There are "
1342
0
                      "%d zero bitplanes in %d bitplanes.\n",
1343
0
                      zero_bplanes, cblk->Mb);
1344
1345
0
        if (p_manager_mutex) {
1346
0
            opj_mutex_unlock(p_manager_mutex);
1347
0
        }
1348
0
        return OPJ_FALSE;
1349
1.41k
    } else if (zero_bplanes == cblk->Mb && num_passes > 1) {
1350
        /* When the number of zero bitplanes is equal to the number of bitplanes,
1351
           only the cleanup pass makes sense*/
1352
0
        if (only_cleanup_pass_is_decoded == OPJ_FALSE) {
1353
0
            if (p_manager_mutex) {
1354
0
                opj_mutex_lock(p_manager_mutex);
1355
0
            }
1356
            /* We have a second check to prevent the possibility of an overrun condition,
1357
               in the very unlikely event of a second thread discovering that
1358
               only_cleanup_pass_is_decoded is false before the first thread changing
1359
               the condition. */
1360
0
            if (only_cleanup_pass_is_decoded == OPJ_FALSE) {
1361
0
                only_cleanup_pass_is_decoded = OPJ_TRUE;
1362
0
                opj_event_msg(p_manager, EVT_WARNING, "Malformed HT codeblock. "
1363
0
                              "When the number of zero planes bitplanes is "
1364
0
                              "equal to the number of bitplanes, only the cleanup "
1365
0
                              "pass makes sense, but we have %d passes in this "
1366
0
                              "codeblock. Therefore, only the cleanup pass will be "
1367
0
                              "decoded. This message will not be displayed again.\n",
1368
0
                              num_passes);
1369
0
            }
1370
0
            if (p_manager_mutex) {
1371
0
                opj_mutex_unlock(p_manager_mutex);
1372
0
            }
1373
0
        }
1374
0
        num_passes = 1;
1375
0
    }
1376
1377
    /* OPJ_UINT32 */
1378
1.41k
    p = cblk->numbps;
1379
1380
    // OPJ_UINT32 zero planes plus 1
1381
1.41k
    zero_bplanes_p1 = zero_bplanes + 1;
1382
1383
1.41k
    if (lengths1 < 2 || (OPJ_UINT32)lengths1 > cblk_len ||
1384
1.41k
            (OPJ_UINT32)(lengths1 + lengths2) > cblk_len) {
1385
4
        if (p_manager_mutex) {
1386
4
            opj_mutex_lock(p_manager_mutex);
1387
4
        }
1388
4
        opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1389
4
                      "Invalid codeblock length values.\n");
1390
1391
4
        if (p_manager_mutex) {
1392
4
            opj_mutex_unlock(p_manager_mutex);
1393
4
        }
1394
4
        return OPJ_FALSE;
1395
4
    }
1396
    // read scup and fix the bytes there
1397
1.41k
    lcup = (int)lengths1;  // length of CUP
1398
    //scup is the length of MEL + VLC
1399
1.41k
    scup = (((int)coded_data[lcup - 1]) << 4) + (coded_data[lcup - 2] & 0xF);
1400
1.41k
    if (scup < 2 || scup > lcup || scup > 4079) { //something is wrong
1401
        /* The standard stipulates 2 <= Scup <= min(Lcup, 4079) */
1402
8
        if (p_manager_mutex) {
1403
8
            opj_mutex_lock(p_manager_mutex);
1404
8
        }
1405
8
        opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1406
8
                      "One of the following condition is not met: "
1407
8
                      "2 <= Scup <= min(Lcup, 4079)\n");
1408
1409
8
        if (p_manager_mutex) {
1410
8
            opj_mutex_unlock(p_manager_mutex);
1411
8
        }
1412
8
        return OPJ_FALSE;
1413
8
    }
1414
1415
    // init structures
1416
1.40k
    if (mel_init(&mel, coded_data, lcup, scup) == OPJ_FALSE) {
1417
0
        if (p_manager_mutex) {
1418
0
            opj_mutex_lock(p_manager_mutex);
1419
0
        }
1420
0
        opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1421
0
                      "Incorrect MEL segment sequence.\n");
1422
0
        if (p_manager_mutex) {
1423
0
            opj_mutex_unlock(p_manager_mutex);
1424
0
        }
1425
0
        return OPJ_FALSE;
1426
0
    }
1427
1.40k
    rev_init(&vlc, coded_data, lcup, scup);
1428
1.40k
    frwd_init(&magsgn, coded_data, lcup - scup, 0xFF);
1429
1.40k
    if (num_passes > 1) { // needs to be tested
1430
907
        frwd_init(&sigprop, coded_data + lengths1, (int)lengths2, 0);
1431
907
    }
1432
1.40k
    if (num_passes > 2) {
1433
879
        rev_init_mrp(&magref, coded_data, (int)lengths1, (int)lengths2);
1434
879
    }
1435
1436
    /** State storage
1437
      *  One byte per quad; for 1024 columns, or 512 quads, we need
1438
      *  512 bytes. We are using 2 extra bytes one on the left and one on
1439
      *  the right for convenience.
1440
      *
1441
      *  The MSB bit in each byte is (\sigma^nw | \sigma^n), and the 7 LSBs
1442
      *  contain max(E^nw | E^n)
1443
      */
1444
1445
    // 514 is enough for a block width of 1024, +2 extra
1446
    // here expanded to 528
1447
1.40k
    line_state = (OPJ_UINT8 *)(mbr2 + 132);
1448
1449
    //initial 2 lines
1450
    /////////////////
1451
1.40k
    lsp = line_state;              // point to line state
1452
1.40k
    lsp[0] = 0;                    // for initial row of quad, we set to 0
1453
1.40k
    run = mel_get_run(&mel);    // decode runs of events from MEL bitstrm
1454
    // data represented as runs of 0 events
1455
    // See mel_decode description
1456
1.40k
    qinf[0] = qinf[1] = 0;      // quad info decoded from VLC bitstream
1457
1.40k
    c_q = 0;                    // context for quad q
1458
1.40k
    sp = decoded_data;          // decoded codeblock samples
1459
    // vlc_val;                 // fetched data from VLC bitstream
1460
1461
18.1k
    for (x = 0; x < width; x += 4) { // one iteration per quad pair
1462
16.7k
        OPJ_UINT32 U_q[2]; // u values for the quad pair
1463
16.7k
        OPJ_UINT32 uvlc_mode;
1464
16.7k
        OPJ_UINT32 consumed_bits;
1465
16.7k
        OPJ_UINT32 m_n, v_n;
1466
16.7k
        OPJ_UINT32 ms_val;
1467
16.7k
        OPJ_UINT32 locs;
1468
1469
        // decode VLC
1470
        /////////////
1471
1472
        //first quad
1473
        // Get the head of the VLC bitstream. One fetch is enough for two
1474
        // quads, since the largest VLC code is 7 bits, and maximum number of
1475
        // bits used for u is 8.  Therefore for two quads we need 30 bits
1476
        // (if we include unstuffing, then 32 bits are enough, since we have
1477
        // a maximum of one stuffing per two bytes)
1478
16.7k
        vlc_val = rev_fetch(&vlc);
1479
1480
        //decode VLC using the context c_q and the head of the VLC bitstream
1481
16.7k
        qinf[0] = vlc_tbl0[(c_q << 7) | (vlc_val & 0x7F) ];
1482
1483
16.7k
        if (c_q == 0) { // if zero context, we need to use one MEL event
1484
15.6k
            run -= 2; //the number of 0 events is multiplied by 2, so subtract 2
1485
1486
            // Is the run terminated in 1? if so, use decoded VLC code,
1487
            // otherwise, discard decoded data, since we will decoded again
1488
            // using a different context
1489
15.6k
            qinf[0] = (run == -1) ? qinf[0] : 0;
1490
1491
            // is run -1 or -2? this means a run has been consumed
1492
15.6k
            if (run < 0) {
1493
11.5k
                run = mel_get_run(&mel);    // get another run
1494
11.5k
            }
1495
15.6k
        }
1496
1497
        // prepare context for the next quad; eqn. 1 in ITU T.814
1498
16.7k
        c_q = ((qinf[0] & 0x10) >> 4) | ((qinf[0] & 0xE0) >> 5);
1499
1500
        //remove data from vlc stream (0 bits are removed if qinf is not used)
1501
16.7k
        vlc_val = rev_advance(&vlc, qinf[0] & 0x7);
1502
1503
        //update sigma
1504
        // The update depends on the value of x; consider one OPJ_UINT32
1505
        // if x is 0, 8, 16 and so on, then this line update c locations
1506
        //      nibble (4 bits) number   0 1 2 3 4 5 6 7
1507
        //                         LSB   c c 0 0 0 0 0 0
1508
        //                               c c 0 0 0 0 0 0
1509
        //                               0 0 0 0 0 0 0 0
1510
        //                               0 0 0 0 0 0 0 0
1511
        // if x is 4, 12, 20, then this line update locations c
1512
        //      nibble (4 bits) number   0 1 2 3 4 5 6 7
1513
        //                         LSB   0 0 0 0 c c 0 0
1514
        //                               0 0 0 0 c c 0 0
1515
        //                               0 0 0 0 0 0 0 0
1516
        //                               0 0 0 0 0 0 0 0
1517
16.7k
        *sip |= (((qinf[0] & 0x30) >> 4) | ((qinf[0] & 0xC0) >> 2)) << sip_shift;
1518
1519
        //second quad
1520
16.7k
        qinf[1] = 0;
1521
16.7k
        if (x + 2 < width) { // do not run if codeblock is narrower
1522
            //decode VLC using the context c_q and the head of the VLC bitstream
1523
16.3k
            qinf[1] = vlc_tbl0[(c_q << 7) | (vlc_val & 0x7F)];
1524
1525
            // if context is zero, use one MEL event
1526
16.3k
            if (c_q == 0) { //zero context
1527
13.2k
                run -= 2; //subtract 2, since events number if multiplied by 2
1528
1529
                // if event is 0, discard decoded qinf
1530
13.2k
                qinf[1] = (run == -1) ? qinf[1] : 0;
1531
1532
13.2k
                if (run < 0) { // have we consumed all events in a run
1533
2.13k
                    run = mel_get_run(&mel);    // if yes, then get another run
1534
2.13k
                }
1535
13.2k
            }
1536
1537
            //prepare context for the next quad, eqn. 1 in ITU T.814
1538
16.3k
            c_q = ((qinf[1] & 0x10) >> 4) | ((qinf[1] & 0xE0) >> 5);
1539
1540
            //remove data from vlc stream, if qinf is not used, cwdlen is 0
1541
16.3k
            vlc_val = rev_advance(&vlc, qinf[1] & 0x7);
1542
16.3k
        }
1543
1544
        //update sigma
1545
        // The update depends on the value of x; consider one OPJ_UINT32
1546
        // if x is 0, 8, 16 and so on, then this line update c locations
1547
        //      nibble (4 bits) number   0 1 2 3 4 5 6 7
1548
        //                         LSB   0 0 c c 0 0 0 0
1549
        //                               0 0 c c 0 0 0 0
1550
        //                               0 0 0 0 0 0 0 0
1551
        //                               0 0 0 0 0 0 0 0
1552
        // if x is 4, 12, 20, then this line update locations c
1553
        //      nibble (4 bits) number   0 1 2 3 4 5 6 7
1554
        //                         LSB   0 0 0 0 0 0 c c
1555
        //                               0 0 0 0 0 0 c c
1556
        //                               0 0 0 0 0 0 0 0
1557
        //                               0 0 0 0 0 0 0 0
1558
16.7k
        *sip |= (((qinf[1] & 0x30) | ((qinf[1] & 0xC0) << 2))) << (4 + sip_shift);
1559
1560
16.7k
        sip += x & 0x7 ? 1 : 0; // move sigma pointer to next entry
1561
16.7k
        sip_shift ^= 0x10;      // increment/decrement sip_shift by 16
1562
1563
        // retrieve u
1564
        /////////////
1565
1566
        // uvlc_mode is made up of u_offset bits from the quad pair
1567
16.7k
        uvlc_mode = ((qinf[0] & 0x8) >> 3) | ((qinf[1] & 0x8) >> 2);
1568
16.7k
        if (uvlc_mode == 3) { // if both u_offset are set, get an event from
1569
            // the MEL run of events
1570
48
            run -= 2; //subtract 2, since events number if multiplied by 2
1571
48
            uvlc_mode += (run == -1) ? 1 : 0; //increment uvlc_mode if event is 1
1572
48
            if (run < 0) { // if run is consumed (run is -1 or -2), get another run
1573
33
                run = mel_get_run(&mel);
1574
33
            }
1575
48
        }
1576
        //decode uvlc_mode to get u for both quads
1577
16.7k
        consumed_bits = decode_init_uvlc(vlc_val, uvlc_mode, U_q);
1578
16.7k
        if (U_q[0] > zero_bplanes_p1 || U_q[1] > zero_bplanes_p1) {
1579
0
            if (p_manager_mutex) {
1580
0
                opj_mutex_lock(p_manager_mutex);
1581
0
            }
1582
0
            opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. Decoding "
1583
0
                          "this codeblock is stopped. U_q is larger than zero "
1584
0
                          "bitplanes + 1 \n");
1585
0
            if (p_manager_mutex) {
1586
0
                opj_mutex_unlock(p_manager_mutex);
1587
0
            }
1588
0
            return OPJ_FALSE;
1589
0
        }
1590
1591
        //consume u bits in the VLC code
1592
16.7k
        vlc_val = rev_advance(&vlc, consumed_bits);
1593
1594
        //decode magsgn and update line_state
1595
        /////////////////////////////////////
1596
1597
        //We obtain a mask for the samples locations that needs evaluation
1598
16.7k
        locs = 0xFF;
1599
16.7k
        if (x + 4 > width) {
1600
512
            locs >>= (x + 4 - width) << 1;    // limits width
1601
512
        }
1602
16.7k
        locs = height > 1 ? locs : (locs & 0x55);         // limits height
1603
1604
16.7k
        if ((((qinf[0] & 0xF0) >> 4) | (qinf[1] & 0xF0)) & ~locs) {
1605
2
            if (p_manager_mutex) {
1606
2
                opj_mutex_lock(p_manager_mutex);
1607
2
            }
1608
2
            opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1609
2
                          "VLC code produces significant samples outside "
1610
2
                          "the codeblock area.\n");
1611
2
            if (p_manager_mutex) {
1612
2
                opj_mutex_unlock(p_manager_mutex);
1613
2
            }
1614
2
            return OPJ_FALSE;
1615
2
        }
1616
1617
        //first quad, starting at first sample in quad and moving on
1618
16.7k
        if (qinf[0] & 0x10) { //is it significant? (sigma_n)
1619
123
            OPJ_UINT32 val;
1620
1621
123
            ms_val = frwd_fetch(&magsgn);         //get 32 bits of magsgn data
1622
123
            m_n = U_q[0] - ((qinf[0] >> 12) & 1); //evaluate m_n (number of bits
1623
            // to read from bitstream), using EMB e_k
1624
123
            frwd_advance(&magsgn, m_n);         //consume m_n
1625
123
            val = ms_val << 31;                 //get sign bit
1626
123
            v_n = ms_val & ((1U << m_n) - 1);   //keep only m_n bits
1627
123
            v_n |= ((qinf[0] & 0x100) >> 8) << m_n;  //add EMB e_1 as MSB
1628
123
            v_n |= 1;                                //add center of bin
1629
            //v_n now has 2 * (\mu - 1) + 0.5 with correct sign bit
1630
            //add 2 to make it 2*\mu+0.5, shift it up to missing MSBs
1631
123
            sp[0] = val | ((v_n + 2) << (p - 1));
1632
16.6k
        } else if (locs & 0x1) { // if this is inside the codeblock, set the
1633
16.6k
            sp[0] = 0;           // sample to zero
1634
16.6k
        }
1635
1636
16.7k
        if (qinf[0] & 0x20) { //sigma_n
1637
2.31k
            OPJ_UINT32 val, t;
1638
1639
2.31k
            ms_val = frwd_fetch(&magsgn);         //get 32 bits
1640
2.31k
            m_n = U_q[0] - ((qinf[0] >> 13) & 1); //m_n, uses EMB e_k
1641
2.31k
            frwd_advance(&magsgn, m_n);           //consume m_n
1642
2.31k
            val = ms_val << 31;                   //get sign bit
1643
2.31k
            v_n = ms_val & ((1U << m_n) - 1);     //keep only m_n bits
1644
2.31k
            v_n |= ((qinf[0] & 0x200) >> 9) << m_n; //add EMB e_1
1645
2.31k
            v_n |= 1;                               //bin center
1646
            //v_n now has 2 * (\mu - 1) + 0.5 with correct sign bit
1647
            //add 2 to make it 2*\mu+0.5, shift it up to missing MSBs
1648
2.31k
            sp[stride] = val | ((v_n + 2) << (p - 1));
1649
1650
            //update line_state: bit 7 (\sigma^N), and E^N
1651
2.31k
            t = lsp[0] & 0x7F;       // keep E^NW
1652
2.31k
            v_n = 32 - count_leading_zeros(v_n);
1653
2.31k
            lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n)); //max(E^NW, E^N) | s
1654
14.4k
        } else if (locs & 0x2) { // if this is inside the codeblock, set the
1655
14.4k
            sp[stride] = 0;      // sample to zero
1656
14.4k
        }
1657
1658
16.7k
        ++lsp; // move to next quad information
1659
16.7k
        ++sp;  // move to next column of samples
1660
1661
        //this is similar to the above two samples
1662
16.7k
        if (qinf[0] & 0x40) {
1663
1.19k
            OPJ_UINT32 val;
1664
1665
1.19k
            ms_val = frwd_fetch(&magsgn);
1666
1.19k
            m_n = U_q[0] - ((qinf[0] >> 14) & 1);
1667
1.19k
            frwd_advance(&magsgn, m_n);
1668
1.19k
            val = ms_val << 31;
1669
1.19k
            v_n = ms_val & ((1U << m_n) - 1);
1670
1.19k
            v_n |= (((qinf[0] & 0x400) >> 10) << m_n);
1671
1.19k
            v_n |= 1;
1672
1.19k
            sp[0] = val | ((v_n + 2) << (p - 1));
1673
15.5k
        } else if (locs & 0x4) {
1674
15.4k
            sp[0] = 0;
1675
15.4k
        }
1676
1677
16.7k
        lsp[0] = 0;
1678
16.7k
        if (qinf[0] & 0x80) {
1679
1.09k
            OPJ_UINT32 val;
1680
1.09k
            ms_val = frwd_fetch(&magsgn);
1681
1.09k
            m_n = U_q[0] - ((qinf[0] >> 15) & 1); //m_n
1682
1.09k
            frwd_advance(&magsgn, m_n);
1683
1.09k
            val = ms_val << 31;
1684
1.09k
            v_n = ms_val & ((1U << m_n) - 1);
1685
1.09k
            v_n |= ((qinf[0] & 0x800) >> 11) << m_n;
1686
1.09k
            v_n |= 1; //center of bin
1687
1.09k
            sp[stride] = val | ((v_n + 2) << (p - 1));
1688
1689
            //line_state: bit 7 (\sigma^NW), and E^NW for next quad
1690
1.09k
            lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
1691
15.6k
        } else if (locs & 0x8) { //if outside set to 0
1692
15.5k
            sp[stride] = 0;
1693
15.5k
        }
1694
1695
16.7k
        ++sp; //move to next column
1696
1697
        //second quad
1698
16.7k
        if (qinf[1] & 0x10) {
1699
58
            OPJ_UINT32 val;
1700
1701
58
            ms_val = frwd_fetch(&magsgn);
1702
58
            m_n = U_q[1] - ((qinf[1] >> 12) & 1); //m_n
1703
58
            frwd_advance(&magsgn, m_n);
1704
58
            val = ms_val << 31;
1705
58
            v_n = ms_val & ((1U << m_n) - 1);
1706
58
            v_n |= (((qinf[1] & 0x100) >> 8) << m_n);
1707
58
            v_n |= 1;
1708
58
            sp[0] = val | ((v_n + 2) << (p - 1));
1709
16.6k
        } else if (locs & 0x10) {
1710
16.2k
            sp[0] = 0;
1711
16.2k
        }
1712
1713
16.7k
        if (qinf[1] & 0x20) {
1714
1.10k
            OPJ_UINT32 val, t;
1715
1716
1.10k
            ms_val = frwd_fetch(&magsgn);
1717
1.10k
            m_n = U_q[1] - ((qinf[1] >> 13) & 1); //m_n
1718
1.10k
            frwd_advance(&magsgn, m_n);
1719
1.10k
            val = ms_val << 31;
1720
1.10k
            v_n = ms_val & ((1U << m_n) - 1);
1721
1.10k
            v_n |= (((qinf[1] & 0x200) >> 9) << m_n);
1722
1.10k
            v_n |= 1;
1723
1.10k
            sp[stride] = val | ((v_n + 2) << (p - 1));
1724
1725
            //update line_state: bit 7 (\sigma^N), and E^N
1726
1.10k
            t = lsp[0] & 0x7F;            //E^NW
1727
1.10k
            v_n = 32 - count_leading_zeros(v_n);     //E^N
1728
1.10k
            lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n)); //max(E^NW, E^N) | s
1729
15.6k
        } else if (locs & 0x20) {
1730
15.2k
            sp[stride] = 0;    //no need to update line_state
1731
15.2k
        }
1732
1733
16.7k
        ++lsp; //move line state to next quad
1734
16.7k
        ++sp;  //move to next sample
1735
1736
16.7k
        if (qinf[1] & 0x40) {
1737
58
            OPJ_UINT32 val;
1738
1739
58
            ms_val = frwd_fetch(&magsgn);
1740
58
            m_n = U_q[1] - ((qinf[1] >> 14) & 1); //m_n
1741
58
            frwd_advance(&magsgn, m_n);
1742
58
            val = ms_val << 31;
1743
58
            v_n = ms_val & ((1U << m_n) - 1);
1744
58
            v_n |= (((qinf[1] & 0x400) >> 10) << m_n);
1745
58
            v_n |= 1;
1746
58
            sp[0] = val | ((v_n + 2) << (p - 1));
1747
16.6k
        } else if (locs & 0x40) {
1748
16.1k
            sp[0] = 0;
1749
16.1k
        }
1750
1751
16.7k
        lsp[0] = 0;
1752
16.7k
        if (qinf[1] & 0x80) {
1753
68
            OPJ_UINT32 val;
1754
1755
68
            ms_val = frwd_fetch(&magsgn);
1756
68
            m_n = U_q[1] - ((qinf[1] >> 15) & 1); //m_n
1757
68
            frwd_advance(&magsgn, m_n);
1758
68
            val = ms_val << 31;
1759
68
            v_n = ms_val & ((1U << m_n) - 1);
1760
68
            v_n |= (((qinf[1] & 0x800) >> 11) << m_n);
1761
68
            v_n |= 1; //center of bin
1762
68
            sp[stride] = val | ((v_n + 2) << (p - 1));
1763
1764
            //line_state: bit 7 (\sigma^NW), and E^NW for next quad
1765
68
            lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
1766
16.6k
        } else if (locs & 0x80) {
1767
16.1k
            sp[stride] = 0;
1768
16.1k
        }
1769
1770
16.7k
        ++sp;
1771
16.7k
    }
1772
1773
    //non-initial lines
1774
    //////////////////////////
1775
10.8k
    for (y = 2; y < height; /*done at the end of loop*/) {
1776
9.44k
        OPJ_UINT32 *sip;
1777
9.44k
        OPJ_UINT8 ls0;
1778
9.44k
        OPJ_INT32 x;
1779
1780
9.44k
        sip_shift ^= 0x2;  // shift sigma to the upper half od the nibble
1781
9.44k
        sip_shift &= 0xFFFFFFEFU; //move back to 0 (it might have been at 0x10)
1782
9.44k
        sip = y & 0x4 ? sigma2 : sigma1; //choose sigma array
1783
1784
9.44k
        lsp = line_state;
1785
9.44k
        ls0 = lsp[0];                   // read the line state value
1786
9.44k
        lsp[0] = 0;                     // and set it to zero
1787
9.44k
        sp = decoded_data + y * stride; // generated samples
1788
9.44k
        c_q = 0;                        // context
1789
22.0k
        for (x = 0; x < width; x += 4) {
1790
12.6k
            OPJ_UINT32 U_q[2];
1791
12.6k
            OPJ_UINT32 uvlc_mode, consumed_bits;
1792
12.6k
            OPJ_UINT32 m_n, v_n;
1793
12.6k
            OPJ_UINT32 ms_val;
1794
12.6k
            OPJ_UINT32 locs;
1795
1796
            // decode vlc
1797
            /////////////
1798
1799
            //first quad
1800
            // get context, eqn. 2 ITU T.814
1801
            // c_q has \sigma^W | \sigma^SW
1802
12.6k
            c_q |= (ls0 >> 7);          //\sigma^NW | \sigma^N
1803
12.6k
            c_q |= (lsp[1] >> 5) & 0x4; //\sigma^NE | \sigma^NF
1804
1805
            //the following is very similar to previous code, so please refer to
1806
            // that
1807
12.6k
            vlc_val = rev_fetch(&vlc);
1808
12.6k
            qinf[0] = vlc_tbl1[(c_q << 7) | (vlc_val & 0x7F)];
1809
12.6k
            if (c_q == 0) { //zero context
1810
10.5k
                run -= 2;
1811
10.5k
                qinf[0] = (run == -1) ? qinf[0] : 0;
1812
10.5k
                if (run < 0) {
1813
4.34k
                    run = mel_get_run(&mel);
1814
4.34k
                }
1815
10.5k
            }
1816
            //prepare context for the next quad, \sigma^W | \sigma^SW
1817
12.6k
            c_q = ((qinf[0] & 0x40) >> 5) | ((qinf[0] & 0x80) >> 6);
1818
1819
            //remove data from vlc stream
1820
12.6k
            vlc_val = rev_advance(&vlc, qinf[0] & 0x7);
1821
1822
            //update sigma
1823
            // The update depends on the value of x and y; consider one OPJ_UINT32
1824
            // if x is 0, 8, 16 and so on, and y is 2, 6, etc., then this
1825
            // line update c locations
1826
            //      nibble (4 bits) number   0 1 2 3 4 5 6 7
1827
            //                         LSB   0 0 0 0 0 0 0 0
1828
            //                               0 0 0 0 0 0 0 0
1829
            //                               c c 0 0 0 0 0 0
1830
            //                               c c 0 0 0 0 0 0
1831
12.6k
            *sip |= (((qinf[0] & 0x30) >> 4) | ((qinf[0] & 0xC0) >> 2)) << sip_shift;
1832
1833
            //second quad
1834
12.6k
            qinf[1] = 0;
1835
12.6k
            if (x + 2 < width) {
1836
3.40k
                c_q |= (lsp[1] >> 7);
1837
3.40k
                c_q |= (lsp[2] >> 5) & 0x4;
1838
3.40k
                qinf[1] = vlc_tbl1[(c_q << 7) | (vlc_val & 0x7F)];
1839
3.40k
                if (c_q == 0) { //zero context
1840
1.54k
                    run -= 2;
1841
1.54k
                    qinf[1] = (run == -1) ? qinf[1] : 0;
1842
1.54k
                    if (run < 0) {
1843
596
                        run = mel_get_run(&mel);
1844
596
                    }
1845
1.54k
                }
1846
                //prepare context for the next quad
1847
3.40k
                c_q = ((qinf[1] & 0x40) >> 5) | ((qinf[1] & 0x80) >> 6);
1848
                //remove data from vlc stream
1849
3.40k
                vlc_val = rev_advance(&vlc, qinf[1] & 0x7);
1850
3.40k
            }
1851
1852
            //update sigma
1853
12.6k
            *sip |= (((qinf[1] & 0x30) | ((qinf[1] & 0xC0) << 2))) << (4 + sip_shift);
1854
1855
12.6k
            sip += x & 0x7 ? 1 : 0;
1856
12.6k
            sip_shift ^= 0x10;
1857
1858
            //retrieve u
1859
            ////////////
1860
12.6k
            uvlc_mode = ((qinf[0] & 0x8) >> 3) | ((qinf[1] & 0x8) >> 2);
1861
12.6k
            consumed_bits = decode_noninit_uvlc(vlc_val, uvlc_mode, U_q);
1862
12.6k
            vlc_val = rev_advance(&vlc, consumed_bits);
1863
1864
            //calculate E^max and add it to U_q, eqns 5 and 6 in ITU T.814
1865
12.6k
            if ((qinf[0] & 0xF0) & ((qinf[0] & 0xF0) - 1)) { // is \gamma_q 1?
1866
1.20k
                OPJ_UINT32 E = (ls0 & 0x7Fu);
1867
1.20k
                E = E > (lsp[1] & 0x7Fu) ? E : (lsp[1] & 0x7Fu); //max(E, E^NE, E^NF)
1868
                //since U_q already has u_q + 1, we subtract 2 instead of 1
1869
1.20k
                U_q[0] += E > 2 ? E - 2 : 0;
1870
1.20k
            }
1871
1872
12.6k
            if ((qinf[1] & 0xF0) & ((qinf[1] & 0xF0) - 1)) { //is \gamma_q 1?
1873
1.04k
                OPJ_UINT32 E = (lsp[1] & 0x7Fu);
1874
1.04k
                E = E > (lsp[2] & 0x7Fu) ? E : (lsp[2] & 0x7Fu); //max(E, E^NE, E^NF)
1875
                //since U_q already has u_q + 1, we subtract 2 instead of 1
1876
1.04k
                U_q[1] += E > 2 ? E - 2 : 0;
1877
1.04k
            }
1878
1879
12.6k
            if (U_q[0] > zero_bplanes_p1 || U_q[1] > zero_bplanes_p1) {
1880
2
                if (p_manager_mutex) {
1881
2
                    opj_mutex_lock(p_manager_mutex);
1882
2
                }
1883
2
                opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1884
2
                              "Decoding this codeblock is stopped. U_q is"
1885
2
                              "larger than bitplanes + 1 \n");
1886
2
                if (p_manager_mutex) {
1887
2
                    opj_mutex_unlock(p_manager_mutex);
1888
2
                }
1889
2
                return OPJ_FALSE;
1890
2
            }
1891
1892
12.6k
            ls0 = lsp[2]; //for next double quad
1893
12.6k
            lsp[1] = lsp[2] = 0;
1894
1895
            //decode magsgn and update line_state
1896
            /////////////////////////////////////
1897
1898
            //locations where samples need update
1899
12.6k
            locs = 0xFF;
1900
12.6k
            if (x + 4 > width) {
1901
9.21k
                locs >>= (x + 4 - width) << 1;
1902
9.21k
            }
1903
12.6k
            locs = y + 2 <= height ? locs : (locs & 0x55);
1904
1905
12.6k
            if ((((qinf[0] & 0xF0) >> 4) | (qinf[1] & 0xF0)) & ~locs) {
1906
0
                if (p_manager_mutex) {
1907
0
                    opj_mutex_lock(p_manager_mutex);
1908
0
                }
1909
0
                opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
1910
0
                              "VLC code produces significant samples outside "
1911
0
                              "the codeblock area.\n");
1912
0
                if (p_manager_mutex) {
1913
0
                    opj_mutex_unlock(p_manager_mutex);
1914
0
                }
1915
0
                return OPJ_FALSE;
1916
0
            }
1917
1918
1919
1920
12.6k
            if (qinf[0] & 0x10) { //sigma_n
1921
2.29k
                OPJ_UINT32 val;
1922
1923
2.29k
                ms_val = frwd_fetch(&magsgn);
1924
2.29k
                m_n = U_q[0] - ((qinf[0] >> 12) & 1); //m_n
1925
2.29k
                frwd_advance(&magsgn, m_n);
1926
2.29k
                val = ms_val << 31;
1927
2.29k
                v_n = ms_val & ((1U << m_n) - 1);
1928
2.29k
                v_n |= ((qinf[0] & 0x100) >> 8) << m_n;
1929
2.29k
                v_n |= 1; //center of bin
1930
2.29k
                sp[0] = val | ((v_n + 2) << (p - 1));
1931
10.3k
            } else if (locs & 0x1) {
1932
10.3k
                sp[0] = 0;
1933
10.3k
            }
1934
1935
12.6k
            if (qinf[0] & 0x20) { //sigma_n
1936
890
                OPJ_UINT32 val, t;
1937
1938
890
                ms_val = frwd_fetch(&magsgn);
1939
890
                m_n = U_q[0] - ((qinf[0] >> 13) & 1); //m_n
1940
890
                frwd_advance(&magsgn, m_n);
1941
890
                val = ms_val << 31;
1942
890
                v_n = ms_val & ((1U << m_n) - 1);
1943
890
                v_n |= ((qinf[0] & 0x200) >> 9) << m_n;
1944
890
                v_n |= 1; //center of bin
1945
890
                sp[stride] = val | ((v_n + 2) << (p - 1));
1946
1947
                //update line_state: bit 7 (\sigma^N), and E^N
1948
890
                t = lsp[0] & 0x7F;          //E^NW
1949
890
                v_n = 32 - count_leading_zeros(v_n);
1950
890
                lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n));
1951
11.7k
            } else if (locs & 0x2) {
1952
11.2k
                sp[stride] = 0;    //no need to update line_state
1953
11.2k
            }
1954
1955
12.6k
            ++lsp;
1956
12.6k
            ++sp;
1957
1958
12.6k
            if (qinf[0] & 0x40) { //sigma_n
1959
1.11k
                OPJ_UINT32 val;
1960
1961
1.11k
                ms_val = frwd_fetch(&magsgn);
1962
1.11k
                m_n = U_q[0] - ((qinf[0] >> 14) & 1); //m_n
1963
1.11k
                frwd_advance(&magsgn, m_n);
1964
1.11k
                val = ms_val << 31;
1965
1.11k
                v_n = ms_val & ((1U << m_n) - 1);
1966
1.11k
                v_n |= (((qinf[0] & 0x400) >> 10) << m_n);
1967
1.11k
                v_n |= 1;                            //center of bin
1968
1.11k
                sp[0] = val | ((v_n + 2) << (p - 1));
1969
11.5k
            } else if (locs & 0x4) {
1970
11.2k
                sp[0] = 0;
1971
11.2k
            }
1972
1973
12.6k
            if (qinf[0] & 0x80) { //sigma_n
1974
882
                OPJ_UINT32 val;
1975
1976
882
                ms_val = frwd_fetch(&magsgn);
1977
882
                m_n = U_q[0] - ((qinf[0] >> 15) & 1); //m_n
1978
882
                frwd_advance(&magsgn, m_n);
1979
882
                val = ms_val << 31;
1980
882
                v_n = ms_val & ((1U << m_n) - 1);
1981
882
                v_n |= ((qinf[0] & 0x800) >> 11) << m_n;
1982
882
                v_n |= 1; //center of bin
1983
882
                sp[stride] = val | ((v_n + 2) << (p - 1));
1984
1985
                //update line_state: bit 7 (\sigma^NW), and E^NW for next quad
1986
882
                lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
1987
11.7k
            } else if (locs & 0x8) {
1988
11.0k
                sp[stride] = 0;
1989
11.0k
            }
1990
1991
12.6k
            ++sp;
1992
1993
12.6k
            if (qinf[1] & 0x10) { //sigma_n
1994
1.15k
                OPJ_UINT32 val;
1995
1996
1.15k
                ms_val = frwd_fetch(&magsgn);
1997
1.15k
                m_n = U_q[1] - ((qinf[1] >> 12) & 1); //m_n
1998
1.15k
                frwd_advance(&magsgn, m_n);
1999
1.15k
                val = ms_val << 31;
2000
1.15k
                v_n = ms_val & ((1U << m_n) - 1);
2001
1.15k
                v_n |= (((qinf[1] & 0x100) >> 8) << m_n);
2002
1.15k
                v_n |= 1;                            //center of bin
2003
1.15k
                sp[0] = val | ((v_n + 2) << (p - 1));
2004
11.4k
            } else if (locs & 0x10) {
2005
2.24k
                sp[0] = 0;
2006
2.24k
            }
2007
2008
12.6k
            if (qinf[1] & 0x20) { //sigma_n
2009
654
                OPJ_UINT32 val, t;
2010
2011
654
                ms_val = frwd_fetch(&magsgn);
2012
654
                m_n = U_q[1] - ((qinf[1] >> 13) & 1); //m_n
2013
654
                frwd_advance(&magsgn, m_n);
2014
654
                val = ms_val << 31;
2015
654
                v_n = ms_val & ((1U << m_n) - 1);
2016
654
                v_n |= (((qinf[1] & 0x200) >> 9) << m_n);
2017
654
                v_n |= 1; //center of bin
2018
654
                sp[stride] = val | ((v_n + 2) << (p - 1));
2019
2020
                //update line_state: bit 7 (\sigma^N), and E^N
2021
654
                t = lsp[0] & 0x7F;          //E^NW
2022
654
                v_n = 32 - count_leading_zeros(v_n);
2023
654
                lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n));
2024
11.9k
            } else if (locs & 0x20) {
2025
2.67k
                sp[stride] = 0;    //no need to update line_state
2026
2.67k
            }
2027
2028
12.6k
            ++lsp;
2029
12.6k
            ++sp;
2030
2031
12.6k
            if (qinf[1] & 0x40) { //sigma_n
2032
736
                OPJ_UINT32 val;
2033
2034
736
                ms_val = frwd_fetch(&magsgn);
2035
736
                m_n = U_q[1] - ((qinf[1] >> 14) & 1); //m_n
2036
736
                frwd_advance(&magsgn, m_n);
2037
736
                val = ms_val << 31;
2038
736
                v_n = ms_val & ((1U << m_n) - 1);
2039
736
                v_n |= (((qinf[1] & 0x400) >> 10) << m_n);
2040
736
                v_n |= 1;                            //center of bin
2041
736
                sp[0] = val | ((v_n + 2) << (p - 1));
2042
11.8k
            } else if (locs & 0x40) {
2043
2.66k
                sp[0] = 0;
2044
2.66k
            }
2045
2046
12.6k
            if (qinf[1] & 0x80) { //sigma_n
2047
872
                OPJ_UINT32 val;
2048
2049
872
                ms_val = frwd_fetch(&magsgn);
2050
872
                m_n = U_q[1] - ((qinf[1] >> 15) & 1); //m_n
2051
872
                frwd_advance(&magsgn, m_n);
2052
872
                val = ms_val << 31;
2053
872
                v_n = ms_val & ((1U << m_n) - 1);
2054
872
                v_n |= (((qinf[1] & 0x800) >> 11) << m_n);
2055
872
                v_n |= 1; //center of bin
2056
872
                sp[stride] = val | ((v_n + 2) << (p - 1));
2057
2058
                //update line_state: bit 7 (\sigma^NW), and E^NW for next quad
2059
872
                lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
2060
11.7k
            } else if (locs & 0x80) {
2061
2.45k
                sp[stride] = 0;
2062
2.45k
            }
2063
2064
12.6k
            ++sp;
2065
12.6k
        }
2066
2067
9.44k
        y += 2;
2068
9.44k
        if (num_passes > 1 && (y & 3) == 0) { //executed at multiples of 4
2069
            // This is for SPP and potentially MRP
2070
2071
4.76k
            if (num_passes > 2) { //do MRP
2072
                // select the current stripe
2073
4.37k
                OPJ_UINT32 *cur_sig = y & 0x4 ? sigma1 : sigma2;
2074
                // the address of the data that needs updating
2075
4.37k
                OPJ_UINT32 *dpp = decoded_data + (y - 4) * stride;
2076
4.37k
                OPJ_UINT32 half = 1u << (p - 2); // half the center of the bin
2077
4.37k
                OPJ_INT32 i;
2078
9.41k
                for (i = 0; i < width; i += 8) {
2079
                    //Process one entry from sigma array at a time
2080
                    // Each nibble (4 bits) in the sigma array represents 4 rows,
2081
                    // and the 32 bits contain 8 columns
2082
5.03k
                    OPJ_UINT32 cwd = rev_fetch_mrp(&magref); // get 32 bit data
2083
5.03k
                    OPJ_UINT32 sig = *cur_sig++; // 32 bit that will be processed now
2084
5.03k
                    OPJ_UINT32 col_mask = 0xFu;  // a mask for a column in sig
2085
5.03k
                    OPJ_UINT32 *dp = dpp + i;    // next column in decode samples
2086
5.03k
                    if (sig) { // if any of the 32 bits are set
2087
1.46k
                        int j;
2088
13.1k
                        for (j = 0; j < 8; ++j, dp++) { //one column at a time
2089
11.7k
                            if (sig & col_mask) { // lowest nibble
2090
4.34k
                                OPJ_UINT32 sample_mask = 0x11111111u & col_mask; //LSB
2091
2092
4.34k
                                if (sig & sample_mask) { //if LSB is set
2093
2.64k
                                    OPJ_UINT32 sym;
2094
2095
2.64k
                                    assert(dp[0] != 0); // decoded value cannot be zero
2096
2.64k
                                    sym = cwd & 1; // get it value
2097
                                    // remove center of bin if sym is 0
2098
2.64k
                                    dp[0] ^= (1 - sym) << (p - 1);
2099
2.64k
                                    dp[0] |= half;      // put half the center of bin
2100
2.64k
                                    cwd >>= 1;          //consume word
2101
2.64k
                                }
2102
4.34k
                                sample_mask += sample_mask; //next row
2103
2104
4.34k
                                if (sig & sample_mask) {
2105
1.92k
                                    OPJ_UINT32 sym;
2106
2107
1.92k
                                    assert(dp[stride] != 0);
2108
1.92k
                                    sym = cwd & 1;
2109
1.92k
                                    dp[stride] ^= (1 - sym) << (p - 1);
2110
1.92k
                                    dp[stride] |= half;
2111
1.92k
                                    cwd >>= 1;
2112
1.92k
                                }
2113
4.34k
                                sample_mask += sample_mask;
2114
2115
4.34k
                                if (sig & sample_mask) {
2116
2.53k
                                    OPJ_UINT32 sym;
2117
2118
2.53k
                                    assert(dp[2 * stride] != 0);
2119
2.53k
                                    sym = cwd & 1;
2120
2.53k
                                    dp[2 * stride] ^= (1 - sym) << (p - 1);
2121
2.53k
                                    dp[2 * stride] |= half;
2122
2.53k
                                    cwd >>= 1;
2123
2.53k
                                }
2124
4.34k
                                sample_mask += sample_mask;
2125
2126
4.34k
                                if (sig & sample_mask) {
2127
1.64k
                                    OPJ_UINT32 sym;
2128
2129
1.64k
                                    assert(dp[3 * stride] != 0);
2130
1.64k
                                    sym = cwd & 1;
2131
1.64k
                                    dp[3 * stride] ^= (1 - sym) << (p - 1);
2132
1.64k
                                    dp[3 * stride] |= half;
2133
1.64k
                                    cwd >>= 1;
2134
1.64k
                                }
2135
4.34k
                                sample_mask += sample_mask;
2136
4.34k
                            }
2137
11.7k
                            col_mask <<= 4; //next column
2138
11.7k
                        }
2139
1.46k
                    }
2140
                    // consume data according to the number of bits set
2141
5.03k
                    rev_advance_mrp(&magref, population_count(sig));
2142
5.03k
                }
2143
4.37k
            }
2144
2145
4.76k
            if (y >= 4) { // update mbr array at the end of each stripe
2146
                //generate mbr corresponding to a stripe
2147
4.76k
                OPJ_UINT32 *sig = y & 0x4 ? sigma1 : sigma2;
2148
4.76k
                OPJ_UINT32 *mbr = y & 0x4 ? mbr1 : mbr2;
2149
2150
                //data is processed in patches of 8 columns, each
2151
                // each 32 bits in sigma1 or mbr1 represent 4 rows
2152
2153
                //integrate horizontally
2154
4.76k
                OPJ_UINT32 prev = 0; // previous columns
2155
4.76k
                OPJ_INT32 i;
2156
10.2k
                for (i = 0; i < width; i += 8, mbr++, sig++) {
2157
5.53k
                    OPJ_UINT32 t, z;
2158
2159
5.53k
                    mbr[0] = sig[0];         //start with significant samples
2160
5.53k
                    mbr[0] |= prev >> 28;    //for first column, left neighbors
2161
5.53k
                    mbr[0] |= sig[0] << 4;   //left neighbors
2162
5.53k
                    mbr[0] |= sig[0] >> 4;   //right neighbors
2163
5.53k
                    mbr[0] |= sig[1] << 28;  //for last column, right neighbors
2164
5.53k
                    prev = sig[0];           // for next group of columns
2165
2166
                    //integrate vertically
2167
5.53k
                    t = mbr[0], z = mbr[0];
2168
5.53k
                    z |= (t & 0x77777777) << 1; //above neighbors
2169
5.53k
                    z |= (t & 0xEEEEEEEE) >> 1; //below neighbors
2170
5.53k
                    mbr[0] = z & ~sig[0]; //remove already significance samples
2171
5.53k
                }
2172
4.76k
            }
2173
2174
4.76k
            if (y >= 8) { //wait until 8 rows has been processed
2175
4.40k
                OPJ_UINT32 *cur_sig, *cur_mbr, *nxt_sig, *nxt_mbr;
2176
4.40k
                OPJ_UINT32 prev;
2177
4.40k
                OPJ_UINT32 val;
2178
4.40k
                OPJ_INT32 i;
2179
2180
                // add membership from the next stripe, obtained above
2181
4.40k
                cur_sig = y & 0x4 ? sigma2 : sigma1;
2182
4.40k
                cur_mbr = y & 0x4 ? mbr2 : mbr1;
2183
4.40k
                nxt_sig = y & 0x4 ? sigma1 : sigma2;  //future samples
2184
4.40k
                prev = 0; // the columns before these group of 8 columns
2185
9.49k
                for (i = 0; i < width; i += 8, cur_mbr++, cur_sig++, nxt_sig++) {
2186
5.09k
                    OPJ_UINT32 t = nxt_sig[0];
2187
5.09k
                    t |= prev >> 28;        //for first column, left neighbors
2188
5.09k
                    t |= nxt_sig[0] << 4;   //left neighbors
2189
5.09k
                    t |= nxt_sig[0] >> 4;   //right neighbors
2190
5.09k
                    t |= nxt_sig[1] << 28;  //for last column, right neighbors
2191
5.09k
                    prev = nxt_sig[0];      // for next group of columns
2192
2193
5.09k
                    if (!stripe_causal) {
2194
4.92k
                        cur_mbr[0] |= (t & 0x11111111u) << 3; //propagate up to cur_mbr
2195
4.92k
                    }
2196
5.09k
                    cur_mbr[0] &= ~cur_sig[0]; //remove already significance samples
2197
5.09k
                }
2198
2199
                //find new locations and get signs
2200
4.40k
                cur_sig = y & 0x4 ? sigma2 : sigma1;
2201
4.40k
                cur_mbr = y & 0x4 ? mbr2 : mbr1;
2202
4.40k
                nxt_sig = y & 0x4 ? sigma1 : sigma2; //future samples
2203
4.40k
                nxt_mbr = y & 0x4 ? mbr1 : mbr2;     //future samples
2204
4.40k
                val = 3u << (p - 2); // sample values for newly discovered
2205
                // significant samples including the bin center
2206
9.49k
                for (i = 0; i < width;
2207
5.09k
                        i += 8, cur_sig++, cur_mbr++, nxt_sig++, nxt_mbr++) {
2208
5.09k
                    OPJ_UINT32 ux, tx;
2209
5.09k
                    OPJ_UINT32 mbr = *cur_mbr;
2210
5.09k
                    OPJ_UINT32 new_sig = 0;
2211
5.09k
                    if (mbr) { //are there any samples that might be significant
2212
1.76k
                        OPJ_INT32 n;
2213
5.30k
                        for (n = 0; n < 8; n += 4) {
2214
3.53k
                            OPJ_UINT32 col_mask;
2215
3.53k
                            OPJ_UINT32 inv_sig;
2216
3.53k
                            OPJ_INT32 end;
2217
3.53k
                            OPJ_INT32 j;
2218
2219
3.53k
                            OPJ_UINT32 cwd = frwd_fetch(&sigprop); //get 32 bits
2220
3.53k
                            OPJ_UINT32 cnt = 0;
2221
2222
3.53k
                            OPJ_UINT32 *dp = decoded_data + (y - 8) * stride;
2223
3.53k
                            dp += i + n; //address for decoded samples
2224
2225
3.53k
                            col_mask = 0xFu << (4 * n); //a mask to select a column
2226
2227
3.53k
                            inv_sig = ~cur_sig[0]; // insignificant samples
2228
2229
                            //find the last sample we operate on
2230
3.53k
                            end = n + 4 + i < width ? n + 4 : width - i;
2231
2232
11.1k
                            for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
2233
7.59k
                                OPJ_UINT32 sample_mask;
2234
2235
7.59k
                                if ((col_mask & mbr) == 0) { //no samples need checking
2236
735
                                    continue;
2237
735
                                }
2238
2239
                                //scan mbr to find a new significant sample
2240
6.85k
                                sample_mask = 0x11111111u & col_mask; // LSB
2241
6.85k
                                if (mbr & sample_mask) {
2242
4.26k
                                    assert(dp[0] == 0); // the sample must have been 0
2243
4.26k
                                    if (cwd & 1) { //if this sample has become significant
2244
                                        // must propagate it to nearby samples
2245
1.15k
                                        OPJ_UINT32 t;
2246
1.15k
                                        new_sig |= sample_mask;  // new significant samples
2247
1.15k
                                        t = 0x32u << (j * 4);// propagation to neighbors
2248
1.15k
                                        mbr |= t & inv_sig; //remove already significant samples
2249
1.15k
                                    }
2250
4.26k
                                    cwd >>= 1;
2251
4.26k
                                    ++cnt; //consume bit and increment number of
2252
                                    //consumed bits
2253
4.26k
                                }
2254
2255
6.85k
                                sample_mask += sample_mask;  // next row
2256
6.85k
                                if (mbr & sample_mask) {
2257
5.11k
                                    assert(dp[stride] == 0);
2258
5.11k
                                    if (cwd & 1) {
2259
1.39k
                                        OPJ_UINT32 t;
2260
1.39k
                                        new_sig |= sample_mask;
2261
1.39k
                                        t = 0x74u << (j * 4);
2262
1.39k
                                        mbr |= t & inv_sig;
2263
1.39k
                                    }
2264
5.11k
                                    cwd >>= 1;
2265
5.11k
                                    ++cnt;
2266
5.11k
                                }
2267
2268
6.85k
                                sample_mask += sample_mask;
2269
6.85k
                                if (mbr & sample_mask) {
2270
4.35k
                                    assert(dp[2 * stride] == 0);
2271
4.35k
                                    if (cwd & 1) {
2272
1.57k
                                        OPJ_UINT32 t;
2273
1.57k
                                        new_sig |= sample_mask;
2274
1.57k
                                        t = 0xE8u << (j * 4);
2275
1.57k
                                        mbr |= t & inv_sig;
2276
1.57k
                                    }
2277
4.35k
                                    cwd >>= 1;
2278
4.35k
                                    ++cnt;
2279
4.35k
                                }
2280
2281
6.85k
                                sample_mask += sample_mask;
2282
6.85k
                                if (mbr & sample_mask) {
2283
4.99k
                                    assert(dp[3 * stride] == 0);
2284
4.99k
                                    if (cwd & 1) {
2285
1.20k
                                        OPJ_UINT32 t;
2286
1.20k
                                        new_sig |= sample_mask;
2287
1.20k
                                        t = 0xC0u << (j * 4);
2288
1.20k
                                        mbr |= t & inv_sig;
2289
1.20k
                                    }
2290
4.99k
                                    cwd >>= 1;
2291
4.99k
                                    ++cnt;
2292
4.99k
                                }
2293
6.85k
                            }
2294
2295
                            //obtain signs here
2296
3.53k
                            if (new_sig & (0xFFFFu << (4 * n))) { //if any
2297
1.28k
                                OPJ_UINT32 col_mask;
2298
1.28k
                                OPJ_INT32 j;
2299
1.28k
                                OPJ_UINT32 *dp = decoded_data + (y - 8) * stride;
2300
1.28k
                                dp += i + n; // decoded samples address
2301
1.28k
                                col_mask = 0xFu << (4 * n); //mask to select a column
2302
2303
4.73k
                                for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
2304
3.45k
                                    OPJ_UINT32 sample_mask;
2305
2306
3.45k
                                    if ((col_mask & new_sig) == 0) { //if non is significant
2307
826
                                        continue;
2308
826
                                    }
2309
2310
                                    //scan 4 signs
2311
2.63k
                                    sample_mask = 0x11111111u & col_mask;
2312
2.63k
                                    if (new_sig & sample_mask) {
2313
1.15k
                                        assert(dp[0] == 0);
2314
1.15k
                                        dp[0] |= ((cwd & 1) << 31) | val; //put value and sign
2315
1.15k
                                        cwd >>= 1;
2316
1.15k
                                        ++cnt; //consume bit and increment number
2317
                                        //of consumed bits
2318
1.15k
                                    }
2319
2320
2.63k
                                    sample_mask += sample_mask;
2321
2.63k
                                    if (new_sig & sample_mask) {
2322
1.39k
                                        assert(dp[stride] == 0);
2323
1.39k
                                        dp[stride] |= ((cwd & 1) << 31) | val;
2324
1.39k
                                        cwd >>= 1;
2325
1.39k
                                        ++cnt;
2326
1.39k
                                    }
2327
2328
2.63k
                                    sample_mask += sample_mask;
2329
2.63k
                                    if (new_sig & sample_mask) {
2330
1.57k
                                        assert(dp[2 * stride] == 0);
2331
1.57k
                                        dp[2 * stride] |= ((cwd & 1) << 31) | val;
2332
1.57k
                                        cwd >>= 1;
2333
1.57k
                                        ++cnt;
2334
1.57k
                                    }
2335
2336
2.63k
                                    sample_mask += sample_mask;
2337
2.63k
                                    if (new_sig & sample_mask) {
2338
1.20k
                                        assert(dp[3 * stride] == 0);
2339
1.20k
                                        dp[3 * stride] |= ((cwd & 1) << 31) | val;
2340
1.20k
                                        cwd >>= 1;
2341
1.20k
                                        ++cnt;
2342
1.20k
                                    }
2343
2.63k
                                }
2344
2345
1.28k
                            }
2346
3.53k
                            frwd_advance(&sigprop, cnt); //consume the bits from bitstrm
2347
3.53k
                            cnt = 0;
2348
2349
                            //update the next 8 columns
2350
3.53k
                            if (n == 4) {
2351
                                //horizontally
2352
1.76k
                                OPJ_UINT32 t = new_sig >> 28;
2353
1.76k
                                t |= ((t & 0xE) >> 1) | ((t & 7) << 1);
2354
1.76k
                                cur_mbr[1] |= t & ~cur_sig[1];
2355
1.76k
                            }
2356
3.53k
                        }
2357
1.76k
                    }
2358
                    //update the next stripe (vertically propagation)
2359
5.09k
                    new_sig |= cur_sig[0];
2360
5.09k
                    ux = (new_sig & 0x88888888) >> 3;
2361
5.09k
                    tx = ux | (ux << 4) | (ux >> 4); //left and right neighbors
2362
5.09k
                    if (i > 0) {
2363
689
                        nxt_mbr[-1] |= (ux << 28) & ~nxt_sig[-1];
2364
689
                    }
2365
5.09k
                    nxt_mbr[0] |= tx & ~nxt_sig[0];
2366
5.09k
                    nxt_mbr[1] |= (ux >> 28) & ~nxt_sig[1];
2367
5.09k
                }
2368
2369
                //clear current sigma
2370
                //mbr need not be cleared because it is overwritten
2371
4.40k
                cur_sig = y & 0x4 ? sigma2 : sigma1;
2372
4.40k
                memset(cur_sig, 0, ((((OPJ_UINT32)width + 7u) >> 3) + 1u) << 2);
2373
4.40k
            }
2374
4.76k
        }
2375
9.44k
    }
2376
2377
    //terminating
2378
1.40k
    if (num_passes > 1) {
2379
905
        OPJ_INT32 st, y;
2380
2381
905
        if (num_passes > 2 && ((height & 3) == 1 || (height & 3) == 2)) {
2382
            //do magref
2383
633
            OPJ_UINT32 *cur_sig = height & 0x4 ? sigma2 : sigma1; //reversed
2384
633
            OPJ_UINT32 *dpp = decoded_data + (height & 0xFFFFFC) * stride;
2385
633
            OPJ_UINT32 half = 1u << (p - 2);
2386
633
            OPJ_INT32 i;
2387
5.05k
            for (i = 0; i < width; i += 8) {
2388
4.42k
                OPJ_UINT32 cwd = rev_fetch_mrp(&magref);
2389
4.42k
                OPJ_UINT32 sig = *cur_sig++;
2390
4.42k
                OPJ_UINT32 col_mask = 0xF;
2391
4.42k
                OPJ_UINT32 *dp = dpp + i;
2392
4.42k
                if (sig) {
2393
1.12k
                    int j;
2394
10.0k
                    for (j = 0; j < 8; ++j, dp++) {
2395
8.97k
                        if (sig & col_mask) {
2396
2.31k
                            OPJ_UINT32 sample_mask = 0x11111111 & col_mask;
2397
2398
2.31k
                            if (sig & sample_mask) {
2399
678
                                OPJ_UINT32 sym;
2400
678
                                assert(dp[0] != 0);
2401
678
                                sym = cwd & 1;
2402
678
                                dp[0] ^= (1 - sym) << (p - 1);
2403
678
                                dp[0] |= half;
2404
678
                                cwd >>= 1;
2405
678
                            }
2406
2.31k
                            sample_mask += sample_mask;
2407
2408
2.31k
                            if (sig & sample_mask) {
2409
2.23k
                                OPJ_UINT32 sym;
2410
2.23k
                                assert(dp[stride] != 0);
2411
2.23k
                                sym = cwd & 1;
2412
2.23k
                                dp[stride] ^= (1 - sym) << (p - 1);
2413
2.23k
                                dp[stride] |= half;
2414
2.23k
                                cwd >>= 1;
2415
2.23k
                            }
2416
2.31k
                            sample_mask += sample_mask;
2417
2418
2.31k
                            if (sig & sample_mask) {
2419
0
                                OPJ_UINT32 sym;
2420
0
                                assert(dp[2 * stride] != 0);
2421
0
                                sym = cwd & 1;
2422
0
                                dp[2 * stride] ^= (1 - sym) << (p - 1);
2423
0
                                dp[2 * stride] |= half;
2424
0
                                cwd >>= 1;
2425
0
                            }
2426
2.31k
                            sample_mask += sample_mask;
2427
2428
2.31k
                            if (sig & sample_mask) {
2429
0
                                OPJ_UINT32 sym;
2430
0
                                assert(dp[3 * stride] != 0);
2431
0
                                sym = cwd & 1;
2432
0
                                dp[3 * stride] ^= (1 - sym) << (p - 1);
2433
0
                                dp[3 * stride] |= half;
2434
0
                                cwd >>= 1;
2435
0
                            }
2436
2.31k
                            sample_mask += sample_mask;
2437
2.31k
                        }
2438
8.97k
                        col_mask <<= 4;
2439
8.97k
                    }
2440
1.12k
                }
2441
4.42k
                rev_advance_mrp(&magref, population_count(sig));
2442
4.42k
            }
2443
633
        }
2444
2445
        //do the last incomplete stripe
2446
        // for cases of (height & 3) == 0 and 3
2447
        // the should have been processed previously
2448
905
        if ((height & 3) == 1 || (height & 3) == 2) {
2449
            //generate mbr of first stripe
2450
639
            OPJ_UINT32 *sig = height & 0x4 ? sigma2 : sigma1;
2451
639
            OPJ_UINT32 *mbr = height & 0x4 ? mbr2 : mbr1;
2452
            //integrate horizontally
2453
639
            OPJ_UINT32 prev = 0;
2454
639
            OPJ_INT32 i;
2455
5.07k
            for (i = 0; i < width; i += 8, mbr++, sig++) {
2456
4.43k
                OPJ_UINT32 t, z;
2457
2458
4.43k
                mbr[0] = sig[0];
2459
4.43k
                mbr[0] |= prev >> 28;    //for first column, left neighbors
2460
4.43k
                mbr[0] |= sig[0] << 4;   //left neighbors
2461
4.43k
                mbr[0] |= sig[0] >> 4;   //left neighbors
2462
4.43k
                mbr[0] |= sig[1] << 28;  //for last column, right neighbors
2463
4.43k
                prev = sig[0];
2464
2465
                //integrate vertically
2466
4.43k
                t = mbr[0], z = mbr[0];
2467
4.43k
                z |= (t & 0x77777777) << 1; //above neighbors
2468
4.43k
                z |= (t & 0xEEEEEEEE) >> 1; //below neighbors
2469
4.43k
                mbr[0] = z & ~sig[0]; //remove already significance samples
2470
4.43k
            }
2471
639
        }
2472
2473
905
        st = height;
2474
905
        st -= height > 6 ? (((height + 1) & 3) + 3) : height;
2475
1.90k
        for (y = st; y < height; y += 4) {
2476
1.00k
            OPJ_UINT32 *cur_sig, *cur_mbr, *nxt_sig, *nxt_mbr;
2477
1.00k
            OPJ_UINT32 val;
2478
1.00k
            OPJ_INT32 i;
2479
2480
1.00k
            OPJ_UINT32 pattern = 0xFFFFFFFFu; // a pattern needed samples
2481
1.00k
            if (height - y == 3) {
2482
262
                pattern = 0x77777777u;
2483
741
            } else if (height - y == 2) {
2484
545
                pattern = 0x33333333u;
2485
545
            } else if (height - y == 1) {
2486
94
                pattern = 0x11111111u;
2487
94
            }
2488
2489
            //add membership from the next stripe, obtained above
2490
1.00k
            if (height - y > 4) {
2491
98
                OPJ_UINT32 prev = 0;
2492
98
                OPJ_INT32 i;
2493
98
                cur_sig = y & 0x4 ? sigma2 : sigma1;
2494
98
                cur_mbr = y & 0x4 ? mbr2 : mbr1;
2495
98
                nxt_sig = y & 0x4 ? sigma1 : sigma2;
2496
203
                for (i = 0; i < width; i += 8, cur_mbr++, cur_sig++, nxt_sig++) {
2497
105
                    OPJ_UINT32 t = nxt_sig[0];
2498
105
                    t |= prev >> 28;     //for first column, left neighbors
2499
105
                    t |= nxt_sig[0] << 4;   //left neighbors
2500
105
                    t |= nxt_sig[0] >> 4;   //left neighbors
2501
105
                    t |= nxt_sig[1] << 28;  //for last column, right neighbors
2502
105
                    prev = nxt_sig[0];
2503
2504
105
                    if (!stripe_causal) {
2505
76
                        cur_mbr[0] |= (t & 0x11111111u) << 3;
2506
76
                    }
2507
                    //remove already significance samples
2508
105
                    cur_mbr[0] &= ~cur_sig[0];
2509
105
                }
2510
98
            }
2511
2512
            //find new locations and get signs
2513
1.00k
            cur_sig = y & 0x4 ? sigma2 : sigma1;
2514
1.00k
            cur_mbr = y & 0x4 ? mbr2 : mbr1;
2515
1.00k
            nxt_sig = y & 0x4 ? sigma1 : sigma2;
2516
1.00k
            nxt_mbr = y & 0x4 ? mbr1 : mbr2;
2517
1.00k
            val = 3u << (p - 2);
2518
5.86k
            for (i = 0; i < width; i += 8,
2519
4.86k
                    cur_sig++, cur_mbr++, nxt_sig++, nxt_mbr++) {
2520
4.86k
                OPJ_UINT32 mbr = *cur_mbr & pattern; //skip unneeded samples
2521
4.86k
                OPJ_UINT32 new_sig = 0;
2522
4.86k
                OPJ_UINT32 ux, tx;
2523
4.86k
                if (mbr) {
2524
1.69k
                    OPJ_INT32 n;
2525
5.09k
                    for (n = 0; n < 8; n += 4) {
2526
3.39k
                        OPJ_UINT32 col_mask;
2527
3.39k
                        OPJ_UINT32 inv_sig;
2528
3.39k
                        OPJ_INT32 end;
2529
3.39k
                        OPJ_INT32 j;
2530
2531
3.39k
                        OPJ_UINT32 cwd = frwd_fetch(&sigprop);
2532
3.39k
                        OPJ_UINT32 cnt = 0;
2533
2534
3.39k
                        OPJ_UINT32 *dp = decoded_data + y * stride;
2535
3.39k
                        dp += i + n;
2536
2537
3.39k
                        col_mask = 0xFu << (4 * n);
2538
2539
3.39k
                        inv_sig = ~cur_sig[0] & pattern;
2540
2541
3.39k
                        end = n + 4 + i < width ? n + 4 : width - i;
2542
16.4k
                        for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
2543
13.0k
                            OPJ_UINT32 sample_mask;
2544
2545
13.0k
                            if ((col_mask & mbr) == 0) {
2546
4.07k
                                continue;
2547
4.07k
                            }
2548
2549
                            //scan 4 mbr
2550
8.93k
                            sample_mask = 0x11111111u & col_mask;
2551
8.93k
                            if (mbr & sample_mask) {
2552
8.77k
                                assert(dp[0] == 0);
2553
8.77k
                                if (cwd & 1) {
2554
3.62k
                                    OPJ_UINT32 t;
2555
3.62k
                                    new_sig |= sample_mask;
2556
3.62k
                                    t = 0x32u << (j * 4);
2557
3.62k
                                    mbr |= t & inv_sig;
2558
3.62k
                                }
2559
8.77k
                                cwd >>= 1;
2560
8.77k
                                ++cnt;
2561
8.77k
                            }
2562
2563
8.93k
                            sample_mask += sample_mask;
2564
8.93k
                            if (mbr & sample_mask) {
2565
7.17k
                                assert(dp[stride] == 0);
2566
7.17k
                                if (cwd & 1) {
2567
3.77k
                                    OPJ_UINT32 t;
2568
3.77k
                                    new_sig |= sample_mask;
2569
3.77k
                                    t = 0x74u << (j * 4);
2570
3.77k
                                    mbr |= t & inv_sig;
2571
3.77k
                                }
2572
7.17k
                                cwd >>= 1;
2573
7.17k
                                ++cnt;
2574
7.17k
                            }
2575
2576
8.93k
                            sample_mask += sample_mask;
2577
8.93k
                            if (mbr & sample_mask) {
2578
310
                                assert(dp[2 * stride] == 0);
2579
310
                                if (cwd & 1) {
2580
127
                                    OPJ_UINT32 t;
2581
127
                                    new_sig |= sample_mask;
2582
127
                                    t = 0xE8u << (j * 4);
2583
127
                                    mbr |= t & inv_sig;
2584
127
                                }
2585
310
                                cwd >>= 1;
2586
310
                                ++cnt;
2587
310
                            }
2588
2589
8.93k
                            sample_mask += sample_mask;
2590
8.93k
                            if (mbr & sample_mask) {
2591
123
                                assert(dp[3 * stride] == 0);
2592
123
                                if (cwd & 1) {
2593
0
                                    OPJ_UINT32 t;
2594
0
                                    new_sig |= sample_mask;
2595
0
                                    t = 0xC0u << (j * 4);
2596
0
                                    mbr |= t & inv_sig;
2597
0
                                }
2598
123
                                cwd >>= 1;
2599
123
                                ++cnt;
2600
123
                            }
2601
8.93k
                        }
2602
2603
                        //signs here
2604
3.39k
                        if (new_sig & (0xFFFFu << (4 * n))) {
2605
2.60k
                            OPJ_UINT32 col_mask;
2606
2.60k
                            OPJ_INT32 j;
2607
2.60k
                            OPJ_UINT32 *dp = decoded_data + y * stride;
2608
2.60k
                            dp += i + n;
2609
2.60k
                            col_mask = 0xFu << (4 * n);
2610
2611
12.9k
                            for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
2612
10.3k
                                OPJ_UINT32 sample_mask;
2613
10.3k
                                if ((col_mask & new_sig) == 0) {
2614
4.87k
                                    continue;
2615
4.87k
                                }
2616
2617
                                //scan 4 signs
2618
5.49k
                                sample_mask = 0x11111111u & col_mask;
2619
5.49k
                                if (new_sig & sample_mask) {
2620
3.62k
                                    assert(dp[0] == 0);
2621
3.62k
                                    dp[0] |= ((cwd & 1) << 31) | val;
2622
3.62k
                                    cwd >>= 1;
2623
3.62k
                                    ++cnt;
2624
3.62k
                                }
2625
2626
5.49k
                                sample_mask += sample_mask;
2627
5.49k
                                if (new_sig & sample_mask) {
2628
3.77k
                                    assert(dp[stride] == 0);
2629
3.77k
                                    dp[stride] |= ((cwd & 1) << 31) | val;
2630
3.77k
                                    cwd >>= 1;
2631
3.77k
                                    ++cnt;
2632
3.77k
                                }
2633
2634
5.49k
                                sample_mask += sample_mask;
2635
5.49k
                                if (new_sig & sample_mask) {
2636
127
                                    assert(dp[2 * stride] == 0);
2637
127
                                    dp[2 * stride] |= ((cwd & 1) << 31) | val;
2638
127
                                    cwd >>= 1;
2639
127
                                    ++cnt;
2640
127
                                }
2641
2642
5.49k
                                sample_mask += sample_mask;
2643
5.49k
                                if (new_sig & sample_mask) {
2644
0
                                    assert(dp[3 * stride] == 0);
2645
0
                                    dp[3 * stride] |= ((cwd & 1) << 31) | val;
2646
0
                                    cwd >>= 1;
2647
0
                                    ++cnt;
2648
0
                                }
2649
5.49k
                            }
2650
2651
2.60k
                        }
2652
3.39k
                        frwd_advance(&sigprop, cnt);
2653
3.39k
                        cnt = 0;
2654
2655
                        //update next columns
2656
3.39k
                        if (n == 4) {
2657
                            //horizontally
2658
1.69k
                            OPJ_UINT32 t = new_sig >> 28;
2659
1.69k
                            t |= ((t & 0xE) >> 1) | ((t & 7) << 1);
2660
1.69k
                            cur_mbr[1] |= t & ~cur_sig[1];
2661
1.69k
                        }
2662
3.39k
                    }
2663
1.69k
                }
2664
                //propagate down (vertically propagation)
2665
4.86k
                new_sig |= cur_sig[0];
2666
4.86k
                ux = (new_sig & 0x88888888) >> 3;
2667
4.86k
                tx = ux | (ux << 4) | (ux >> 4);
2668
4.86k
                if (i > 0) {
2669
3.86k
                    nxt_mbr[-1] |= (ux << 28) & ~nxt_sig[-1];
2670
3.86k
                }
2671
4.86k
                nxt_mbr[0] |= tx & ~nxt_sig[0];
2672
4.86k
                nxt_mbr[1] |= (ux >> 28) & ~nxt_sig[1];
2673
4.86k
            }
2674
1.00k
        }
2675
905
    }
2676
2677
1.40k
    {
2678
1.40k
        OPJ_INT32 x, y;
2679
22.7k
        for (y = 0; y < height; ++y) {
2680
21.3k
            OPJ_INT32* sp = (OPJ_INT32*)decoded_data + y * stride;
2681
214k
            for (x = 0; x < width; ++x, ++sp) {
2682
192k
                OPJ_INT32 val = (*sp & 0x7FFFFFFF);
2683
192k
                *sp = ((OPJ_UINT32) * sp & 0x80000000) ? -val : val;
2684
192k
            }
2685
21.3k
        }
2686
1.40k
    }
2687
2688
1.40k
    return OPJ_TRUE;
2689
1.40k
}