1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689 |
- #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;
- }
|