src/lib/openjp2/mqc.c

   1 /*
   2  * The copyright in this software is being made available under the 2-clauses
   3  * BSD License, included below. This software may be subject to other third
   4  * party and contributor rights, including patent rights, and no such rights
   5  * are granted under this license.
   6  *
   7  * Copyright (c) 2002-2014, Universite catholique de Louvain (UCL), Belgium
   8  * Copyright (c) 2002-2014, Professor Benoit Macq
   9  * Copyright (c) 2001-2003, David Janssens
  10  * Copyright (c) 2002-2003, Yannick Verschueren
  11  * Copyright (c) 2003-2007, Francois-Olivier Devaux
  12  * Copyright (c) 2003-2014, Antonin Descampe
  13  * Copyright (c) 2005, Herve Drolon, FreeImage Team
  14  * Copyright (c) 2008, Jerome Fimes, Communications & Systemes <jerome.fimes@c-s.fr>
  15  * All rights reserved.
  16  *
  17  * Redistribution and use in source and binary forms, with or without
  18  * modification, are permitted provided that the following conditions
  19  * are met:
  20  * 1. Redistributions of source code must retain the above copyright
  21  *    notice, this list of conditions and the following disclaimer.
  22  * 2. Redistributions in binary form must reproduce the above copyright
  23  *    notice, this list of conditions and the following disclaimer in the
  24  *    documentation and/or other materials provided with the distribution.
  25  *
  26  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
  27  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  28  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  29  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  30  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  36  * POSSIBILITY OF SUCH DAMAGE.
  37  */
  38
  39 #include "opj_includes.h"
  40
  41 /** @defgroup MQC MQC - Implementation of an MQ-Coder */
  42 /*@{*/
  43
  44 /** @name Local static functions */
  45 /*@{*/
  46
  47 /**
  48 Output a byte, doing bit-stuffing if necessary.
  49 After a 0xff byte, the next byte must be smaller than 0x90.
  50 @param mqc MQC handle
  51 */
  52 static void opj_mqc_byteout(opj_mqc_t *mqc);
  53 /**
  54 Renormalize mqc->a and mqc->c while encoding, so that mqc->a stays between 0x8000 and 0x10000
  55 @param mqc MQC handle
  56 */
  57 static void opj_mqc_renorme(opj_mqc_t *mqc);
  58 /**
  59 Encode the most probable symbol
  60 @param mqc MQC handle
  61 */
  62 static void opj_mqc_codemps(opj_mqc_t *mqc);
  63 /**
  64 Encode the most least symbol
  65 @param mqc MQC handle
  66 */
  67 static void opj_mqc_codelps(opj_mqc_t *mqc);
  68 /**
  69 Fill mqc->c with 1's for flushing
  70 @param mqc MQC handle
  71 */
  72 static void opj_mqc_setbits(opj_mqc_t *mqc);
  73 /**
  74 FIXME DOC
  75 @param mqc MQC handle
  76 @return
  77 */
  78 static INLINE OPJ_INT32 opj_mqc_mpsexchange(opj_mqc_t *const mqc);
  79 /**
  80 FIXME DOC
  81 @param mqc MQC handle
  82 @return
  83 */
  84 static INLINE OPJ_INT32 opj_mqc_lpsexchange(opj_mqc_t *const mqc);
  85 /**
  86 Input a byte
  87 @param mqc MQC handle
  88 */
  89 static INLINE void opj_mqc_bytein(opj_mqc_t *const mqc);
  90 /**
  91 Renormalize mqc->a and mqc->c while decoding
  92 @param mqc MQC handle
  93 */
  94 static INLINE void opj_mqc_renormd(opj_mqc_t *const mqc);
  95 /*@}*/
  96
  97 /*@}*/
  98
  99 /* <summary> */
 100 /* This array defines all the possible states for a context. */
 101 /* </summary> */
 102 static opj_mqc_state_t mqc_states[47 * 2] = {
 103         {0x5601, 0, &mqc_states[2], &mqc_states[3]},
 104         {0x5601, 1, &mqc_states[3], &mqc_states[2]},
 105         {0x3401, 0, &mqc_states[4], &mqc_states[12]},
 106         {0x3401, 1, &mqc_states[5], &mqc_states[13]},
 107         {0x1801, 0, &mqc_states[6], &mqc_states[18]},
 108         {0x1801, 1, &mqc_states[7], &mqc_states[19]},
 109         {0x0ac1, 0, &mqc_states[8], &mqc_states[24]},
 110         {0x0ac1, 1, &mqc_states[9], &mqc_states[25]},
 111         {0x0521, 0, &mqc_states[10], &mqc_states[58]},
 112         {0x0521, 1, &mqc_states[11], &mqc_states[59]},
 113         {0x0221, 0, &mqc_states[76], &mqc_states[66]},
 114         {0x0221, 1, &mqc_states[77], &mqc_states[67]},
 115         {0x5601, 0, &mqc_states[14], &mqc_states[13]},
 116         {0x5601, 1, &mqc_states[15], &mqc_states[12]},
 117         {0x5401, 0, &mqc_states[16], &mqc_states[28]},
 118         {0x5401, 1, &mqc_states[17], &mqc_states[29]},
 119         {0x4801, 0, &mqc_states[18], &mqc_states[28]},
 120         {0x4801, 1, &mqc_states[19], &mqc_states[29]},
 121         {0x3801, 0, &mqc_states[20], &mqc_states[28]},
 122         {0x3801, 1, &mqc_states[21], &mqc_states[29]},
 123         {0x3001, 0, &mqc_states[22], &mqc_states[34]},
 124         {0x3001, 1, &mqc_states[23], &mqc_states[35]},
 125         {0x2401, 0, &mqc_states[24], &mqc_states[36]},
 126         {0x2401, 1, &mqc_states[25], &mqc_states[37]},
 127         {0x1c01, 0, &mqc_states[26], &mqc_states[40]},
 128         {0x1c01, 1, &mqc_states[27], &mqc_states[41]},
 129         {0x1601, 0, &mqc_states[58], &mqc_states[42]},
 130         {0x1601, 1, &mqc_states[59], &mqc_states[43]},
 131         {0x5601, 0, &mqc_states[30], &mqc_states[29]},
 132         {0x5601, 1, &mqc_states[31], &mqc_states[28]},
 133         {0x5401, 0, &mqc_states[32], &mqc_states[28]},
 134         {0x5401, 1, &mqc_states[33], &mqc_states[29]},
 135         {0x5101, 0, &mqc_states[34], &mqc_states[30]},
 136         {0x5101, 1, &mqc_states[35], &mqc_states[31]},
 137         {0x4801, 0, &mqc_states[36], &mqc_states[32]},
 138         {0x4801, 1, &mqc_states[37], &mqc_states[33]},
 139         {0x3801, 0, &mqc_states[38], &mqc_states[34]},
 140         {0x3801, 1, &mqc_states[39], &mqc_states[35]},
 141         {0x3401, 0, &mqc_states[40], &mqc_states[36]},
 142         {0x3401, 1, &mqc_states[41], &mqc_states[37]},
 143         {0x3001, 0, &mqc_states[42], &mqc_states[38]},
 144         {0x3001, 1, &mqc_states[43], &mqc_states[39]},
 145         {0x2801, 0, &mqc_states[44], &mqc_states[38]},
 146         {0x2801, 1, &mqc_states[45], &mqc_states[39]},
 147         {0x2401, 0, &mqc_states[46], &mqc_states[40]},
 148         {0x2401, 1, &mqc_states[47], &mqc_states[41]},
 149         {0x2201, 0, &mqc_states[48], &mqc_states[42]},
 150         {0x2201, 1, &mqc_states[49], &mqc_states[43]},
 151         {0x1c01, 0, &mqc_states[50], &mqc_states[44]},
 152         {0x1c01, 1, &mqc_states[51], &mqc_states[45]},
 153         {0x1801, 0, &mqc_states[52], &mqc_states[46]},
 154         {0x1801, 1, &mqc_states[53], &mqc_states[47]},
 155         {0x1601, 0, &mqc_states[54], &mqc_states[48]},
 156         {0x1601, 1, &mqc_states[55], &mqc_states[49]},
 157         {0x1401, 0, &mqc_states[56], &mqc_states[50]},
 158         {0x1401, 1, &mqc_states[57], &mqc_states[51]},
 159         {0x1201, 0, &mqc_states[58], &mqc_states[52]},
 160         {0x1201, 1, &mqc_states[59], &mqc_states[53]},
 161         {0x1101, 0, &mqc_states[60], &mqc_states[54]},
 162         {0x1101, 1, &mqc_states[61], &mqc_states[55]},
 163         {0x0ac1, 0, &mqc_states[62], &mqc_states[56]},
 164         {0x0ac1, 1, &mqc_states[63], &mqc_states[57]},
 165         {0x09c1, 0, &mqc_states[64], &mqc_states[58]},
 166         {0x09c1, 1, &mqc_states[65], &mqc_states[59]},
 167         {0x08a1, 0, &mqc_states[66], &mqc_states[60]},
 168         {0x08a1, 1, &mqc_states[67], &mqc_states[61]},
 169         {0x0521, 0, &mqc_states[68], &mqc_states[62]},
 170         {0x0521, 1, &mqc_states[69], &mqc_states[63]},
 171         {0x0441, 0, &mqc_states[70], &mqc_states[64]},
 172         {0x0441, 1, &mqc_states[71], &mqc_states[65]},
 173         {0x02a1, 0, &mqc_states[72], &mqc_states[66]},
 174         {0x02a1, 1, &mqc_states[73], &mqc_states[67]},
 175         {0x0221, 0, &mqc_states[74], &mqc_states[68]},
 176         {0x0221, 1, &mqc_states[75], &mqc_states[69]},
 177         {0x0141, 0, &mqc_states[76], &mqc_states[70]},
 178         {0x0141, 1, &mqc_states[77], &mqc_states[71]},
 179         {0x0111, 0, &mqc_states[78], &mqc_states[72]},
 180         {0x0111, 1, &mqc_states[79], &mqc_states[73]},
 181         {0x0085, 0, &mqc_states[80], &mqc_states[74]},
 182         {0x0085, 1, &mqc_states[81], &mqc_states[75]},
 183         {0x0049, 0, &mqc_states[82], &mqc_states[76]},
 184         {0x0049, 1, &mqc_states[83], &mqc_states[77]},
 185         {0x0025, 0, &mqc_states[84], &mqc_states[78]},
 186         {0x0025, 1, &mqc_states[85], &mqc_states[79]},
 187         {0x0015, 0, &mqc_states[86], &mqc_states[80]},
 188         {0x0015, 1, &mqc_states[87], &mqc_states[81]},
 189         {0x0009, 0, &mqc_states[88], &mqc_states[82]},
 190         {0x0009, 1, &mqc_states[89], &mqc_states[83]},
 191         {0x0005, 0, &mqc_states[90], &mqc_states[84]},
 192         {0x0005, 1, &mqc_states[91], &mqc_states[85]},
 193         {0x0001, 0, &mqc_states[90], &mqc_states[86]},
 194         {0x0001, 1, &mqc_states[91], &mqc_states[87]},
 195         {0x5601, 0, &mqc_states[92], &mqc_states[92]},
 196         {0x5601, 1, &mqc_states[93], &mqc_states[93]},
 197 };
 198
 199 /*
 200 ==========================================================
 201    local functions
 202 ==========================================================
 203 */
 204
 205 static void opj_mqc_byteout(opj_mqc_t *mqc) {
 206         if (*mqc->bp == 0xff) {
 207                 mqc->bp++;
 208                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 20);
 209                 mqc->c &= 0xfffff;
 210                 mqc->ct = 7;
 211         } else {
 212                 if ((mqc->c & 0x8000000) == 0) {        /* ((mqc->c&0x8000000)==0) CHANGE */
 213                         mqc->bp++;
 214                         *mqc->bp = (OPJ_BYTE)(mqc->c >> 19);
 215                         mqc->c &= 0x7ffff;
 216                         mqc->ct = 8;
 217                 } else {
 218                         (*mqc->bp)++;
 219                         if (*mqc->bp == 0xff) {
 220                                 mqc->c &= 0x7ffffff;
 221                                 mqc->bp++;
 222                                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 20);
 223                                 mqc->c &= 0xfffff;
 224                                 mqc->ct = 7;
 225                         } else {
 226                                 mqc->bp++;
 227                                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 19);
 228                                 mqc->c &= 0x7ffff;
 229                                 mqc->ct = 8;
 230                         }
 231                 }
 232         }
 233 }
 234
 235 static void opj_mqc_renorme(opj_mqc_t *mqc) {
 236         do {
 237                 mqc->a <<= 1;
 238                 mqc->c <<= 1;
 239                 mqc->ct--;
 240                 if (mqc->ct == 0) {
 241                         opj_mqc_byteout(mqc);
 242                 }
 243         } while ((mqc->a & 0x8000) == 0);
 244 }
 245
 246 static void opj_mqc_codemps(opj_mqc_t *mqc) {
 247         mqc->a -= (*mqc->curctx)->qeval;
 248         if ((mqc->a & 0x8000) == 0) {
 249                 if (mqc->a < (*mqc->curctx)->qeval) {
 250                         mqc->a = (*mqc->curctx)->qeval;
 251                 } else {
 252                         mqc->c += (*mqc->curctx)->qeval;
 253                 }
 254                 *mqc->curctx = (*mqc->curctx)->nmps;
 255                 opj_mqc_renorme(mqc);
 256         } else {
 257                 mqc->c += (*mqc->curctx)->qeval;
 258         }
 259 }
 260
 261 static void opj_mqc_codelps(opj_mqc_t *mqc) {
 262         mqc->a -= (*mqc->curctx)->qeval;
 263         if (mqc->a < (*mqc->curctx)->qeval) {
 264                 mqc->c += (*mqc->curctx)->qeval;
 265         } else {
 266                 mqc->a = (*mqc->curctx)->qeval;
 267         }
 268         *mqc->curctx = (*mqc->curctx)->nlps;
 269         opj_mqc_renorme(mqc);
 270 }
 271
 272 static void opj_mqc_setbits(opj_mqc_t *mqc) {
 273         OPJ_UINT32 tempc = mqc->c + mqc->a;
 274         mqc->c |= 0xffff;
 275         if (mqc->c >= tempc) {
 276                 mqc->c -= 0x8000;
 277         }
 278 }
 279
 280 static INLINE OPJ_INT32 opj_mqc_mpsexchange(opj_mqc_t *const mqc) {
 281         OPJ_INT32 d;
 282         if (mqc->a < (*mqc->curctx)->qeval) {
 283                 d = (OPJ_INT32)(1 - (*mqc->curctx)->mps);
 284                 *mqc->curctx = (*mqc->curctx)->nlps;
 285         } else {
 286                 d = (OPJ_INT32)(*mqc->curctx)->mps;
 287                 *mqc->curctx = (*mqc->curctx)->nmps;
 288         }
 289
 290         return d;
 291 }
 292
 293 static INLINE OPJ_INT32 opj_mqc_lpsexchange(opj_mqc_t *const mqc) {
 294         OPJ_INT32 d;
 295         if (mqc->a < (*mqc->curctx)->qeval) {
 296                 mqc->a = (*mqc->curctx)->qeval;
 297                 d = (OPJ_INT32)(*mqc->curctx)->mps;
 298                 *mqc->curctx = (*mqc->curctx)->nmps;
 299         } else {
 300                 mqc->a = (*mqc->curctx)->qeval;
 301                 d = (OPJ_INT32)(1 - (*mqc->curctx)->mps);
 302                 *mqc->curctx = (*mqc->curctx)->nlps;
 303         }
 304
 305         return d;
 306 }
 307
 308 #ifdef MQC_PERF_OPT
 309 static INLINE void opj_mqc_bytein(opj_mqc_t *const mqc) {
 310         unsigned int i = *((unsigned int *) mqc->bp);
 311         mqc->c += i & 0xffff00;
 312         mqc->ct = i & 0x0f;
 313         mqc->bp += (i >> 2) & 0x04;
 314 }
 315 #else
 316 static void opj_mqc_bytein(opj_mqc_t *const mqc) {
 317         if (mqc->bp != mqc->end) {
 318                 OPJ_UINT32 c;
 319                 if (mqc->bp + 1 != mqc->end) {
 320                         c = *(mqc->bp + 1);
 321                 } else {
 322                         c = 0xff;
 323                 }
 324                 if (*mqc->bp == 0xff) {
 325                         if (c > 0x8f) {
 326                                 mqc->c += 0xff00;
 327                                 mqc->ct = 8;
 328                         } else {
 329                                 mqc->bp++;
 330                                 mqc->c += c << 9;
 331                                 mqc->ct = 7;
 332                         }
 333                 } else {
 334                         mqc->bp++;
 335                         mqc->c += c << 8;
 336                         mqc->ct = 8;
 337                 }
 338         } else {
 339                 mqc->c += 0xff00;
 340                 mqc->ct = 8;
 341         }
 342 }
 343 #endif
 344
 345 static INLINE void opj_mqc_renormd(opj_mqc_t *const mqc) {
 346         do {
 347                 if (mqc->ct == 0) {
 348                         opj_mqc_bytein(mqc);
 349                 }
 350                 mqc->a <<= 1;
 351                 mqc->c <<= 1;
 352                 mqc->ct--;
 353         } while (mqc->a < 0x8000);
 354 }
 355
 356 /*
 357 ==========================================================
 358    MQ-Coder interface
 359 ==========================================================
 360 */
 361
 362 opj_mqc_t* opj_mqc_create(void) {
 363         opj_mqc_t *mqc = (opj_mqc_t*)opj_malloc(sizeof(opj_mqc_t));
 364 #ifdef MQC_PERF_OPT
 365         if (mqc) {
 366                 mqc->buffer = NULL;
 367         }
 368 #endif
 369         return mqc;
 370 }
 371
 372 void opj_mqc_destroy(opj_mqc_t *mqc) {
 373         if(mqc) {
 374 #ifdef MQC_PERF_OPT
 375                 if (mqc->buffer) {
 376                         opj_free(mqc->buffer);
 377                 }
 378 #endif
 379                 opj_free(mqc);
 380         }
 381 }
 382
 383 OPJ_UINT32 opj_mqc_numbytes(opj_mqc_t *mqc) {
 384         const ptrdiff_t diff = mqc->bp - mqc->start;
 385 #if 0
 386   assert( diff <= 0xffffffff && diff >= 0 ); /* UINT32_MAX */
 387 #endif
 388         return (OPJ_UINT32)diff;
 389 }
 390
 391 void opj_mqc_init_enc(opj_mqc_t *mqc, OPJ_BYTE *bp) {
 392     /* TODO MSD: need to take a look to the v2 version */
 393         opj_mqc_setcurctx(mqc, 0);
 394         mqc->a = 0x8000;
 395         mqc->c = 0;
 396         mqc->bp = bp - 1;
 397         mqc->ct = 12;
 398         if (*mqc->bp == 0xff) {
 399                 mqc->ct = 13;
 400         }
 401         mqc->start = bp;
 402 }
 403
 404 void opj_mqc_encode(opj_mqc_t *mqc, OPJ_UINT32 d) {
 405         if ((*mqc->curctx)->mps == d) {
 406                 opj_mqc_codemps(mqc);
 407         } else {
 408                 opj_mqc_codelps(mqc);
 409         }
 410 }
 411
 412 void opj_mqc_flush(opj_mqc_t *mqc) {
 413         opj_mqc_setbits(mqc);
 414         mqc->c <<= mqc->ct;
 415         opj_mqc_byteout(mqc);
 416         mqc->c <<= mqc->ct;
 417         opj_mqc_byteout(mqc);
 418
 419         if (*mqc->bp != 0xff) {
 420                 mqc->bp++;
 421         }
 422 }
 423
 424 void opj_mqc_bypass_init_enc(opj_mqc_t *mqc) {
 425         mqc->c = 0;
 426         mqc->ct = 8;
 427         /*if (*mqc->bp == 0xff) {
 428         mqc->ct = 7;
 429      } */
 430 }
 431
 432 void opj_mqc_bypass_enc(opj_mqc_t *mqc, OPJ_UINT32 d) {
 433         mqc->ct--;
 434         mqc->c = mqc->c + (d << mqc->ct);
 435         if (mqc->ct == 0) {
 436                 mqc->bp++;
 437                 *mqc->bp = (OPJ_BYTE)mqc->c;
 438                 mqc->ct = 8;
 439                 if (*mqc->bp == 0xff) {
 440                         mqc->ct = 7;
 441                 }
 442                 mqc->c = 0;
 443         }
 444 }
 445
 446 OPJ_UINT32 opj_mqc_bypass_flush_enc(opj_mqc_t *mqc) {
 447         OPJ_BYTE bit_padding;
 448
 449         bit_padding = 0;
 450
 451         if (mqc->ct != 0) {
 452                 while (mqc->ct > 0) {
 453                         mqc->ct--;
 454                         mqc->c += (OPJ_UINT32)(bit_padding << mqc->ct);
 455                         bit_padding = (bit_padding + 1) & 0x01;
 456                 }
 457                 mqc->bp++;
 458                 *mqc->bp = (OPJ_BYTE)mqc->c;
 459                 mqc->ct = 8;
 460                 mqc->c = 0;
 461         }
 462
 463         return 1;
 464 }
 465
 466 void opj_mqc_reset_enc(opj_mqc_t *mqc) {
 467         opj_mqc_resetstates(mqc);
 468         opj_mqc_setstate(mqc, T1_CTXNO_UNI, 0, 46);
 469         opj_mqc_setstate(mqc, T1_CTXNO_AGG, 0, 3);
 470         opj_mqc_setstate(mqc, T1_CTXNO_ZC, 0, 4);
 471 }
 472
 473 OPJ_UINT32 opj_mqc_restart_enc(opj_mqc_t *mqc) {
 474         OPJ_UINT32 correction = 1;
 475
 476         /* <flush part> */
 477         OPJ_INT32 n = (OPJ_INT32)(27 - 15 - mqc->ct);
 478         mqc->c <<= mqc->ct;
 479         while (n > 0) {
 480                 opj_mqc_byteout(mqc);
 481                 n -= (OPJ_INT32)mqc->ct;
 482                 mqc->c <<= mqc->ct;
 483         }
 484         opj_mqc_byteout(mqc);
 485
 486         return correction;
 487 }
 488
 489 void opj_mqc_restart_init_enc(opj_mqc_t *mqc) {
 490         /* <Re-init part> */
 491         opj_mqc_setcurctx(mqc, 0);
 492         mqc->a = 0x8000;
 493         mqc->c = 0;
 494         mqc->ct = 12;
 495         mqc->bp--;
 496         if (*mqc->bp == 0xff) {
 497                 mqc->ct = 13;
 498         }
 499 }
 500
 501 void opj_mqc_erterm_enc(opj_mqc_t *mqc) {
 502         OPJ_INT32 k = (OPJ_INT32)(11 - mqc->ct + 1);
 503
 504         while (k > 0) {
 505                 mqc->c <<= mqc->ct;
 506                 mqc->ct = 0;
 507                 opj_mqc_byteout(mqc);
 508                 k -= (OPJ_INT32)mqc->ct;
 509         }
 510
 511         if (*mqc->bp != 0xff) {
 512                 opj_mqc_byteout(mqc);
 513         }
 514 }
 515
 516 void opj_mqc_segmark_enc(opj_mqc_t *mqc) {
 517         OPJ_UINT32 i;
 518         opj_mqc_setcurctx(mqc, 18);
 519
 520         for (i = 1; i < 5; i++) {
 521                 opj_mqc_encode(mqc, i % 2);
 522         }
 523 }
 524
 525 OPJ_BOOL opj_mqc_init_dec(opj_mqc_t *mqc, OPJ_BYTE *bp, OPJ_UINT32 len) {
 526         opj_mqc_setcurctx(mqc, 0);
 527         mqc->start = bp;
 528         mqc->end = bp + len;
 529         mqc->bp = bp;
 530         if (len==0) mqc->c = 0xff << 16;
 531         else mqc->c = (OPJ_UINT32)(*mqc->bp << 16);
 532
 533 #ifdef MQC_PERF_OPT /* TODO_MSD: check this option and put in experimental */
 534         {
 535         OPJ_UINT32 c;
 536                 OPJ_UINT32 *ip;
 537                 OPJ_BYTE *end = mqc->end - 1;
 538         void* new_buffer = opj_realloc(mqc->buffer, (len + 1) * sizeof(OPJ_UINT32));
 539         if (! new_buffer) {
 540             opj_free(mqc->buffer);
 541             mqc->buffer = NULL;
 542             return OPJ_FALSE;
 543         }
 544         mqc->buffer = new_buffer;
 545
 546         ip = (OPJ_UINT32 *) mqc->buffer;
 547
 548                 while (bp < end) {
 549                         c = *(bp + 1);
 550                         if (*bp == 0xff) {
 551                                 if (c > 0x8f) {
 552                                         break;
 553                                 } else {
 554                                         *ip = 0x00000017 | (c << 9);
 555                                 }
 556                         } else {
 557                                 *ip = 0x00000018 | (c << 8);
 558                         }
 559                         bp++;
 560                         ip++;
 561                 }
 562
 563                 /* Handle last byte of data */
 564                 c = 0xff;
 565                 if (*bp == 0xff) {
 566                         *ip = 0x0000ff18;
 567                 } else {
 568                         bp++;
 569                         *ip = 0x00000018 | (c << 8);
 570                 }
 571                 ip++;
 572
 573                 *ip = 0x0000ff08;
 574                 mqc->bp = mqc->buffer;
 575         }
 576 #endif
 577         opj_mqc_bytein(mqc);
 578         mqc->c <<= 7;
 579         mqc->ct -= 7;
 580         mqc->a = 0x8000;
 581         return OPJ_TRUE;
 582 }
 583
 584 OPJ_INT32 opj_mqc_decode(opj_mqc_t *const mqc) {
 585         OPJ_INT32 d;
 586         mqc->a -= (*mqc->curctx)->qeval;
 587         if ((mqc->c >> 16) < (*mqc->curctx)->qeval) {
 588                 d = opj_mqc_lpsexchange(mqc);
 589                 opj_mqc_renormd(mqc);
 590         } else {
 591                 mqc->c -= (*mqc->curctx)->qeval << 16;
 592                 if ((mqc->a & 0x8000) == 0) {
 593                         d = opj_mqc_mpsexchange(mqc);
 594                         opj_mqc_renormd(mqc);
 595                 } else {
 596                         d = (OPJ_INT32)(*mqc->curctx)->mps;
 597                 }
 598         }
 599
 600         return d;
 601 }
 602
 603 void opj_mqc_resetstates(opj_mqc_t *mqc) {
 604         OPJ_UINT32 i;
 605         for (i = 0; i < MQC_NUMCTXS; i++) {
 606                 mqc->ctxs[i] = mqc_states;
 607         }
 608 }
 609
 610 void opj_mqc_setstate(opj_mqc_t *mqc, OPJ_UINT32 ctxno, OPJ_UINT32 msb, OPJ_INT32 prob) {
 611         mqc->ctxs[ctxno] = &mqc_states[msb + (OPJ_UINT32)(prob << 1)];
 612 }
 613
 614