#include <assert.h>
#include <string.h>
#include "opj_includes.h"
#include "t1_ht_luts.h"
#ifdef _MSC_VER
#define OPJ_COMPILER_MSVC
#elif (defined __GNUC__)
#define OPJ_COMPILER_GNUC
#endif
#if defined(OPJ_COMPILER_MSVC) && defined(_M_ARM64) \
&& !defined(_M_ARM64EC) && !defined(_M_CEE_PURE) && !defined(__CUDACC__) \
&& !defined(__INTEL_COMPILER) && !defined(__clang__)
#define MSVC_NEON_INTRINSICS
#endif
#ifdef MSVC_NEON_INTRINSICS
#include <arm64_neon.h>
#endif
static OPJ_BOOL only_cleanup_pass_is_decoded = OPJ_FALSE;
static INLINE
OPJ_UINT32 population_count(OPJ_UINT32 val)
{
#if defined(OPJ_COMPILER_MSVC) && (defined(_M_IX86) || defined(_M_AMD64))
return (OPJ_UINT32)__popcnt(val);
#elif defined(OPJ_COMPILER_MSVC) && defined(MSVC_NEON_INTRINSICS)
const __n64 temp = neon_cnt(__uint64ToN64_v(val));
return neon_addv8(temp).n8_i8[0];
#elif (defined OPJ_COMPILER_GNUC)
return (OPJ_UINT32)__builtin_popcount(val);
#else
val -= ((val >> 1) & 0x55555555);
val = (((val >> 2) & 0x33333333) + (val & 0x33333333));
val = (((val >> 4) + val) & 0x0f0f0f0f);
val += (val >> 8);
val += (val >> 16);
return (OPJ_UINT32)(val & 0x0000003f);
#endif
}
#ifdef OPJ_COMPILER_MSVC
#pragma intrinsic(_BitScanReverse)
#endif
static INLINE
OPJ_UINT32 count_leading_zeros(OPJ_UINT32 val)
{
#ifdef OPJ_COMPILER_MSVC
unsigned long result = 0;
_BitScanReverse(&result, val);
return 31U ^ (OPJ_UINT32)result;
#elif (defined OPJ_COMPILER_GNUC)
return (OPJ_UINT32)__builtin_clz(val);
#else
val |= (val >> 1);
val |= (val >> 2);
val |= (val >> 4);
val |= (val >> 8);
val |= (val >> 16);
return 32U - population_count(val);
#endif
}
static INLINE OPJ_UINT32 read_le_uint32(const void* dataIn)
{
#if defined(OPJ_BIG_ENDIAN)
const OPJ_UINT8* data = (const OPJ_UINT8*)dataIn;
return ((OPJ_UINT32)data[0]) | (OPJ_UINT32)(data[1] << 8) | (OPJ_UINT32)(
data[2] << 16) | (((
OPJ_UINT32)data[3]) <<
24U);
#else
return *(OPJ_UINT32*)dataIn;
#endif
}
typedef struct dec_mel {
OPJ_UINT8* data; OPJ_UINT64 tmp; int bits; int size; OPJ_BOOL unstuff; int k;
int num_runs; OPJ_UINT64 runs; } dec_mel_t;
static INLINE
void mel_read(dec_mel_t *melp)
{
OPJ_UINT32 val;
int bits;
OPJ_UINT32 t;
OPJ_BOOL unstuff;
if (melp->bits > 32) { return; }
val = 0xFFFFFFFF; if (melp->size > 4) { val = read_le_uint32(melp->data); melp->data += 4; melp->size -= 4; } else if (melp->size > 0) { OPJ_UINT32 m, v;
int i = 0;
while (melp->size > 1) {
OPJ_UINT32 v = *melp->data++; OPJ_UINT32 m = ~(0xFFu << i); val = (val & m) | (v << i); --melp->size;
i += 8;
}
v = *melp->data++; v |= 0xF; m = ~(0xFFu << i);
val = (val & m) | (v << i);
--melp->size;
}
bits = 32 - melp->unstuff;
t = val & 0xFF;
unstuff = ((val & 0xFF) == 0xFF); bits -= unstuff; t = t << (8 - unstuff);
t |= (val >> 8) & 0xFF;
unstuff = (((val >> 8) & 0xFF) == 0xFF);
bits -= unstuff;
t = t << (8 - unstuff);
t |= (val >> 16) & 0xFF;
unstuff = (((val >> 16) & 0xFF) == 0xFF);
bits -= unstuff;
t = t << (8 - unstuff);
t |= (val >> 24) & 0xFF;
melp->unstuff = (((val >> 24) & 0xFF) == 0xFF);
melp->tmp |= ((OPJ_UINT64)t) << (64 - bits - melp->bits);
melp->bits += bits; }
static INLINE
void mel_decode(dec_mel_t *melp)
{
static const int mel_exp[13] = { 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 4, 5
};
if (melp->bits < 6) { mel_read(melp); }
while (melp->bits >= 6 && melp->num_runs < 8) {
int eval = mel_exp[melp->k]; int run = 0;
if (melp->tmp & (1ull << 63)) { run = 1 << eval;
run--; melp->k = melp->k + 1 < 12 ? melp->k + 1 : 12; melp->tmp <<= 1; melp->bits -= 1;
run = run << 1; } else {
run = (int)(melp->tmp >> (63 - eval)) & ((1 << eval) - 1);
melp->k = melp->k - 1 > 0 ? melp->k - 1 : 0; melp->tmp <<= eval + 1; melp->bits -= eval + 1;
run = (run << 1) + 1; }
eval = melp->num_runs * 7; melp->runs &= ~((OPJ_UINT64)0x3F << eval); melp->runs |= ((OPJ_UINT64)run) << eval; melp->num_runs++; }
}
static INLINE
OPJ_BOOL mel_init(dec_mel_t *melp, OPJ_UINT8* bbuf, int lcup, int scup)
{
int num;
int i;
melp->data = bbuf + lcup - scup; melp->bits = 0; melp->tmp = 0; melp->unstuff = OPJ_FALSE; melp->size = scup - 1; melp->k = 0; melp->num_runs = 0; melp->runs = 0;
num = 4 - (int)((intptr_t)(melp->data) & 0x3);
for (i = 0; i < num; ++i) { OPJ_UINT64 d;
int d_bits;
if (melp->unstuff == OPJ_TRUE && melp->data[0] > 0x8F) {
return OPJ_FALSE;
}
d = (melp->size > 0) ? *melp->data : 0xFF; if (melp->size == 1) {
d |= 0xF; }
melp->data += melp->size-- > 0; d_bits = 8 - melp->unstuff; melp->tmp = (melp->tmp << d_bits) | d; melp->bits += d_bits; melp->unstuff = ((d & 0xFF) == 0xFF); }
melp->tmp <<= (64 - melp->bits); return OPJ_TRUE;
}
static INLINE
int mel_get_run(dec_mel_t *melp)
{
int t;
if (melp->num_runs == 0) { mel_decode(melp);
}
t = melp->runs & 0x7F; melp->runs >>= 7; melp->num_runs--;
return t; }
typedef struct rev_struct {
OPJ_UINT8* data; OPJ_UINT64 tmp; OPJ_UINT32 bits; int size; OPJ_BOOL unstuff; } rev_struct_t;
static INLINE
void rev_read(rev_struct_t *vlcp)
{
OPJ_UINT32 val;
OPJ_UINT32 tmp;
OPJ_UINT32 bits;
OPJ_BOOL unstuff;
if (vlcp->bits > 32) { return; }
val = 0;
if (vlcp->size > 3) { val = read_le_uint32(vlcp->data - 3); vlcp->data -= 4; vlcp->size -= 4; } else if (vlcp->size > 0) { int i = 24;
while (vlcp->size > 0) {
OPJ_UINT32 v = *vlcp->data--; val |= (v << i); --vlcp->size;
i -= 8;
}
}
tmp = val >> 24;
bits = 8u - ((vlcp->unstuff && (((val >> 24) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = (val >> 24) > 0x8F;
tmp |= ((val >> 16) & 0xFF) << bits; bits += 8u - ((unstuff && (((val >> 16) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = ((val >> 16) & 0xFF) > 0x8F;
tmp |= ((val >> 8) & 0xFF) << bits;
bits += 8u - ((unstuff && (((val >> 8) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = ((val >> 8) & 0xFF) > 0x8F;
tmp |= (val & 0xFF) << bits;
bits += 8u - ((unstuff && ((val & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = (val & 0xFF) > 0x8F;
vlcp->tmp |= (OPJ_UINT64)tmp << vlcp->bits;
vlcp->bits += bits;
vlcp->unstuff = unstuff; }
static INLINE
void rev_init(rev_struct_t *vlcp, OPJ_UINT8* data, int lcup, int scup)
{
OPJ_UINT32 d;
int num, tnum, i;
vlcp->data = data + lcup - 2;
vlcp->size = scup - 2;
d = *vlcp->data--; vlcp->tmp = d >> 4; vlcp->bits = 4 - ((vlcp->tmp & 7) == 7); vlcp->unstuff = (d | 0xF) > 0x8F;
num = 1 + (int)((intptr_t)(vlcp->data) & 0x3);
tnum = num < vlcp->size ? num : vlcp->size;
for (i = 0; i < tnum; ++i) {
OPJ_UINT64 d;
OPJ_UINT32 d_bits;
d = *vlcp->data--; d_bits = 8u - ((vlcp->unstuff && ((d & 0x7F) == 0x7F)) ? 1u : 0u);
vlcp->tmp |= d << vlcp->bits; vlcp->bits += d_bits;
vlcp->unstuff = d > 0x8F; }
vlcp->size -= tnum;
rev_read(vlcp); }
static INLINE
OPJ_UINT32 rev_fetch(rev_struct_t *vlcp)
{
if (vlcp->bits < 32) { rev_read(vlcp); if (vlcp->bits < 32) { rev_read(vlcp); }
}
return (OPJ_UINT32)vlcp->tmp; }
static INLINE
OPJ_UINT32 rev_advance(rev_struct_t *vlcp, OPJ_UINT32 num_bits)
{
assert(num_bits <= vlcp->bits); vlcp->tmp >>= num_bits; vlcp->bits -= num_bits; return (OPJ_UINT32)vlcp->tmp;
}
static INLINE
void rev_read_mrp(rev_struct_t *mrp)
{
OPJ_UINT32 val;
OPJ_UINT32 tmp;
OPJ_UINT32 bits;
OPJ_BOOL unstuff;
if (mrp->bits > 32) {
return;
}
val = 0;
if (mrp->size > 3) { val = read_le_uint32(mrp->data - 3); mrp->data -= 4; mrp->size -= 4; } else if (mrp->size > 0) {
int i = 24;
while (mrp->size > 0) {
OPJ_UINT32 v = *mrp->data--; val |= (v << i); --mrp->size;
i -= 8;
}
}
tmp = val >> 24;
bits = 8u - ((mrp->unstuff && (((val >> 24) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = (val >> 24) > 0x8F;
tmp |= ((val >> 16) & 0xFF) << bits;
bits += 8u - ((unstuff && (((val >> 16) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = ((val >> 16) & 0xFF) > 0x8F;
tmp |= ((val >> 8) & 0xFF) << bits;
bits += 8u - ((unstuff && (((val >> 8) & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = ((val >> 8) & 0xFF) > 0x8F;
tmp |= (val & 0xFF) << bits;
bits += 8u - ((unstuff && ((val & 0x7F) == 0x7F)) ? 1u : 0u);
unstuff = (val & 0xFF) > 0x8F;
mrp->tmp |= (OPJ_UINT64)tmp << mrp->bits; mrp->bits += bits;
mrp->unstuff = unstuff; }
static INLINE
void rev_init_mrp(rev_struct_t *mrp, OPJ_UINT8* data, int lcup, int len2)
{
int num, i;
mrp->data = data + lcup + len2 - 1;
mrp->size = len2;
mrp->unstuff = OPJ_TRUE;
mrp->bits = 0;
mrp->tmp = 0;
num = 1 + (int)((intptr_t)(mrp->data) & 0x3);
for (i = 0; i < num; ++i) {
OPJ_UINT64 d;
OPJ_UINT32 d_bits;
d = (mrp->size-- > 0) ? *mrp->data-- : 0;
d_bits = 8u - ((mrp->unstuff && ((d & 0x7F) == 0x7F)) ? 1u : 0u);
mrp->tmp |= d << mrp->bits; mrp->bits += d_bits;
mrp->unstuff = d > 0x8F; }
rev_read_mrp(mrp);
}
static INLINE
OPJ_UINT32 rev_fetch_mrp(rev_struct_t *mrp)
{
if (mrp->bits < 32) { rev_read_mrp(mrp); if (mrp->bits < 32) { rev_read_mrp(mrp); }
}
return (OPJ_UINT32)mrp->tmp; }
static INLINE
OPJ_UINT32 rev_advance_mrp(rev_struct_t *mrp, OPJ_UINT32 num_bits)
{
assert(num_bits <= mrp->bits); mrp->tmp >>= num_bits; mrp->bits -= num_bits;
return (OPJ_UINT32)mrp->tmp; }
static INLINE
OPJ_UINT32 decode_init_uvlc(OPJ_UINT32 vlc, OPJ_UINT32 mode, OPJ_UINT32 *u)
{
static const OPJ_UINT8 dec[8] = { 3 | (5 << 2) | (5 << 5), 1 | (0 << 2) | (1 << 5), 2 | (0 << 2) | (2 << 5), 1 | (0 << 2) | (1 << 5), 3 | (1 << 2) | (3 << 5), 1 | (0 << 2) | (1 << 5), 2 | (0 << 2) | (2 << 5), 1 | (0 << 2) | (1 << 5) };
OPJ_UINT32 consumed_bits = 0;
if (mode == 0) { u[0] = u[1] = 1; } else if (mode <= 2) { OPJ_UINT32 d;
OPJ_UINT32 suffix_len;
d = dec[vlc & 0x7]; vlc >>= d & 0x3; consumed_bits += d & 0x3;
suffix_len = ((d >> 2) & 0x7);
consumed_bits += suffix_len;
d = (d >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = (mode == 1) ? d + 1 : 1; u[1] = (mode == 1) ? 1 : d + 1; } else if (mode == 3) { OPJ_UINT32 d1 = dec[vlc & 0x7]; vlc >>= d1 & 0x3; consumed_bits += d1 & 0x3;
if ((d1 & 0x3) > 2) {
OPJ_UINT32 suffix_len;
u[1] = (vlc & 1) + 1 + 1; ++consumed_bits;
vlc >>= 1;
suffix_len = ((d1 >> 2) & 0x7);
consumed_bits += suffix_len;
d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = d1 + 1; } else {
OPJ_UINT32 d2;
OPJ_UINT32 suffix_len;
d2 = dec[vlc & 0x7]; vlc >>= d2 & 0x3; consumed_bits += d2 & 0x3;
suffix_len = ((d1 >> 2) & 0x7);
consumed_bits += suffix_len;
d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = d1 + 1; vlc >>= suffix_len;
suffix_len = ((d2 >> 2) & 0x7);
consumed_bits += suffix_len;
d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[1] = d2 + 1; }
} else if (mode == 4) { OPJ_UINT32 d1;
OPJ_UINT32 d2;
OPJ_UINT32 suffix_len;
d1 = dec[vlc & 0x7]; vlc >>= d1 & 0x3; consumed_bits += d1 & 0x3;
d2 = dec[vlc & 0x7]; vlc >>= d2 & 0x3; consumed_bits += d2 & 0x3;
suffix_len = ((d1 >> 2) & 0x7);
consumed_bits += suffix_len;
d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = d1 + 3; vlc >>= suffix_len;
suffix_len = ((d2 >> 2) & 0x7);
consumed_bits += suffix_len;
d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[1] = d2 + 3; }
return consumed_bits;
}
static INLINE
OPJ_UINT32 decode_noninit_uvlc(OPJ_UINT32 vlc, OPJ_UINT32 mode, OPJ_UINT32 *u)
{
static const OPJ_UINT8 dec[8] = {
3 | (5 << 2) | (5 << 5), 1 | (0 << 2) | (1 << 5), 2 | (0 << 2) | (2 << 5), 1 | (0 << 2) | (1 << 5), 3 | (1 << 2) | (3 << 5), 1 | (0 << 2) | (1 << 5), 2 | (0 << 2) | (2 << 5), 1 | (0 << 2) | (1 << 5) };
OPJ_UINT32 consumed_bits = 0;
if (mode == 0) {
u[0] = u[1] = 1; } else if (mode <= 2) { OPJ_UINT32 d;
OPJ_UINT32 suffix_len;
d = dec[vlc & 0x7]; vlc >>= d & 0x3; consumed_bits += d & 0x3;
suffix_len = ((d >> 2) & 0x7);
consumed_bits += suffix_len;
d = (d >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = (mode == 1) ? d + 1 : 1; u[1] = (mode == 1) ? 1 : d + 1; } else if (mode == 3) { OPJ_UINT32 d1;
OPJ_UINT32 d2;
OPJ_UINT32 suffix_len;
d1 = dec[vlc & 0x7]; vlc >>= d1 & 0x3; consumed_bits += d1 & 0x3;
d2 = dec[vlc & 0x7]; vlc >>= d2 & 0x3; consumed_bits += d2 & 0x3;
suffix_len = ((d1 >> 2) & 0x7);
consumed_bits += suffix_len;
d1 = (d1 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[0] = d1 + 1; vlc >>= suffix_len;
suffix_len = ((d2 >> 2) & 0x7);
consumed_bits += suffix_len;
d2 = (d2 >> 5) + (vlc & ((1U << suffix_len) - 1)); u[1] = d2 + 1; }
return consumed_bits;
}
typedef struct frwd_struct {
const OPJ_UINT8* data; OPJ_UINT64 tmp; OPJ_UINT32 bits; OPJ_BOOL unstuff; int size; OPJ_UINT32 X; } frwd_struct_t;
static INLINE
void frwd_read(frwd_struct_t *msp)
{
OPJ_UINT32 val;
OPJ_UINT32 bits;
OPJ_UINT32 t;
OPJ_BOOL unstuff;
assert(msp->bits <= 32);
val = 0u;
if (msp->size > 3) {
val = read_le_uint32(msp->data); msp->data += 4; msp->size -= 4; } else if (msp->size > 0) {
int i = 0;
val = msp->X != 0 ? 0xFFFFFFFFu : 0;
while (msp->size > 0) {
OPJ_UINT32 v = *msp->data++; OPJ_UINT32 m = ~(0xFFu << i); val = (val & m) | (v << i); --msp->size;
i += 8;
}
} else {
val = msp->X != 0 ? 0xFFFFFFFFu : 0;
}
bits = 8u - (msp->unstuff ? 1u : 0u);
t = val & 0xFF;
unstuff = ((val & 0xFF) == 0xFF);
t |= ((val >> 8) & 0xFF) << bits;
bits += 8u - (unstuff ? 1u : 0u);
unstuff = (((val >> 8) & 0xFF) == 0xFF);
t |= ((val >> 16) & 0xFF) << bits;
bits += 8u - (unstuff ? 1u : 0u);
unstuff = (((val >> 16) & 0xFF) == 0xFF);
t |= ((val >> 24) & 0xFF) << bits;
bits += 8u - (unstuff ? 1u : 0u);
msp->unstuff = (((val >> 24) & 0xFF) == 0xFF);
msp->tmp |= ((OPJ_UINT64)t) << msp->bits; msp->bits += bits;
}
static INLINE
void frwd_init(frwd_struct_t *msp, const OPJ_UINT8* data, int size,
OPJ_UINT32 X)
{
int num, i;
msp->data = data;
msp->tmp = 0;
msp->bits = 0;
msp->unstuff = OPJ_FALSE;
msp->size = size;
msp->X = X;
assert(msp->X == 0 || msp->X == 0xFF);
num = 4 - (int)((intptr_t)(msp->data) & 0x3);
for (i = 0; i < num; ++i) {
OPJ_UINT64 d;
d = msp->size-- > 0 ? *msp->data++ : msp->X;
msp->tmp |= (d << msp->bits); msp->bits += 8u - (msp->unstuff ? 1u : 0u); msp->unstuff = ((d & 0xFF) == 0xFF); }
frwd_read(msp); }
static INLINE
void frwd_advance(frwd_struct_t *msp, OPJ_UINT32 num_bits)
{
assert(num_bits <= msp->bits);
msp->tmp >>= num_bits; msp->bits -= num_bits;
}
static INLINE
OPJ_UINT32 frwd_fetch(frwd_struct_t *msp)
{
if (msp->bits < 32) {
frwd_read(msp);
if (msp->bits < 32) { frwd_read(msp);
}
}
return (OPJ_UINT32)msp->tmp;
}
static OPJ_BOOL opj_t1_allocate_buffers(
opj_t1_t *t1,
OPJ_UINT32 w,
OPJ_UINT32 h)
{
OPJ_UINT32 flagssize;
assert(w <= 1024);
assert(h <= 1024);
assert(w * h <= 4096);
{
OPJ_UINT32 datasize = w * h;
if (datasize > t1->datasize) {
opj_aligned_free(t1->data);
t1->data = (OPJ_INT32*)
opj_aligned_malloc(datasize * sizeof(OPJ_INT32));
if (!t1->data) {
return OPJ_FALSE;
}
t1->datasize = datasize;
}
if (t1->data != NULL) {
memset(t1->data, 0, datasize * sizeof(OPJ_INT32));
}
}
flagssize = 132U * sizeof(OPJ_UINT32) * 4U; flagssize += 528U;
{
if (flagssize > t1->flagssize) {
opj_aligned_free(t1->flags);
t1->flags = (opj_flag_t*) opj_aligned_malloc(flagssize * sizeof(opj_flag_t));
if (!t1->flags) {
return OPJ_FALSE;
}
}
t1->flagssize = flagssize;
memset(t1->flags, 0, flagssize * sizeof(opj_flag_t));
}
t1->w = w;
t1->h = h;
return OPJ_TRUE;
}
OPJ_BOOL opj_t1_ht_decode_cblk(opj_t1_t *t1,
opj_tcd_cblk_dec_t* cblk,
OPJ_UINT32 orient,
OPJ_UINT32 roishift,
OPJ_UINT32 cblksty,
opj_event_mgr_t *p_manager,
opj_mutex_t* p_manager_mutex,
OPJ_BOOL check_pterm);
OPJ_BOOL opj_t1_ht_decode_cblk(opj_t1_t *t1,
opj_tcd_cblk_dec_t* cblk,
OPJ_UINT32 orient,
OPJ_UINT32 roishift,
OPJ_UINT32 cblksty,
opj_event_mgr_t *p_manager,
opj_mutex_t* p_manager_mutex,
OPJ_BOOL check_pterm)
{
OPJ_BYTE* cblkdata = NULL;
OPJ_UINT8* coded_data;
OPJ_UINT32* decoded_data;
OPJ_UINT32 zero_bplanes;
OPJ_UINT32 num_passes;
OPJ_UINT32 lengths1;
OPJ_UINT32 lengths2;
OPJ_INT32 width;
OPJ_INT32 height;
OPJ_INT32 stride;
OPJ_UINT32 *pflags, *sigma1, *sigma2, *mbr1, *mbr2, *sip, sip_shift;
OPJ_UINT32 p;
OPJ_UINT32 zero_bplanes_p1;
int lcup, scup;
dec_mel_t mel;
rev_struct_t vlc;
frwd_struct_t magsgn;
frwd_struct_t sigprop;
rev_struct_t magref;
OPJ_UINT8 *lsp, *line_state;
int run;
OPJ_UINT32 vlc_val; OPJ_UINT32 qinf[2];
OPJ_UINT32 c_q;
OPJ_UINT32* sp;
OPJ_INT32 x, y; OPJ_BOOL stripe_causal = (cblksty & J2K_CCP_CBLKSTY_VSC) != 0;
OPJ_UINT32 cblk_len = 0;
(void)(orient); (void)(check_pterm);
if (roishift != 0) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "We do not support ROI in decoding "
"HT codeblocks\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (!opj_t1_allocate_buffers(
t1,
(OPJ_UINT32)(cblk->x1 - cblk->x0),
(OPJ_UINT32)(cblk->y1 - cblk->y0))) {
return OPJ_FALSE;
}
if (cblk->Mb == 0) {
return OPJ_TRUE;
}
zero_bplanes = (cblk->Mb + 1) - cblk->numbps;
cblk_len = 0;
{
OPJ_UINT32 i;
for (i = 0; i < cblk->numchunks; i++) {
cblk_len += cblk->chunks[i].len;
}
}
if (cblk->numchunks > 1 || t1->mustuse_cblkdatabuffer) {
OPJ_UINT32 i;
if (cblk_len > t1->cblkdatabuffersize) {
cblkdata = (OPJ_BYTE*)opj_realloc(
t1->cblkdatabuffer, cblk_len);
if (cblkdata == NULL) {
return OPJ_FALSE;
}
t1->cblkdatabuffer = cblkdata;
t1->cblkdatabuffersize = cblk_len;
}
cblkdata = t1->cblkdatabuffer;
if (cblkdata == NULL) {
return OPJ_FALSE;
}
cblk_len = 0;
for (i = 0; i < cblk->numchunks; i++) {
memcpy(cblkdata + cblk_len, cblk->chunks[i].data, cblk->chunks[i].len);
cblk_len += cblk->chunks[i].len;
}
} else if (cblk->numchunks == 1) {
cblkdata = cblk->chunks[0].data;
} else {
return OPJ_TRUE;
}
coded_data = cblkdata;
decoded_data = (OPJ_UINT32*)t1->data;
num_passes = cblk->numsegs > 0 ? cblk->segs[0].real_num_passes : 0;
num_passes += cblk->numsegs > 1 ? cblk->segs[1].real_num_passes : 0;
lengths1 = num_passes > 0 ? cblk->segs[0].len : 0;
lengths2 = num_passes > 1 ? cblk->segs[1].len : 0;
width = cblk->x1 - cblk->x0;
height = cblk->y1 - cblk->y0;
stride = width;
pflags = (OPJ_UINT32 *)t1->flags;
sigma1 = pflags;
sigma2 = sigma1 + 132;
mbr1 = sigma2 + 132;
mbr2 = mbr1 + 132;
sip = sigma1; sip_shift = 0;
if (num_passes > 1 && lengths2 == 0) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_WARNING, "A malformed codeblock that has "
"more than one coding pass, but zero length for "
"2nd and potentially the 3rd pass in an HT codeblock.\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
num_passes = 1;
}
if (num_passes > 3) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "We do not support more than 3 "
"coding passes in an HT codeblock; This codeblocks has "
"%d passes.\n", num_passes);
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (cblk->Mb > 30) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "32 bits are not enough to "
"decode this codeblock, since the number of "
"bitplane, %d, is larger than 30.\n", cblk->Mb);
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (zero_bplanes > cblk->Mb) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"Decoding this codeblock is stopped. There are "
"%d zero bitplanes in %d bitplanes.\n",
zero_bplanes, cblk->Mb);
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
} else if (zero_bplanes == cblk->Mb && num_passes > 1) {
if (only_cleanup_pass_is_decoded == OPJ_FALSE) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
if (only_cleanup_pass_is_decoded == OPJ_FALSE) {
only_cleanup_pass_is_decoded = OPJ_TRUE;
opj_event_msg(p_manager, EVT_WARNING, "Malformed HT codeblock. "
"When the number of zero planes bitplanes is "
"equal to the number of bitplanes, only the cleanup "
"pass makes sense, but we have %d passes in this "
"codeblock. Therefore, only the cleanup pass will be "
"decoded. This message will not be displayed again.\n",
num_passes);
}
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
}
num_passes = 1;
}
p = cblk->numbps;
zero_bplanes_p1 = zero_bplanes + 1;
if (lengths1 < 2 || (OPJ_UINT32)lengths1 > cblk_len ||
(OPJ_UINT32)(lengths1 + lengths2) > cblk_len) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"Invalid codeblock length values.\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
lcup = (int)lengths1; scup = (((int)coded_data[lcup - 1]) << 4) + (coded_data[lcup - 2] & 0xF);
if (scup < 2 || scup > lcup || scup > 4079) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"One of the following condition is not met: "
"2 <= Scup <= min(Lcup, 4079)\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (mel_init(&mel, coded_data, lcup, scup) == OPJ_FALSE) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"Incorrect MEL segment sequence.\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
rev_init(&vlc, coded_data, lcup, scup);
frwd_init(&magsgn, coded_data, lcup - scup, 0xFF);
if (num_passes > 1) { frwd_init(&sigprop, coded_data + lengths1, (int)lengths2, 0);
}
if (num_passes > 2) {
rev_init_mrp(&magref, coded_data, (int)lengths1, (int)lengths2);
}
line_state = (OPJ_UINT8 *)(mbr2 + 132);
lsp = line_state; lsp[0] = 0; run = mel_get_run(&mel); qinf[0] = qinf[1] = 0; c_q = 0; sp = decoded_data;
for (x = 0; x < width; x += 4) { OPJ_UINT32 U_q[2]; OPJ_UINT32 uvlc_mode;
OPJ_UINT32 consumed_bits;
OPJ_UINT32 m_n, v_n;
OPJ_UINT32 ms_val;
OPJ_UINT32 locs;
vlc_val = rev_fetch(&vlc);
qinf[0] = vlc_tbl0[(c_q << 7) | (vlc_val & 0x7F) ];
if (c_q == 0) { run -= 2;
qinf[0] = (run == -1) ? qinf[0] : 0;
if (run < 0) {
run = mel_get_run(&mel); }
}
c_q = ((qinf[0] & 0x10) >> 4) | ((qinf[0] & 0xE0) >> 5);
vlc_val = rev_advance(&vlc, qinf[0] & 0x7);
*sip |= (((qinf[0] & 0x30) >> 4) | ((qinf[0] & 0xC0) >> 2)) << sip_shift;
qinf[1] = 0;
if (x + 2 < width) { qinf[1] = vlc_tbl0[(c_q << 7) | (vlc_val & 0x7F)];
if (c_q == 0) { run -= 2;
qinf[1] = (run == -1) ? qinf[1] : 0;
if (run < 0) { run = mel_get_run(&mel); }
}
c_q = ((qinf[1] & 0x10) >> 4) | ((qinf[1] & 0xE0) >> 5);
vlc_val = rev_advance(&vlc, qinf[1] & 0x7);
}
*sip |= (((qinf[1] & 0x30) | ((qinf[1] & 0xC0) << 2))) << (4 + sip_shift);
sip += x & 0x7 ? 1 : 0; sip_shift ^= 0x10;
uvlc_mode = ((qinf[0] & 0x8) >> 3) | ((qinf[1] & 0x8) >> 2);
if (uvlc_mode == 3) { run -= 2; uvlc_mode += (run == -1) ? 1 : 0; if (run < 0) { run = mel_get_run(&mel);
}
}
consumed_bits = decode_init_uvlc(vlc_val, uvlc_mode, U_q);
if (U_q[0] > zero_bplanes_p1 || U_q[1] > zero_bplanes_p1) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. Decoding "
"this codeblock is stopped. U_q is larger than zero "
"bitplanes + 1 \n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
vlc_val = rev_advance(&vlc, consumed_bits);
locs = 0xFF;
if (x + 4 > width) {
locs >>= (x + 4 - width) << 1; }
locs = height > 1 ? locs : (locs & 0x55);
if ((((qinf[0] & 0xF0) >> 4) | (qinf[1] & 0xF0)) & ~locs) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"VLC code produces significant samples outside "
"the codeblock area.\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (qinf[0] & 0x10) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn); m_n = U_q[0] - ((qinf[0] >> 12) & 1); frwd_advance(&magsgn, m_n); val = ms_val << 31; v_n = ms_val & ((1U << m_n) - 1); v_n |= ((qinf[0] & 0x100) >> 8) << m_n; v_n |= 1; sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x1) { sp[0] = 0; }
if (qinf[0] & 0x20) { OPJ_UINT32 val, t;
ms_val = frwd_fetch(&magsgn); m_n = U_q[0] - ((qinf[0] >> 13) & 1); frwd_advance(&magsgn, m_n); val = ms_val << 31; v_n = ms_val & ((1U << m_n) - 1); v_n |= ((qinf[0] & 0x200) >> 9) << m_n; v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
t = lsp[0] & 0x7F; v_n = 32 - count_leading_zeros(v_n);
lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n)); } else if (locs & 0x2) { sp[stride] = 0; }
++lsp; ++sp;
if (qinf[0] & 0x40) {
OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 14) & 1);
frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[0] & 0x400) >> 10) << m_n);
v_n |= 1;
sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x4) {
sp[0] = 0;
}
lsp[0] = 0;
if (qinf[0] & 0x80) {
OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 15) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= ((qinf[0] & 0x800) >> 11) << m_n;
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
} else if (locs & 0x8) { sp[stride] = 0;
}
++sp;
if (qinf[1] & 0x10) {
OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 12) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x100) >> 8) << m_n);
v_n |= 1;
sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x10) {
sp[0] = 0;
}
if (qinf[1] & 0x20) {
OPJ_UINT32 val, t;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 13) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x200) >> 9) << m_n);
v_n |= 1;
sp[stride] = val | ((v_n + 2) << (p - 1));
t = lsp[0] & 0x7F; v_n = 32 - count_leading_zeros(v_n); lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n)); } else if (locs & 0x20) {
sp[stride] = 0; }
++lsp; ++sp;
if (qinf[1] & 0x40) {
OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 14) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x400) >> 10) << m_n);
v_n |= 1;
sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x40) {
sp[0] = 0;
}
lsp[0] = 0;
if (qinf[1] & 0x80) {
OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 15) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x800) >> 11) << m_n);
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
} else if (locs & 0x80) {
sp[stride] = 0;
}
++sp;
}
for (y = 2; y < height; ) {
OPJ_UINT32 *sip;
OPJ_UINT8 ls0;
OPJ_INT32 x;
sip_shift ^= 0x2; sip_shift &= 0xFFFFFFEFU; sip = y & 0x4 ? sigma2 : sigma1;
lsp = line_state;
ls0 = lsp[0]; lsp[0] = 0; sp = decoded_data + y * stride; c_q = 0; for (x = 0; x < width; x += 4) {
OPJ_UINT32 U_q[2];
OPJ_UINT32 uvlc_mode, consumed_bits;
OPJ_UINT32 m_n, v_n;
OPJ_UINT32 ms_val;
OPJ_UINT32 locs;
c_q |= (ls0 >> 7); c_q |= (lsp[1] >> 5) & 0x4;
vlc_val = rev_fetch(&vlc);
qinf[0] = vlc_tbl1[(c_q << 7) | (vlc_val & 0x7F)];
if (c_q == 0) { run -= 2;
qinf[0] = (run == -1) ? qinf[0] : 0;
if (run < 0) {
run = mel_get_run(&mel);
}
}
c_q = ((qinf[0] & 0x40) >> 5) | ((qinf[0] & 0x80) >> 6);
vlc_val = rev_advance(&vlc, qinf[0] & 0x7);
*sip |= (((qinf[0] & 0x30) >> 4) | ((qinf[0] & 0xC0) >> 2)) << sip_shift;
qinf[1] = 0;
if (x + 2 < width) {
c_q |= (lsp[1] >> 7);
c_q |= (lsp[2] >> 5) & 0x4;
qinf[1] = vlc_tbl1[(c_q << 7) | (vlc_val & 0x7F)];
if (c_q == 0) { run -= 2;
qinf[1] = (run == -1) ? qinf[1] : 0;
if (run < 0) {
run = mel_get_run(&mel);
}
}
c_q = ((qinf[1] & 0x40) >> 5) | ((qinf[1] & 0x80) >> 6);
vlc_val = rev_advance(&vlc, qinf[1] & 0x7);
}
*sip |= (((qinf[1] & 0x30) | ((qinf[1] & 0xC0) << 2))) << (4 + sip_shift);
sip += x & 0x7 ? 1 : 0;
sip_shift ^= 0x10;
uvlc_mode = ((qinf[0] & 0x8) >> 3) | ((qinf[1] & 0x8) >> 2);
consumed_bits = decode_noninit_uvlc(vlc_val, uvlc_mode, U_q);
vlc_val = rev_advance(&vlc, consumed_bits);
if ((qinf[0] & 0xF0) & ((qinf[0] & 0xF0) - 1)) { OPJ_UINT32 E = (ls0 & 0x7Fu);
E = E > (lsp[1] & 0x7Fu) ? E : (lsp[1] & 0x7Fu); U_q[0] += E > 2 ? E - 2 : 0;
}
if ((qinf[1] & 0xF0) & ((qinf[1] & 0xF0) - 1)) { OPJ_UINT32 E = (lsp[1] & 0x7Fu);
E = E > (lsp[2] & 0x7Fu) ? E : (lsp[2] & 0x7Fu); U_q[1] += E > 2 ? E - 2 : 0;
}
if (U_q[0] > zero_bplanes_p1 || U_q[1] > zero_bplanes_p1) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"Decoding this codeblock is stopped. U_q is"
"larger than bitplanes + 1 \n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
ls0 = lsp[2]; lsp[1] = lsp[2] = 0;
locs = 0xFF;
if (x + 4 > width) {
locs >>= (x + 4 - width) << 1;
}
locs = y + 2 <= height ? locs : (locs & 0x55);
if ((((qinf[0] & 0xF0) >> 4) | (qinf[1] & 0xF0)) & ~locs) {
if (p_manager_mutex) {
opj_mutex_lock(p_manager_mutex);
}
opj_event_msg(p_manager, EVT_ERROR, "Malformed HT codeblock. "
"VLC code produces significant samples outside "
"the codeblock area.\n");
if (p_manager_mutex) {
opj_mutex_unlock(p_manager_mutex);
}
return OPJ_FALSE;
}
if (qinf[0] & 0x10) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 12) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= ((qinf[0] & 0x100) >> 8) << m_n;
v_n |= 1; sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x1) {
sp[0] = 0;
}
if (qinf[0] & 0x20) { OPJ_UINT32 val, t;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 13) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= ((qinf[0] & 0x200) >> 9) << m_n;
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
t = lsp[0] & 0x7F; v_n = 32 - count_leading_zeros(v_n);
lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n));
} else if (locs & 0x2) {
sp[stride] = 0; }
++lsp;
++sp;
if (qinf[0] & 0x40) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 14) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[0] & 0x400) >> 10) << m_n);
v_n |= 1; sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x4) {
sp[0] = 0;
}
if (qinf[0] & 0x80) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[0] - ((qinf[0] >> 15) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= ((qinf[0] & 0x800) >> 11) << m_n;
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
} else if (locs & 0x8) {
sp[stride] = 0;
}
++sp;
if (qinf[1] & 0x10) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 12) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x100) >> 8) << m_n);
v_n |= 1; sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x10) {
sp[0] = 0;
}
if (qinf[1] & 0x20) { OPJ_UINT32 val, t;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 13) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x200) >> 9) << m_n);
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
t = lsp[0] & 0x7F; v_n = 32 - count_leading_zeros(v_n);
lsp[0] = (OPJ_UINT8)(0x80 | (t > v_n ? t : v_n));
} else if (locs & 0x20) {
sp[stride] = 0; }
++lsp;
++sp;
if (qinf[1] & 0x40) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 14) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x400) >> 10) << m_n);
v_n |= 1; sp[0] = val | ((v_n + 2) << (p - 1));
} else if (locs & 0x40) {
sp[0] = 0;
}
if (qinf[1] & 0x80) { OPJ_UINT32 val;
ms_val = frwd_fetch(&magsgn);
m_n = U_q[1] - ((qinf[1] >> 15) & 1); frwd_advance(&magsgn, m_n);
val = ms_val << 31;
v_n = ms_val & ((1U << m_n) - 1);
v_n |= (((qinf[1] & 0x800) >> 11) << m_n);
v_n |= 1; sp[stride] = val | ((v_n + 2) << (p - 1));
lsp[0] = (OPJ_UINT8)(0x80 | (32 - count_leading_zeros(v_n)));
} else if (locs & 0x80) {
sp[stride] = 0;
}
++sp;
}
y += 2;
if (num_passes > 1 && (y & 3) == 0) {
if (num_passes > 2) { OPJ_UINT32 *cur_sig = y & 0x4 ? sigma1 : sigma2;
OPJ_UINT32 *dpp = decoded_data + (y - 4) * stride;
OPJ_UINT32 half = 1u << (p - 2); OPJ_INT32 i;
for (i = 0; i < width; i += 8) {
OPJ_UINT32 cwd = rev_fetch_mrp(&magref); OPJ_UINT32 sig = *cur_sig++; OPJ_UINT32 col_mask = 0xFu; OPJ_UINT32 *dp = dpp + i; if (sig) { int j;
for (j = 0; j < 8; ++j, dp++) { if (sig & col_mask) { OPJ_UINT32 sample_mask = 0x11111111u & col_mask;
if (sig & sample_mask) { OPJ_UINT32 sym;
assert(dp[0] != 0); sym = cwd & 1; dp[0] ^= (1 - sym) << (p - 1);
dp[0] |= half; cwd >>= 1; }
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[stride] != 0);
sym = cwd & 1;
dp[stride] ^= (1 - sym) << (p - 1);
dp[stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[2 * stride] != 0);
sym = cwd & 1;
dp[2 * stride] ^= (1 - sym) << (p - 1);
dp[2 * stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[3 * stride] != 0);
sym = cwd & 1;
dp[3 * stride] ^= (1 - sym) << (p - 1);
dp[3 * stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
}
col_mask <<= 4; }
}
rev_advance_mrp(&magref, population_count(sig));
}
}
if (y >= 4) { OPJ_UINT32 *sig = y & 0x4 ? sigma1 : sigma2;
OPJ_UINT32 *mbr = y & 0x4 ? mbr1 : mbr2;
OPJ_UINT32 prev = 0; OPJ_INT32 i;
for (i = 0; i < width; i += 8, mbr++, sig++) {
OPJ_UINT32 t, z;
mbr[0] = sig[0]; mbr[0] |= prev >> 28; mbr[0] |= sig[0] << 4; mbr[0] |= sig[0] >> 4; mbr[0] |= sig[1] << 28; prev = sig[0];
t = mbr[0], z = mbr[0];
z |= (t & 0x77777777) << 1; z |= (t & 0xEEEEEEEE) >> 1; mbr[0] = z & ~sig[0]; }
}
if (y >= 8) { OPJ_UINT32 *cur_sig, *cur_mbr, *nxt_sig, *nxt_mbr;
OPJ_UINT32 prev;
OPJ_UINT32 val;
OPJ_INT32 i;
cur_sig = y & 0x4 ? sigma2 : sigma1;
cur_mbr = y & 0x4 ? mbr2 : mbr1;
nxt_sig = y & 0x4 ? sigma1 : sigma2; prev = 0; for (i = 0; i < width; i += 8, cur_mbr++, cur_sig++, nxt_sig++) {
OPJ_UINT32 t = nxt_sig[0];
t |= prev >> 28; t |= nxt_sig[0] << 4; t |= nxt_sig[0] >> 4; t |= nxt_sig[1] << 28; prev = nxt_sig[0];
if (!stripe_causal) {
cur_mbr[0] |= (t & 0x11111111u) << 3; }
cur_mbr[0] &= ~cur_sig[0]; }
cur_sig = y & 0x4 ? sigma2 : sigma1;
cur_mbr = y & 0x4 ? mbr2 : mbr1;
nxt_sig = y & 0x4 ? sigma1 : sigma2; nxt_mbr = y & 0x4 ? mbr1 : mbr2; val = 3u << (p - 2); for (i = 0; i < width;
i += 8, cur_sig++, cur_mbr++, nxt_sig++, nxt_mbr++) {
OPJ_UINT32 ux, tx;
OPJ_UINT32 mbr = *cur_mbr;
OPJ_UINT32 new_sig = 0;
if (mbr) { OPJ_INT32 n;
for (n = 0; n < 8; n += 4) {
OPJ_UINT32 col_mask;
OPJ_UINT32 inv_sig;
OPJ_INT32 end;
OPJ_INT32 j;
OPJ_UINT32 cwd = frwd_fetch(&sigprop); OPJ_UINT32 cnt = 0;
OPJ_UINT32 *dp = decoded_data + (y - 8) * stride;
dp += i + n;
col_mask = 0xFu << (4 * n);
inv_sig = ~cur_sig[0];
end = n + 4 + i < width ? n + 4 : width - i;
for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
OPJ_UINT32 sample_mask;
if ((col_mask & mbr) == 0) { continue;
}
sample_mask = 0x11111111u & col_mask; if (mbr & sample_mask) {
assert(dp[0] == 0); if (cwd & 1) { OPJ_UINT32 t;
new_sig |= sample_mask; t = 0x32u << (j * 4); mbr |= t & inv_sig; }
cwd >>= 1;
++cnt; }
sample_mask += sample_mask; if (mbr & sample_mask) {
assert(dp[stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0x74u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (mbr & sample_mask) {
assert(dp[2 * stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0xE8u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (mbr & sample_mask) {
assert(dp[3 * stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0xC0u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
}
if (new_sig & (0xFFFFu << (4 * n))) { OPJ_UINT32 col_mask;
OPJ_INT32 j;
OPJ_UINT32 *dp = decoded_data + (y - 8) * stride;
dp += i + n; col_mask = 0xFu << (4 * n);
for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
OPJ_UINT32 sample_mask;
if ((col_mask & new_sig) == 0) { continue;
}
sample_mask = 0x11111111u & col_mask;
if (new_sig & sample_mask) {
assert(dp[0] == 0);
dp[0] |= ((cwd & 1) << 31) | val; cwd >>= 1;
++cnt; }
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[stride] == 0);
dp[stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[2 * stride] == 0);
dp[2 * stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[3 * stride] == 0);
dp[3 * stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
}
}
frwd_advance(&sigprop, cnt); cnt = 0;
if (n == 4) {
OPJ_UINT32 t = new_sig >> 28;
t |= ((t & 0xE) >> 1) | ((t & 7) << 1);
cur_mbr[1] |= t & ~cur_sig[1];
}
}
}
new_sig |= cur_sig[0];
ux = (new_sig & 0x88888888) >> 3;
tx = ux | (ux << 4) | (ux >> 4); if (i > 0) {
nxt_mbr[-1] |= (ux << 28) & ~nxt_sig[-1];
}
nxt_mbr[0] |= tx & ~nxt_sig[0];
nxt_mbr[1] |= (ux >> 28) & ~nxt_sig[1];
}
cur_sig = y & 0x4 ? sigma2 : sigma1;
memset(cur_sig, 0, ((((OPJ_UINT32)width + 7u) >> 3) + 1u) << 2);
}
}
}
if (num_passes > 1) {
OPJ_INT32 st, y;
if (num_passes > 2 && ((height & 3) == 1 || (height & 3) == 2)) {
OPJ_UINT32 *cur_sig = height & 0x4 ? sigma2 : sigma1; OPJ_UINT32 *dpp = decoded_data + (height & 0xFFFFFC) * stride;
OPJ_UINT32 half = 1u << (p - 2);
OPJ_INT32 i;
for (i = 0; i < width; i += 8) {
OPJ_UINT32 cwd = rev_fetch_mrp(&magref);
OPJ_UINT32 sig = *cur_sig++;
OPJ_UINT32 col_mask = 0xF;
OPJ_UINT32 *dp = dpp + i;
if (sig) {
int j;
for (j = 0; j < 8; ++j, dp++) {
if (sig & col_mask) {
OPJ_UINT32 sample_mask = 0x11111111 & col_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[0] != 0);
sym = cwd & 1;
dp[0] ^= (1 - sym) << (p - 1);
dp[0] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[stride] != 0);
sym = cwd & 1;
dp[stride] ^= (1 - sym) << (p - 1);
dp[stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[2 * stride] != 0);
sym = cwd & 1;
dp[2 * stride] ^= (1 - sym) << (p - 1);
dp[2 * stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
if (sig & sample_mask) {
OPJ_UINT32 sym;
assert(dp[3 * stride] != 0);
sym = cwd & 1;
dp[3 * stride] ^= (1 - sym) << (p - 1);
dp[3 * stride] |= half;
cwd >>= 1;
}
sample_mask += sample_mask;
}
col_mask <<= 4;
}
}
rev_advance_mrp(&magref, population_count(sig));
}
}
if ((height & 3) == 1 || (height & 3) == 2) {
OPJ_UINT32 *sig = height & 0x4 ? sigma2 : sigma1;
OPJ_UINT32 *mbr = height & 0x4 ? mbr2 : mbr1;
OPJ_UINT32 prev = 0;
OPJ_INT32 i;
for (i = 0; i < width; i += 8, mbr++, sig++) {
OPJ_UINT32 t, z;
mbr[0] = sig[0];
mbr[0] |= prev >> 28; mbr[0] |= sig[0] << 4; mbr[0] |= sig[0] >> 4; mbr[0] |= sig[1] << 28; prev = sig[0];
t = mbr[0], z = mbr[0];
z |= (t & 0x77777777) << 1; z |= (t & 0xEEEEEEEE) >> 1; mbr[0] = z & ~sig[0]; }
}
st = height;
st -= height > 6 ? (((height + 1) & 3) + 3) : height;
for (y = st; y < height; y += 4) {
OPJ_UINT32 *cur_sig, *cur_mbr, *nxt_sig, *nxt_mbr;
OPJ_UINT32 val;
OPJ_INT32 i;
OPJ_UINT32 pattern = 0xFFFFFFFFu; if (height - y == 3) {
pattern = 0x77777777u;
} else if (height - y == 2) {
pattern = 0x33333333u;
} else if (height - y == 1) {
pattern = 0x11111111u;
}
if (height - y > 4) {
OPJ_UINT32 prev = 0;
OPJ_INT32 i;
cur_sig = y & 0x4 ? sigma2 : sigma1;
cur_mbr = y & 0x4 ? mbr2 : mbr1;
nxt_sig = y & 0x4 ? sigma1 : sigma2;
for (i = 0; i < width; i += 8, cur_mbr++, cur_sig++, nxt_sig++) {
OPJ_UINT32 t = nxt_sig[0];
t |= prev >> 28; t |= nxt_sig[0] << 4; t |= nxt_sig[0] >> 4; t |= nxt_sig[1] << 28; prev = nxt_sig[0];
if (!stripe_causal) {
cur_mbr[0] |= (t & 0x11111111u) << 3;
}
cur_mbr[0] &= ~cur_sig[0];
}
}
cur_sig = y & 0x4 ? sigma2 : sigma1;
cur_mbr = y & 0x4 ? mbr2 : mbr1;
nxt_sig = y & 0x4 ? sigma1 : sigma2;
nxt_mbr = y & 0x4 ? mbr1 : mbr2;
val = 3u << (p - 2);
for (i = 0; i < width; i += 8,
cur_sig++, cur_mbr++, nxt_sig++, nxt_mbr++) {
OPJ_UINT32 mbr = *cur_mbr & pattern; OPJ_UINT32 new_sig = 0;
OPJ_UINT32 ux, tx;
if (mbr) {
OPJ_INT32 n;
for (n = 0; n < 8; n += 4) {
OPJ_UINT32 col_mask;
OPJ_UINT32 inv_sig;
OPJ_INT32 end;
OPJ_INT32 j;
OPJ_UINT32 cwd = frwd_fetch(&sigprop);
OPJ_UINT32 cnt = 0;
OPJ_UINT32 *dp = decoded_data + y * stride;
dp += i + n;
col_mask = 0xFu << (4 * n);
inv_sig = ~cur_sig[0] & pattern;
end = n + 4 + i < width ? n + 4 : width - i;
for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
OPJ_UINT32 sample_mask;
if ((col_mask & mbr) == 0) {
continue;
}
sample_mask = 0x11111111u & col_mask;
if (mbr & sample_mask) {
assert(dp[0] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0x32u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (mbr & sample_mask) {
assert(dp[stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0x74u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (mbr & sample_mask) {
assert(dp[2 * stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0xE8u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (mbr & sample_mask) {
assert(dp[3 * stride] == 0);
if (cwd & 1) {
OPJ_UINT32 t;
new_sig |= sample_mask;
t = 0xC0u << (j * 4);
mbr |= t & inv_sig;
}
cwd >>= 1;
++cnt;
}
}
if (new_sig & (0xFFFFu << (4 * n))) {
OPJ_UINT32 col_mask;
OPJ_INT32 j;
OPJ_UINT32 *dp = decoded_data + y * stride;
dp += i + n;
col_mask = 0xFu << (4 * n);
for (j = n; j < end; ++j, ++dp, col_mask <<= 4) {
OPJ_UINT32 sample_mask;
if ((col_mask & new_sig) == 0) {
continue;
}
sample_mask = 0x11111111u & col_mask;
if (new_sig & sample_mask) {
assert(dp[0] == 0);
dp[0] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[stride] == 0);
dp[stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[2 * stride] == 0);
dp[2 * stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
sample_mask += sample_mask;
if (new_sig & sample_mask) {
assert(dp[3 * stride] == 0);
dp[3 * stride] |= ((cwd & 1) << 31) | val;
cwd >>= 1;
++cnt;
}
}
}
frwd_advance(&sigprop, cnt);
cnt = 0;
if (n == 4) {
OPJ_UINT32 t = new_sig >> 28;
t |= ((t & 0xE) >> 1) | ((t & 7) << 1);
cur_mbr[1] |= t & ~cur_sig[1];
}
}
}
new_sig |= cur_sig[0];
ux = (new_sig & 0x88888888) >> 3;
tx = ux | (ux << 4) | (ux >> 4);
if (i > 0) {
nxt_mbr[-1] |= (ux << 28) & ~nxt_sig[-1];
}
nxt_mbr[0] |= tx & ~nxt_sig[0];
nxt_mbr[1] |= (ux >> 28) & ~nxt_sig[1];
}
}
}
{
OPJ_INT32 x, y;
for (y = 0; y < height; ++y) {
OPJ_INT32* sp = (OPJ_INT32*)decoded_data + y * stride;
for (x = 0; x < width; ++x, ++sp) {
OPJ_INT32 val = (*sp & 0x7FFFFFFF);
*sp = ((OPJ_UINT32) * sp & 0x80000000) ? -val : val;
}
}
}
return OPJ_TRUE;
}