suppress valgrind error - avoid accessing uninitialized memory in mq encoder
[openjpeg.git] / 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         /* avoid accessing uninitialized memory*/
207         if (mqc->bp == mqc->start-1) {
208                 mqc->bp++;
209                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 19);
210                 mqc->c &= 0x7ffff;
211                 mqc->ct = 8;
212         }
213         else if (*mqc->bp == 0xff) {
214                 mqc->bp++;
215                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 20);
216                 mqc->c &= 0xfffff;
217                 mqc->ct = 7;
218         } else {
219                 if ((mqc->c & 0x8000000) == 0) {        
220                         mqc->bp++;
221                         *mqc->bp = (OPJ_BYTE)(mqc->c >> 19);
222                         mqc->c &= 0x7ffff;
223                         mqc->ct = 8;
224                 } else {
225                         (*mqc->bp)++;
226                         if (*mqc->bp == 0xff) {
227                                 mqc->c &= 0x7ffffff;
228                                 mqc->bp++;
229                                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 20);
230                                 mqc->c &= 0xfffff;
231                                 mqc->ct = 7;
232                         } else {
233                                 mqc->bp++;
234                                 *mqc->bp = (OPJ_BYTE)(mqc->c >> 19);
235                                 mqc->c &= 0x7ffff;
236                                 mqc->ct = 8;
237                         }
238                 }
239         }
240 }
241
242 static void opj_mqc_renorme(opj_mqc_t *mqc) {
243         do {
244                 mqc->a <<= 1;
245                 mqc->c <<= 1;
246                 mqc->ct--;
247                 if (mqc->ct == 0) {
248                         opj_mqc_byteout(mqc);
249                 }
250         } while ((mqc->a & 0x8000) == 0);
251 }
252
253 static void opj_mqc_codemps(opj_mqc_t *mqc) {
254         mqc->a -= (*mqc->curctx)->qeval;
255         if ((mqc->a & 0x8000) == 0) {
256                 if (mqc->a < (*mqc->curctx)->qeval) {
257                         mqc->a = (*mqc->curctx)->qeval;
258                 } else {
259                         mqc->c += (*mqc->curctx)->qeval;
260                 }
261                 *mqc->curctx = (*mqc->curctx)->nmps;
262                 opj_mqc_renorme(mqc);
263         } else {
264                 mqc->c += (*mqc->curctx)->qeval;
265         }
266 }
267
268 static void opj_mqc_codelps(opj_mqc_t *mqc) {
269         mqc->a -= (*mqc->curctx)->qeval;
270         if (mqc->a < (*mqc->curctx)->qeval) {
271                 mqc->c += (*mqc->curctx)->qeval;
272         } else {
273                 mqc->a = (*mqc->curctx)->qeval;
274         }
275         *mqc->curctx = (*mqc->curctx)->nlps;
276         opj_mqc_renorme(mqc);
277 }
278
279 static void opj_mqc_setbits(opj_mqc_t *mqc) {
280         OPJ_UINT32 tempc = mqc->c + mqc->a;
281         mqc->c |= 0xffff;
282         if (mqc->c >= tempc) {
283                 mqc->c -= 0x8000;
284         }
285 }
286
287 static INLINE OPJ_INT32 opj_mqc_mpsexchange(opj_mqc_t *const mqc) {
288         OPJ_INT32 d;
289         if (mqc->a < (*mqc->curctx)->qeval) {
290                 d = (OPJ_INT32)(1 - (*mqc->curctx)->mps);
291                 *mqc->curctx = (*mqc->curctx)->nlps;
292         } else {
293                 d = (OPJ_INT32)(*mqc->curctx)->mps;
294                 *mqc->curctx = (*mqc->curctx)->nmps;
295         }
296         
297         return d;
298 }
299
300 static INLINE OPJ_INT32 opj_mqc_lpsexchange(opj_mqc_t *const mqc) {
301         OPJ_INT32 d;
302         if (mqc->a < (*mqc->curctx)->qeval) {
303                 mqc->a = (*mqc->curctx)->qeval;
304                 d = (OPJ_INT32)(*mqc->curctx)->mps;
305                 *mqc->curctx = (*mqc->curctx)->nmps;
306         } else {
307                 mqc->a = (*mqc->curctx)->qeval;
308                 d = (OPJ_INT32)(1 - (*mqc->curctx)->mps);
309                 *mqc->curctx = (*mqc->curctx)->nlps;
310         }
311         
312         return d;
313 }
314
315 #ifdef MQC_PERF_OPT
316 static INLINE void opj_mqc_bytein(opj_mqc_t *const mqc) {
317         unsigned int i = *((unsigned int *) mqc->bp);
318         mqc->c += i & 0xffff00;
319         mqc->ct = i & 0x0f;
320         mqc->bp += (i >> 2) & 0x04;
321 }
322 #else
323 static void opj_mqc_bytein(opj_mqc_t *const mqc) {
324         if (mqc->bp != mqc->end) {
325                 OPJ_UINT32 c;
326                 if (mqc->bp + 1 != mqc->end) {
327                         c = *(mqc->bp + 1);
328                 } else {
329                         c = 0xff;
330                 }
331                 if (*mqc->bp == 0xff) {
332                         if (c > 0x8f) {
333                                 mqc->c += 0xff00;
334                                 mqc->ct = 8;
335                         } else {
336                                 mqc->bp++;
337                                 mqc->c += c << 9;
338                                 mqc->ct = 7;
339                         }
340                 } else {
341                         mqc->bp++;
342                         mqc->c += c << 8;
343                         mqc->ct = 8;
344                 }
345         } else {
346                 mqc->c += 0xff00;
347                 mqc->ct = 8;
348         }
349 }
350 #endif
351
352 static INLINE void opj_mqc_renormd(opj_mqc_t *const mqc) {
353         do {
354                 if (mqc->ct == 0) {
355                         opj_mqc_bytein(mqc);
356                 }
357                 mqc->a <<= 1;
358                 mqc->c <<= 1;
359                 mqc->ct--;
360         } while (mqc->a < 0x8000);
361 }
362
363 /* 
364 ==========================================================
365    MQ-Coder interface
366 ==========================================================
367 */
368
369 opj_mqc_t* opj_mqc_create(void) {
370         opj_mqc_t *mqc = (opj_mqc_t*)opj_malloc(sizeof(opj_mqc_t));
371 #ifdef MQC_PERF_OPT
372         if (mqc) {
373                 mqc->buffer = NULL;
374         }
375 #endif
376         return mqc;
377 }
378
379 void opj_mqc_destroy(opj_mqc_t *mqc) {
380         if(mqc) {
381 #ifdef MQC_PERF_OPT
382                 if (mqc->buffer) {
383                         opj_free(mqc->buffer);
384                 }
385 #endif
386                 opj_free(mqc);
387         }
388 }
389
390 OPJ_UINT32 opj_mqc_numbytes(opj_mqc_t *mqc) {
391         const ptrdiff_t diff = mqc->bp - mqc->start;
392 #if 0
393   assert( diff <= 0xffffffff && diff >= 0 ); /* UINT32_MAX */
394 #endif
395         return (OPJ_UINT32)diff;
396 }
397
398 void opj_mqc_init_enc(opj_mqc_t *mqc, OPJ_BYTE *bp) {
399     /* TODO MSD: need to take a look to the v2 version */
400         opj_mqc_setcurctx(mqc, 0);
401         mqc->a = 0x8000;
402         mqc->c = 0;
403         mqc->bp = bp - 1;
404         mqc->ct = 12;
405         mqc->start = bp;
406 }
407
408 void opj_mqc_encode(opj_mqc_t *mqc, OPJ_UINT32 d) {
409         if ((*mqc->curctx)->mps == d) {
410                 opj_mqc_codemps(mqc);
411         } else {
412                 opj_mqc_codelps(mqc);
413         }
414 }
415
416 void opj_mqc_flush(opj_mqc_t *mqc) {
417         opj_mqc_setbits(mqc);
418         mqc->c <<= mqc->ct;
419         opj_mqc_byteout(mqc);
420         mqc->c <<= mqc->ct;
421         opj_mqc_byteout(mqc);
422         
423         if (*mqc->bp != 0xff) {
424                 mqc->bp++;
425         }
426 }
427
428 void opj_mqc_bypass_init_enc(opj_mqc_t *mqc) {
429         mqc->c = 0;
430         mqc->ct = 8;
431         /*if (*mqc->bp == 0xff) {
432         mqc->ct = 7;
433      } */
434 }
435
436 void opj_mqc_bypass_enc(opj_mqc_t *mqc, OPJ_UINT32 d) {
437         mqc->ct--;
438         mqc->c = mqc->c + (d << mqc->ct);
439         if (mqc->ct == 0) {
440                 mqc->bp++;
441                 *mqc->bp = (OPJ_BYTE)mqc->c;
442                 mqc->ct = 8;
443                 if (*mqc->bp == 0xff) {
444                         mqc->ct = 7;
445                 }
446                 mqc->c = 0;
447         }
448 }
449
450 OPJ_UINT32 opj_mqc_bypass_flush_enc(opj_mqc_t *mqc) {
451         OPJ_BYTE bit_padding;
452         
453         bit_padding = 0;
454         
455         if (mqc->ct != 0) {
456                 while (mqc->ct > 0) {
457                         mqc->ct--;
458                         mqc->c += (OPJ_UINT32)(bit_padding << mqc->ct);
459                         bit_padding = (bit_padding + 1) & 0x01;
460                 }
461                 mqc->bp++;
462                 *mqc->bp = (OPJ_BYTE)mqc->c;
463                 mqc->ct = 8;
464                 mqc->c = 0;
465         }
466         
467         return 1;
468 }
469
470 void opj_mqc_reset_enc(opj_mqc_t *mqc) {
471         opj_mqc_resetstates(mqc);
472         opj_mqc_setstate(mqc, T1_CTXNO_UNI, 0, 46);
473         opj_mqc_setstate(mqc, T1_CTXNO_AGG, 0, 3);
474         opj_mqc_setstate(mqc, T1_CTXNO_ZC, 0, 4);
475 }
476
477 OPJ_UINT32 opj_mqc_restart_enc(opj_mqc_t *mqc) {
478         OPJ_UINT32 correction = 1;
479         
480         /* <flush part> */
481         OPJ_INT32 n = (OPJ_INT32)(27 - 15 - mqc->ct);
482         mqc->c <<= mqc->ct;
483         while (n > 0) {
484                 opj_mqc_byteout(mqc);
485                 n -= (OPJ_INT32)mqc->ct;
486                 mqc->c <<= mqc->ct;
487         }
488         opj_mqc_byteout(mqc);
489         
490         return correction;
491 }
492
493 void opj_mqc_restart_init_enc(opj_mqc_t *mqc) {
494         /* <Re-init part> */
495         opj_mqc_setcurctx(mqc, 0);
496         mqc->a = 0x8000;
497         mqc->c = 0;
498         mqc->ct = 12;
499         mqc->bp--;
500         if (*mqc->bp == 0xff) {
501                 mqc->ct = 13;
502         }
503 }
504
505 void opj_mqc_erterm_enc(opj_mqc_t *mqc) {
506         OPJ_INT32 k = (OPJ_INT32)(11 - mqc->ct + 1);
507         
508         while (k > 0) {
509                 mqc->c <<= mqc->ct;
510                 mqc->ct = 0;
511                 opj_mqc_byteout(mqc);
512                 k -= (OPJ_INT32)mqc->ct;
513         }
514         
515         if (*mqc->bp != 0xff) {
516                 opj_mqc_byteout(mqc);
517         }
518 }
519
520 void opj_mqc_segmark_enc(opj_mqc_t *mqc) {
521         OPJ_UINT32 i;
522         opj_mqc_setcurctx(mqc, 18);
523         
524         for (i = 1; i < 5; i++) {
525                 opj_mqc_encode(mqc, i % 2);
526         }
527 }
528
529 OPJ_BOOL opj_mqc_init_dec(opj_mqc_t *mqc, OPJ_BYTE *bp, OPJ_UINT32 len) {
530         opj_mqc_setcurctx(mqc, 0);
531         mqc->start = bp;
532         mqc->end = bp + len;
533         mqc->bp = bp;
534         if (len==0) mqc->c = 0xff << 16;
535         else mqc->c = (OPJ_UINT32)(*mqc->bp << 16);
536
537 #ifdef MQC_PERF_OPT /* TODO_MSD: check this option and put in experimental */
538         {
539         OPJ_UINT32 c;
540                 OPJ_UINT32 *ip;
541                 OPJ_BYTE *end = mqc->end - 1;
542         void* new_buffer = opj_realloc(mqc->buffer, (len + 1) * sizeof(OPJ_UINT32));
543         if (! new_buffer) {
544             opj_free(mqc->buffer);
545             mqc->buffer = NULL;
546             return OPJ_FALSE;
547         }
548         mqc->buffer = new_buffer;
549                 
550         ip = (OPJ_UINT32 *) mqc->buffer;
551
552                 while (bp < end) {
553                         c = *(bp + 1);
554                         if (*bp == 0xff) {
555                                 if (c > 0x8f) {
556                                         break;
557                                 } else {
558                                         *ip = 0x00000017 | (c << 9);
559                                 }
560                         } else {
561                                 *ip = 0x00000018 | (c << 8);
562                         }
563                         bp++;
564                         ip++;
565                 }
566
567                 /* Handle last byte of data */
568                 c = 0xff;
569                 if (*bp == 0xff) {
570                         *ip = 0x0000ff18;
571                 } else {
572                         bp++;
573                         *ip = 0x00000018 | (c << 8);
574                 }
575                 ip++;
576
577                 *ip = 0x0000ff08;
578                 mqc->bp = mqc->buffer;
579         }
580 #endif
581         opj_mqc_bytein(mqc);
582         mqc->c <<= 7;
583         mqc->ct -= 7;
584         mqc->a = 0x8000;
585         return OPJ_TRUE;
586 }
587
588 OPJ_INT32 opj_mqc_decode(opj_mqc_t *const mqc) {
589         OPJ_INT32 d;
590         mqc->a -= (*mqc->curctx)->qeval;
591         if ((mqc->c >> 16) < (*mqc->curctx)->qeval) {
592                 d = opj_mqc_lpsexchange(mqc);
593                 opj_mqc_renormd(mqc);
594         } else {
595                 mqc->c -= (*mqc->curctx)->qeval << 16;
596                 if ((mqc->a & 0x8000) == 0) {
597                         d = opj_mqc_mpsexchange(mqc);
598                         opj_mqc_renormd(mqc);
599                 } else {
600                         d = (OPJ_INT32)(*mqc->curctx)->mps;
601                 }
602         }
603
604         return d;
605 }
606
607 void opj_mqc_resetstates(opj_mqc_t *mqc) {
608         OPJ_UINT32 i;
609         for (i = 0; i < MQC_NUMCTXS; i++) {
610                 mqc->ctxs[i] = mqc_states;
611         }
612 }
613
614 void opj_mqc_setstate(opj_mqc_t *mqc, OPJ_UINT32 ctxno, OPJ_UINT32 msb, OPJ_INT32 prob) {
615         mqc->ctxs[ctxno] = &mqc_states[msb + (OPJ_UINT32)(prob << 1)];
616 }
617
618