fprintf correctly redirected to stderr or stdout
[openjpeg.git] / libopenjpeg / t1.c
1 /*
2  * Copyright (c) 2001-2002, David Janssens
3  * Copyright (c) 2002-2003, Yannick Verschueren
4  * Copyright (c) 2002-2003,  Communications and remote sensing Laboratory, Universite catholique de Louvain, Belgium
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
17  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
20  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26  * POSSIBILITY OF SUCH DAMAGE.
27  */
28
29 #include "t1.h"
30 #include "j2k.h"
31 #include "mqc.h"
32 #include "raw.h"                /* Antonin */
33 #include "int.h"
34 #include "mct.h"
35 #include "dwt.h"
36 #include "fix.h"
37 #include <stdio.h>
38 #include <math.h>
39 #include <stdlib.h>
40
41 #define T1_MAXCBLKW 1024
42 #define T1_MAXCBLKH 1024
43
44 #define T1_SIG_NE 0x0001
45 #define T1_SIG_SE 0x0002
46 #define T1_SIG_SW 0x0004
47 #define T1_SIG_NW 0x0008
48 #define T1_SIG_N 0x0010
49 #define T1_SIG_E 0x0020
50 #define T1_SIG_S 0x0040
51 #define T1_SIG_W 0x0080
52 #define T1_SIG_OTH (T1_SIG_N|T1_SIG_NE|T1_SIG_E|T1_SIG_SE|T1_SIG_S|T1_SIG_SW|T1_SIG_W|T1_SIG_NW)
53 #define T1_SIG_PRIM (T1_SIG_N|T1_SIG_E|T1_SIG_S|T1_SIG_W)
54
55 #define T1_SGN_N 0x0100
56 #define T1_SGN_E 0x0200
57 #define T1_SGN_S 0x0400
58 #define T1_SGN_W 0x0800
59 #define T1_SGN (T1_SGN_N|T1_SGN_E|T1_SGN_S|T1_SGN_W)
60
61 #define T1_SIG 0x1000
62 #define T1_REFINE 0x2000
63 #define T1_VISIT 0x4000
64
65 #define T1_NUMCTXS_AGG 1
66 #define T1_NUMCTXS_ZC 9
67 #define T1_NUMCTXS_MAG 3
68 #define T1_NUMCTXS_SC 5
69 #define T1_NUMCTXS_UNI 1
70
71 #define T1_CTXNO_AGG 0
72 #define T1_CTXNO_ZC (T1_CTXNO_AGG+T1_NUMCTXS_AGG)
73 #define T1_CTXNO_MAG (T1_CTXNO_ZC+T1_NUMCTXS_ZC)
74 #define T1_CTXNO_SC (T1_CTXNO_MAG+T1_NUMCTXS_MAG)
75 #define T1_CTXNO_UNI (T1_CTXNO_SC+T1_NUMCTXS_SC)
76 #define T1_NUMCTXS (T1_CTXNO_UNI+T1_NUMCTXS_UNI)
77
78 #define T1_NMSEDEC_BITS 7
79 #define T1_NMSEDEC_FRACBITS (T1_NMSEDEC_BITS-1)
80
81 /* add TONY */
82 #define T1_TYPE_MQ 0
83 #define T1_TYPE_RAW 1
84 /* dda */
85
86 static int t1_lut_ctxno_zc[1024];
87 static int t1_lut_ctxno_sc[256];
88 static int t1_lut_ctxno_mag[4096];
89 static int t1_lut_spb[256];
90 static int t1_lut_nmsedec_sig[1 << T1_NMSEDEC_BITS];
91 static int t1_lut_nmsedec_sig0[1 << T1_NMSEDEC_BITS];
92 static int t1_lut_nmsedec_ref[1 << T1_NMSEDEC_BITS];
93 static int t1_lut_nmsedec_ref0[1 << T1_NMSEDEC_BITS];
94
95 static int t1_data[T1_MAXCBLKH][T1_MAXCBLKW];
96 static int t1_flags[T1_MAXCBLKH + 2][T1_MAXCBLKH + 2];
97
98 int t1_getctxno_zc(int f, int orient)
99 {
100   return t1_lut_ctxno_zc[(orient << 8) | (f & T1_SIG_OTH)];
101 }
102
103 int t1_getctxno_sc(int f)
104 {
105   return t1_lut_ctxno_sc[(f & (T1_SIG_PRIM | T1_SGN)) >> 4];
106 }
107
108 int t1_getctxno_mag(int f)
109 {
110   return t1_lut_ctxno_mag[(f & T1_SIG_OTH) |
111                           (((f & T1_REFINE) != 0) << 11)];
112 }
113
114 int t1_getspb(int f)
115 {
116   return t1_lut_spb[(f & (T1_SIG_PRIM | T1_SGN)) >> 4];
117 }
118
119 int t1_getnmsedec_sig(int x, int bitpos)
120 {
121   if (bitpos > T1_NMSEDEC_FRACBITS)
122     return t1_lut_nmsedec_sig[(x >> (bitpos - T1_NMSEDEC_FRACBITS)) &
123                               ((1 << T1_NMSEDEC_BITS) - 1)];
124   else
125     return t1_lut_nmsedec_sig0[x & ((1 << T1_NMSEDEC_BITS) - 1)];
126 }
127
128 int t1_getnmsedec_ref(int x, int bitpos)
129 {
130   if (bitpos > T1_NMSEDEC_FRACBITS)
131     return t1_lut_nmsedec_ref[(x >> (bitpos - T1_NMSEDEC_FRACBITS)) &
132                               ((1 << T1_NMSEDEC_BITS) - 1)];
133   else
134     return t1_lut_nmsedec_ref0[x & ((1 << T1_NMSEDEC_BITS) - 1)];
135 }
136
137 void t1_updateflags(int *fp, int s)
138 {
139   int *np = fp - (T1_MAXCBLKW + 2);
140   int *sp = fp + (T1_MAXCBLKW + 2);
141   np[-1] |= T1_SIG_SE;
142   np[1] |= T1_SIG_SW;
143   sp[-1] |= T1_SIG_NE;
144   sp[1] |= T1_SIG_NW;
145   *np |= T1_SIG_S;
146   *sp |= T1_SIG_N;
147   fp[-1] |= T1_SIG_E;
148   fp[1] |= T1_SIG_W;
149   if (s) {
150     *np |= T1_SGN_S;
151     *sp |= T1_SGN_N;
152     fp[-1] |= T1_SGN_E;
153     fp[1] |= T1_SGN_W;
154   }
155 }
156
157 void t1_enc_sigpass_step(int *fp, int *dp, int orient, int bpno, int one,
158                          int *nmsedec, char type, int vsc)
159 {
160   int v, flag;
161   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
162     : (*fp);
163   if ((flag & T1_SIG_OTH) && !(flag & (T1_SIG | T1_VISIT))) {
164     v = int_abs(*dp) & one ? 1 : 0;
165     if (type == T1_TYPE_RAW) {  /* BYPASS/LAZY MODE */
166       mqc_setcurctx(t1_getctxno_zc(flag, orient));      /* ESSAI */
167       mqc_bypass_enc(v);
168     } else {
169       mqc_setcurctx(t1_getctxno_zc(flag, orient));
170       mqc_encode(v);
171     }
172     if (v) {
173       v = *dp < 0 ? 1 : 0;
174       *nmsedec +=
175         t1_getnmsedec_sig(int_abs(*dp), bpno + T1_NMSEDEC_FRACBITS);
176       if (type == T1_TYPE_RAW) {        /* BYPASS/LAZY MODE */
177         mqc_setcurctx(t1_getctxno_sc(flag));    /* ESSAI */
178         mqc_bypass_enc(v);
179       } else {
180         mqc_setcurctx(t1_getctxno_sc(flag));
181         mqc_encode(v ^ t1_getspb(flag));
182       }
183       t1_updateflags(fp, v);
184       *fp |= T1_SIG;
185     }
186     *fp |= T1_VISIT;
187   }
188 }
189
190
191
192 void t1_dec_sigpass_step(int *fp, int *dp, int orient, int oneplushalf,
193                          char type, int vsc)
194 {
195   int v, flag;
196   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
197     : (*fp);
198   if ((flag & T1_SIG_OTH) && !(flag & (T1_SIG | T1_VISIT))) {
199     if (type == T1_TYPE_RAW) {
200       if (raw_decode()) {
201         v = raw_decode();       /* ESSAI */
202         *dp = v ? -oneplushalf : oneplushalf;
203         t1_updateflags(fp, v);
204         *fp |= T1_SIG;
205       }
206     } else {
207       mqc_setcurctx(t1_getctxno_zc(flag, orient));
208       if (mqc_decode()) {
209         mqc_setcurctx(t1_getctxno_sc(flag));
210         v = mqc_decode() ^ t1_getspb(flag);
211         *dp = v ? -oneplushalf : oneplushalf;
212         t1_updateflags(fp, v);
213         *fp |= T1_SIG;
214       }
215     }
216     *fp |= T1_VISIT;
217   }
218 }                               /* VSC and  BYPASS by Antonin */
219
220 void t1_enc_sigpass(int w, int h, int bpno, int orient, int *nmsedec,
221                     char type, int cblksty)
222 {
223   int i, j, k, one, vsc;
224   *nmsedec = 0;
225   one = 1 << (bpno + T1_NMSEDEC_FRACBITS);
226   for (k = 0; k < h; k += 4) {
227     for (i = 0; i < w; i++) {
228       for (j = k; j < k + 4 && j < h; j++) {
229         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
230                && (j == k + 3 || j == h - 1)) ? 1 : 0;
231         t1_enc_sigpass_step(&t1_flags[1 + j][1 + i],
232                             &t1_data[j][i], orient, bpno, one,
233                             nmsedec, type, vsc);
234       }
235     }
236   }
237 }
238
239 void t1_dec_sigpass(int w, int h, int bpno, int orient, char type,
240                     int cblksty)
241 {
242   int i, j, k, one, half, oneplushalf, vsc;
243   one = 1 << bpno;
244   half = one >> 1;
245   oneplushalf = one | half;
246   for (k = 0; k < h; k += 4) {
247     for (i = 0; i < w; i++) {
248       for (j = k; j < k + 4 && j < h; j++) {
249         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
250                && (j == k + 3 || j == h - 1)) ? 1 : 0;
251         t1_dec_sigpass_step(&t1_flags[1 + j][1 + i],
252                             &t1_data[j][i], 
253
254                             orient, 
255
256                             oneplushalf,
257                             type, vsc);
258       }
259     }
260   }
261 }                               /* VSC and  BYPASS by Antonin */
262
263 void t1_enc_refpass_step(int *fp, int *dp, int bpno, int one, int *nmsedec,
264                          char type, int vsc)
265 {
266   int v, flag;
267   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
268     : (*fp);
269   if ((flag & (T1_SIG | T1_VISIT)) == T1_SIG) {
270     *nmsedec +=
271       t1_getnmsedec_ref(int_abs(*dp), bpno + T1_NMSEDEC_FRACBITS);
272     v = int_abs(*dp) & one ? 1 : 0;
273     if (type == T1_TYPE_RAW) {  /* BYPASS/LAZY MODE */
274       mqc_setcurctx(t1_getctxno_mag(flag));     /* ESSAI */
275       mqc_bypass_enc(v);
276     } else {
277       mqc_setcurctx(t1_getctxno_mag(flag));
278       mqc_encode(v);
279     }
280     *fp |= T1_REFINE;
281   }
282 }
283
284
285
286 void t1_dec_refpass_step(int *fp, int *dp, int poshalf, int neghalf,
287                          char type, int vsc)
288 {
289   int v, t, flag;
290   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
291     : (*fp);
292   if ((flag & (T1_SIG | T1_VISIT)) == T1_SIG) {
293     if (type == T1_TYPE_RAW) {
294       mqc_setcurctx(t1_getctxno_mag(flag));     /* ESSAI */
295       v = raw_decode();
296     } else {
297       mqc_setcurctx(t1_getctxno_mag(flag));
298       v = mqc_decode();
299     }
300     t = v ? poshalf : neghalf;
301     *dp += *dp < 0 ? -t : t;
302     *fp |= T1_REFINE;
303   }
304 }                               /* VSC and  BYPASS by Antonin  */
305
306 void t1_enc_refpass(int w, int h, int bpno, int *nmsedec, char type,
307                     int cblksty)
308 {
309   int i, j, k, one, vsc;
310   *nmsedec = 0;
311   one = 1 << (bpno + T1_NMSEDEC_FRACBITS);
312   for (k = 0; k < h; k += 4) {
313     for (i = 0; i < w; i++) {
314       for (j = k; j < k + 4 && j < h; j++) {
315         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
316                && (j == k + 3 || j == h - 1)) ? 1 : 0;
317         t1_enc_refpass_step(&t1_flags[1 + j][1 + i],
318                             &t1_data[j][i], bpno, one, nmsedec, type, vsc);
319       }
320     }
321   }
322 }
323
324 void t1_dec_refpass(int w, int h, int bpno, char type, int cblksty)
325 {
326   int i, j, k, one, poshalf, neghalf;
327   int vsc;
328   one = 1 << bpno;
329   poshalf = one >> 1;
330   neghalf = bpno > 0 ? -poshalf : -1;
331   for (k = 0; k < h; k += 4) {
332     for (i = 0; i < w; i++) {
333       for (j = k; j < k + 4 && j < h; j++) {
334         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
335                && (j == k + 3 || j == h - 1)) ? 1 : 0;
336         t1_dec_refpass_step(&t1_flags[1 + j][1 + i],
337                             &t1_data[j][i], 
338
339                             poshalf, 
340
341                             neghalf, 
342
343                             type, vsc);
344       }
345     }
346   }
347 }                               /* VSC and  BYPASS by Antonin */
348
349 void t1_enc_clnpass_step(int *fp, int *dp, int orient, int bpno, int one,
350                          int *nmsedec, int partial, int vsc)
351 {
352   int v, flag;
353   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
354     : (*fp);
355   if (partial)
356     goto label_partial;
357   if (!(*fp & (T1_SIG | T1_VISIT))) {
358     mqc_setcurctx(t1_getctxno_zc(flag, orient));
359     v = int_abs(*dp) & one ? 1 : 0;
360     mqc_encode(v);
361     if (v) {
362     label_partial:
363       *nmsedec +=
364         t1_getnmsedec_sig(int_abs(*dp), bpno + T1_NMSEDEC_FRACBITS);
365       mqc_setcurctx(t1_getctxno_sc(flag));
366       v = *dp < 0 ? 1 : 0;
367       mqc_encode(v ^ t1_getspb(flag));
368       t1_updateflags(fp, v);
369       *fp |= T1_SIG;
370     }
371   }
372   *fp &= ~T1_VISIT;
373 }
374
375
376
377
378 void t1_dec_clnpass_step(int *fp, int *dp, int orient, int oneplushalf,
379                          int partial, int vsc)
380 {
381   int v, flag;
382   flag = vsc ? ((*fp) & (~(T1_SIG_S | T1_SIG_SE | T1_SIG_SW | T1_SGN_S)))
383     : (*fp);
384   if (partial)
385     goto label_partial;
386   if (!(flag & (T1_SIG | T1_VISIT))) {
387     mqc_setcurctx(t1_getctxno_zc(flag, orient));
388     if (mqc_decode()) {
389     label_partial:
390       mqc_setcurctx(t1_getctxno_sc(flag));
391       v = mqc_decode() ^ t1_getspb(flag);
392       *dp = v ? -oneplushalf : oneplushalf;
393       t1_updateflags(fp, v);
394       *fp |= T1_SIG;
395     }
396   }
397   *fp &= ~T1_VISIT;
398 }                               /* VSC and  BYPASS by Antonin */
399
400 void t1_enc_clnpass(int w, int h, int bpno, int orient, int *nmsedec,
401                     int cblksty)
402 {
403   int i, j, k, one, agg, runlen, vsc;
404   *nmsedec = 0;
405   one = 1 << (bpno + T1_NMSEDEC_FRACBITS);
406   for (k = 0; k < h; k += 4) {
407     for (i = 0; i < w; i++) {
408       if (k + 3 < h) {
409         if (cblksty & J2K_CCP_CBLKSTY_VSC) {
410           agg = !(t1_flags[1 + k][1 + i] & (T1_SIG | T1_VISIT | T1_SIG_OTH)
411                   || t1_flags[1 + k + 1][1 +
412                                          i] & (T1_SIG | T1_VISIT |
413                                                T1_SIG_OTH)
414                   || t1_flags[1 + k + 2][1 +
415                                          i] & (T1_SIG | T1_VISIT |
416                                                T1_SIG_OTH)
417                   || (t1_flags[1 + k + 3][1 + i] &
418                       (~
419                        (T1_SIG_S | T1_SIG_SE | T1_SIG_SW |
420                         T1_SGN_S))) & (T1_SIG | T1_VISIT | T1_SIG_OTH));
421         } else {
422           agg = !(t1_flags[1 + k][1 + i] & (T1_SIG | T1_VISIT | T1_SIG_OTH)
423                   || t1_flags[1 + k + 1][1 +
424                                          i] & (T1_SIG | T1_VISIT |
425                                                T1_SIG_OTH)
426                   || t1_flags[1 + k + 2][1 +
427                                          i] & (T1_SIG | T1_VISIT |
428                                                T1_SIG_OTH)
429                   || t1_flags[1 + k + 3][1 +
430                                          i] & (T1_SIG | T1_VISIT |
431                                                T1_SIG_OTH));
432         }
433       } else {
434         agg = 0;
435       }
436       if (agg) {
437         for (runlen = 0; runlen < 4; runlen++) {
438           if (int_abs(t1_data[k + runlen][i]) & one)
439             break;
440         }
441         mqc_setcurctx(T1_CTXNO_AGG);
442         mqc_encode(runlen != 4);
443         if (runlen == 4) {
444           continue;
445         }
446         mqc_setcurctx(T1_CTXNO_UNI);
447         mqc_encode(runlen >> 1);
448         mqc_encode(runlen & 1);
449       } else {
450         runlen = 0;
451       }
452       for (j = k + runlen; j < k + 4 && j < h; j++) {
453         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
454                && (j == k + 3 || j == h - 1)) ? 1 : 0;
455         t1_enc_clnpass_step(&t1_flags[1 + j][1 + i],
456                             &t1_data[j][i], orient, bpno, one,
457                             nmsedec, agg && (j == k + runlen), vsc);
458       }
459     }
460   }
461 }
462
463 void t1_dec_clnpass(int w, int h, int bpno, int orient, int cblksty)
464 {
465   int i, j, k, one, half, oneplushalf, agg, runlen, vsc;
466   int segsym = cblksty & J2K_CCP_CBLKSTY_SEGSYM;
467   one = 1 << bpno;
468   half = one >> 1;
469   oneplushalf = one | half;
470   for (k = 0; k < h; k += 4) {
471     for (i = 0; i < w; i++) {
472       if (k + 3 < h) {
473         if (cblksty & J2K_CCP_CBLKSTY_VSC) {
474           agg = !(t1_flags[1 + k][1 + i] & (T1_SIG | T1_VISIT | T1_SIG_OTH)
475                   || t1_flags[1 + k + 1][1 +
476                                          i] & (T1_SIG | T1_VISIT |
477                                                T1_SIG_OTH)
478                   || t1_flags[1 + k + 2][1 +
479                                          i] & (T1_SIG | T1_VISIT |
480                                                T1_SIG_OTH)
481                   || (t1_flags[1 + k + 3][1 + i] &
482                       (~
483                        (T1_SIG_S | T1_SIG_SE | T1_SIG_SW |
484                         T1_SGN_S))) & (T1_SIG | T1_VISIT | T1_SIG_OTH));
485         } else {
486           agg = !(t1_flags[1 + k][1 + i] & (T1_SIG | T1_VISIT | T1_SIG_OTH)
487                   || t1_flags[1 + k + 1][1 +
488                                          i] & (T1_SIG | T1_VISIT |
489                                                T1_SIG_OTH)
490                   || t1_flags[1 + k + 2][1 +
491                                          i] & (T1_SIG | T1_VISIT |
492                                                T1_SIG_OTH)
493                   || t1_flags[1 + k + 3][1 +
494                                          i] & (T1_SIG | T1_VISIT |
495                                                T1_SIG_OTH));
496         }
497       } else {
498         agg = 0;
499       }
500       if (agg) {
501         mqc_setcurctx(T1_CTXNO_AGG);
502         if (!mqc_decode()) {
503           continue;
504         }
505         mqc_setcurctx(T1_CTXNO_UNI);
506         runlen = mqc_decode();
507         runlen = (runlen << 1) | mqc_decode();
508       } else {
509         runlen = 0;
510       }
511       for (j = k + runlen; j < k + 4 && j < h; j++) {
512         vsc = ((cblksty & J2K_CCP_CBLKSTY_VSC)
513                && (j == k + 3 || j == h - 1)) ? 1 : 0;
514         t1_dec_clnpass_step(&t1_flags[1 + j][1 + i],
515                             &t1_data[j][i], 
516
517                             orient, 
518
519                             oneplushalf,
520                             agg && (j == k + runlen), vsc);
521       }
522     }
523   }
524   if (segsym) {
525     int v = 0;
526     mqc_setcurctx(T1_CTXNO_UNI);
527     v = mqc_decode();
528     v = (v << 1) | mqc_decode();
529     v = (v << 1) | mqc_decode();
530     v = (v << 1) | mqc_decode();
531     /*  if (v!=0xa) 
532        {
533        fprintf(stderr, "warning: bad segmentation symbol %x\n",v);
534        } */
535   }
536 }                               /* VSC and  BYPASS by Antonin */
537
538 double t1_getwmsedec(int nmsedec, int compno, int level, int orient, int bpno, int qmfbid, double stepsize, int numcomps)       //mod fixed_quality
539 {
540   double w1, w2, wmsedec;
541   if (qmfbid == 1) {
542     w1 = (numcomps > 1) ? mct_getnorm(compno) : 1;
543     w2 = dwt_getnorm(level, orient);
544   } else {                      /* if (qmfbid == 0) */
545     w1 = (numcomps > 1) ? mct_getnorm_real(compno) : 1;
546     w2 = dwt_getnorm_real(level, orient);
547   }
548   wmsedec = w1 * w2 * (stepsize / 8192.0) * (1 << bpno);
549   wmsedec *= wmsedec * nmsedec / 8192.0;
550   return wmsedec;
551 }
552
553 void t1_encode_cblk(tcd_cblk_t * cblk, int orient, int compno, int level, int qmfbid, double stepsize, int cblksty, int numcomps, tcd_tile_t * tile)    //mod fixed_quality
554 {
555   int i, j;
556   int w, h;
557   int passno;
558   int bpno, passtype;
559   int max;
560   int nmsedec;
561   double cumwmsedec = 0;
562   char type = T1_TYPE_MQ;
563
564   w = cblk->x1 - cblk->x0;
565   h = cblk->y1 - cblk->y0;
566
567   max = 0;
568   for (j = 0; j < h; j++) {
569     for (i = 0; i < w; i++) {
570       max = int_max(max, int_abs(t1_data[j][i]));
571     }
572   }
573
574   cblk->numbps = max ? (int_floorlog2(max) + 1) - T1_NMSEDEC_FRACBITS : 0;
575
576   for (i = 0; i < sizeof(t1_flags) / sizeof(int); i++)
577     ((int *) t1_flags)[i] = 0;
578   bpno = cblk->numbps - 1;
579   passtype = 2;
580
581   mqc_resetstates();
582   mqc_setstate(T1_CTXNO_UNI, 0, 46);
583   mqc_setstate(T1_CTXNO_AGG, 0, 3);
584   mqc_setstate(T1_CTXNO_ZC, 0, 4);
585   mqc_init_enc(cblk->data);
586
587   for (passno = 0; bpno >= 0; passno++) {
588     tcd_pass_t *pass = &cblk->passes[passno];
589     int correction = 3;
590     type = ((bpno < (cblk->numbps - 4)) && (passtype < 2)
591             && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
592       T1_TYPE_MQ;
593
594     switch (passtype) {
595     case 0:
596       t1_enc_sigpass(w, h, bpno, orient, &nmsedec, type, cblksty);
597       break;
598     case 1:
599       t1_enc_refpass(w, h, bpno, &nmsedec, type, cblksty);
600       break;
601     case 2:
602       t1_enc_clnpass(w, h, bpno, orient, &nmsedec, cblksty);
603       /* code switch SEGMARK (i.e. SEGSYM) */
604       if (cblksty & J2K_CCP_CBLKSTY_SEGSYM)
605         mqc_segmark_enc();
606       break;
607     }
608
609     cumwmsedec += t1_getwmsedec(nmsedec, compno, level, orient, bpno, qmfbid, stepsize, numcomps);      //mod fixed_quality
610     tile->distotile += t1_getwmsedec(nmsedec, compno, level, orient, bpno, qmfbid, stepsize, numcomps); //add antonin quality
611
612
613     /* Code switch "RESTART" (i.e. TERMALL) */
614     if ((cblksty & J2K_CCP_CBLKSTY_TERMALL)
615         && !((passtype == 2) && (bpno - 1 < 0))) {
616       if (type == T1_TYPE_RAW) {
617         mqc_flush();
618         correction = 1;
619         /* correction = mqc_bypass_flush_enc(); */
620       } else {                  /* correction = mqc_restart_enc(); */
621         mqc_flush();
622         correction = 1;
623       }
624       pass->term = 1;
625     } else {
626       if (((bpno < (cblk->numbps - 4) && (passtype > 0))
627            || ((bpno == (cblk->numbps - 4)) && (passtype == 2)))
628           && (cblksty & J2K_CCP_CBLKSTY_LAZY)) {
629         if (type == T1_TYPE_RAW) {
630           mqc_flush();
631           correction = 1;
632           /* correction = mqc_bypass_flush_enc(); */
633         } else {                /* correction = mqc_restart_enc(); */
634           mqc_flush();
635           correction = 1;
636         }
637         pass->term = 1;
638       } else {
639         pass->term = 0;
640       }
641     }
642
643     if (++passtype == 3) {
644       passtype = 0;
645       bpno--;
646     }
647
648     if (pass->term && bpno > 0) {
649       type = ((bpno < (cblk->numbps - 4)) && (passtype < 2)
650               && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
651         T1_TYPE_MQ;
652       if (type == T1_TYPE_RAW)
653         mqc_bypass_init_enc();
654       else
655         mqc_restart_init_enc();
656     }
657
658     pass->distortiondec = cumwmsedec;
659     pass->rate = mqc_numbytes() + correction;   /* FIXME */
660     pass->len =
661       pass->rate - (passno == 0 ? 0 : cblk->passes[passno - 1].rate);
662
663     /* Code-switch "RESET" */
664     if (cblksty & J2K_CCP_CBLKSTY_RESET)
665       mqc_reset_enc();
666   }
667
668   /* Code switch "ERTERM" (i.e. PTERM) */
669   if (cblksty & J2K_CCP_CBLKSTY_PTERM)
670     mqc_erterm_enc();
671   else /* Default coding */ if (!(cblksty & J2K_CCP_CBLKSTY_LAZY))
672     mqc_flush();
673
674   cblk->totalpasses = passno;
675 }
676
677 void t1_decode_cblk(tcd_cblk_t * cblk, int orient, int roishift,
678                     int cblksty)
679 {
680   int i;
681   int w, h;
682   int bpno, passtype;
683   int segno, passno;
684   char type = T1_TYPE_MQ; //BYPASS mode
685
686   for (i = 0; i < sizeof(t1_data) / sizeof(int); i++)
687     ((int *) t1_data)[i] = 0;
688   for (i = 0; i < sizeof(t1_flags) / sizeof(int); i++)
689     ((int *) t1_flags)[i] = 0;
690
691   w = cblk->x1 - cblk->x0;
692   h = cblk->y1 - cblk->y0;
693   bpno = roishift + cblk->numbps - 1;
694   passtype = 2;
695
696   mqc_resetstates();
697   mqc_setstate(T1_CTXNO_UNI, 0, 46);
698   mqc_setstate(T1_CTXNO_AGG, 0, 3);
699   mqc_setstate(T1_CTXNO_ZC, 0, 4);
700
701   for (segno = 0; segno < cblk->numsegs; segno++) {
702     tcd_seg_t *seg = &cblk->segs[segno];
703     
704     // Add BYPASS mode 
705     type = ((bpno <= (cblk->numbps - 1) - 4) && (passtype < 2)
706       && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
707     T1_TYPE_MQ;
708     if (type == T1_TYPE_RAW) 
709       raw_init_dec(seg->data, seg->len);
710     else
711       mqc_init_dec(seg->data, seg->len);
712     // ddA
713
714     
715
716     if (bpno==0) cblk->lastbp=1;  // Add Antonin : quantizbug1
717     
718     for (passno = 0; passno < seg->numpasses; passno++) {
719       switch (passtype) {
720       case 0:
721         t1_dec_sigpass(w, h, bpno, orient, type, cblksty);
722         break;
723       case 1:
724         t1_dec_refpass(w, h, bpno, type, cblksty);
725         break;
726       case 2:
727         t1_dec_clnpass(w, h, bpno, orient, cblksty);
728         break;
729       }
730       
731       if ((cblksty & J2K_CCP_CBLKSTY_RESET) && type == T1_TYPE_MQ) {
732         mqc_resetstates();
733
734         mqc_setstate(T1_CTXNO_UNI, 0, 46);
735
736         mqc_setstate(T1_CTXNO_AGG, 0, 3);
737
738         mqc_setstate(T1_CTXNO_ZC, 0, 4);
739
740       }
741       
742       if (++passtype == 3) {
743         passtype = 0;
744         bpno--;
745       }
746     }
747   }
748 }
749
750 void t1_encode_cblks(tcd_tile_t * tile, j2k_tcp_t * tcp)
751 {
752   int compno, resno, bandno, precno, cblkno;
753   int x, y, i, j, orient;
754   tcd_tilecomp_t *tilec;
755   tcd_resolution_t *res;
756   tcd_band_t *band;
757   tcd_precinct_t *prc;
758   tcd_cblk_t *cblk;
759
760   tile->distotile = 0;          //add fixed_quality
761
762   for (compno = 0; compno < tile->numcomps; compno++) {
763     tilec = &tile->comps[compno];
764     for (resno = 0; resno < tilec->numresolutions; resno++) {
765       res = &tilec->resolutions[resno];
766       for (bandno = 0; bandno < res->numbands; bandno++) {
767         band = &res->bands[bandno];
768         for (precno = 0; precno < res->pw * res->ph; precno++) {
769           prc = &band->precincts[precno];
770           for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
771             cblk = &prc->cblks[cblkno];
772
773             if (band->bandno == 0) {
774               x = cblk->x0 - band->x0;
775               y = cblk->y0 - band->y0;
776             } else if (band->bandno == 1) {
777               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
778               x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
779               y = cblk->y0 - band->y0;
780             } else if (band->bandno == 2) {
781               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
782               x = cblk->x0 - band->x0;
783               y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
784             } else {            /* if (band->bandno == 3) */
785               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
786               x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
787               y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
788             }
789
790             if (tcp->tccps[compno].qmfbid == 1) {
791
792               for (j = 0; j < cblk->y1 - cblk->y0; j++) {
793                 for (i = 0; i < cblk->x1 - cblk->x0; i++) {
794                   t1_data[j][i] =
795                     tilec->data[(x + i) +
796                                 (y + j) * (tilec->x1 -
797                                            tilec->
798                                            x0)] << T1_NMSEDEC_FRACBITS;
799                 }
800               }
801             } else if (tcp->tccps[compno].qmfbid == 0) {
802               for (j = 0; j < cblk->y1 - cblk->y0; j++) {
803                 for (i = 0; i < cblk->x1 - cblk->x0; i++) {
804                   t1_data[j][i] =
805                     fix_mul(tilec->
806                             data[x + i +
807                                  (y + j) * (tilec->x1 -
808                                             tilec->
809                                             x0)],
810                             8192 * 8192 /
811                             band->stepsize) >> (13 - T1_NMSEDEC_FRACBITS);
812                 }
813               }
814             }
815             orient = band->bandno;      /* FIXME */
816             if (orient == 2) {
817               orient = 1;
818             } else if (orient == 1) {
819               orient = 2;
820             }
821             t1_encode_cblk(cblk, orient, compno, tilec->numresolutions - 1 - resno, tcp->tccps[compno].qmfbid, band->stepsize, tcp->tccps[compno].cblksty, tile->numcomps, tile);       //mod fixed_quality
822           }                     /* cblkno */
823         }                       /* precno */
824       }                         /* bandno */
825     }                           /* resno  */
826   }                             /* compo  */
827 }
828
829
830 void t1_decode_cblks(tcd_tile_t * tile, j2k_tcp_t * tcp)
831 {
832   int compno, resno, bandno, precno, cblkno;
833
834   for (compno = 0; compno < tile->numcomps; compno++) {
835     tcd_tilecomp_t *tilec = &tile->comps[compno];
836     for (resno = 0; resno < tilec->numresolutions; resno++) {
837       tcd_resolution_t *res = &tilec->resolutions[resno];
838       for (bandno = 0; bandno < res->numbands; bandno++) {
839         tcd_band_t *band = &res->bands[bandno];
840         for (precno = 0; precno < res->pw * res->ph; precno++) {
841           tcd_precinct_t *prc = &band->precincts[precno];
842           for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
843             int x, y, i, j, orient;
844             tcd_cblk_t *cblk = &prc->cblks[cblkno];
845             orient = band->bandno;      /* FIXME */
846             if (orient == 2)
847               orient = 1;
848             else if (orient == 1)
849               orient = 2;
850             t1_decode_cblk(cblk, orient,
851                            tcp->tccps[compno].roishift,
852                            tcp->tccps[compno].cblksty);
853             if (band->bandno == 0) {
854               x = cblk->x0 - band->x0;
855               y = cblk->y0 - band->y0;
856             } else if (band->bandno == 1) {
857               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
858               x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
859               y = cblk->y0 - band->y0;
860             } else if (band->bandno == 2) {
861               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
862               x = cblk->x0 - band->x0;
863               y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
864             } else {            /* if (band->bandno == 3) */
865               tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
866               x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
867               y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
868             }
869
870             if (tcp->tccps[compno].roishift) {
871               int thresh, val, mag;
872               thresh = 1 << tcp->tccps[compno].roishift;
873               for (j = 0; j < cblk->y1 - cblk->y0; j++) {
874                 for (i = 0; i < cblk->x1 - cblk->x0; i++) {
875                   val = t1_data[j][i];
876                   mag = int_abs(val);
877                   if (mag >= thresh) {
878                     mag >>= tcp->tccps[compno].roishift;
879                     t1_data[j][i] = val < 0 ? -mag : mag;
880                   }
881                 }
882               }
883             }
884
885             if (tcp->tccps[compno].qmfbid == 1) {
886               for (j = 0; j < cblk->y1 - cblk->y0; j++) {
887                 for (i = 0; i < cblk->x1 - cblk->x0; i++) {
888                   tilec->data[x + i +
889                               (y + j) * (tilec->x1 -
890                                          tilec->x0)] = t1_data[j][i];
891                 }
892               }
893             } else {            /* if (tcp->tccps[compno].qmfbid == 0) */
894
895               for (j = 0; j < cblk->y1 - cblk->y0; j++) {
896                 for (i = 0; i < cblk->x1 - cblk->x0; i++) {
897                   if (t1_data[j][i] == 0) {
898                     tilec->data[x + i +
899                       (y + j) * (tilec->x1 - tilec->x0)] = 0;
900                   } else {
901
902                     // Add antonin : quantizbug1
903
904                     t1_data[j][i]<<=1;
905
906                     //if (cblk->lastbp) 
907
908                     t1_data[j][i]+=t1_data[j][i]>0?1:-1;
909
910                     // ddA
911                     tilec->data[x + i +
912                                 (y + j) * (tilec->x1 -
913                                            tilec->
914                                            x0)] =
915                       fix_mul(t1_data[j][i] << 12, band->stepsize); //Mod Antonin : quantizbug1 (before : << 13)
916                   }
917                 }
918               }
919             }
920           }
921         }
922       }
923     }
924   }
925 }
926
927 int t1_init_ctxno_zc(int f, int orient)
928 {
929   int h, v, d, n, t, hv;
930   n = 0;
931   h = ((f & T1_SIG_W) != 0) + ((f & T1_SIG_E) != 0);
932   v = ((f & T1_SIG_N) != 0) + ((f & T1_SIG_S) != 0);
933   d = ((f & T1_SIG_NW) != 0) + ((f & T1_SIG_NE) !=
934                                 0) + ((f & T1_SIG_SE) !=
935                                       0) + ((f & T1_SIG_SW) != 0);
936   switch (orient) {
937   case 2:
938     t = h;
939     h = v;
940     v = t;
941   case 0:
942   case 1:
943     if (!h) {
944       if (!v) {
945         if (!d)
946           n = 0;
947         else if (d == 1)
948           n = 1;
949         else
950           n = 2;
951       } else if (v == 1)
952         n = 3;
953       else
954         n = 4;
955     } else if (h == 1) {
956       if (!v) {
957         if (!d)
958           n = 5;
959         else
960           n = 6;
961       } else
962         n = 7;
963     } else
964       n = 8;
965     break;
966   case 3:
967     hv = h + v;
968     if (!d) {
969       if (!hv)
970         n = 0;
971       else if (hv == 1)
972         n = 1;
973       else
974         n = 2;
975     } else if (d == 1) {
976       if (!hv)
977         n = 3;
978       else if (hv == 1)
979         n = 4;
980       else
981         n = 5;
982     } else if (d == 2) {
983       if (!hv)
984         n = 6;
985       else
986         n = 7;
987     } else
988       n = 8;
989     break;
990   }
991   return T1_CTXNO_ZC + n;
992 }
993
994 int t1_init_ctxno_sc(int f)
995 {
996   int hc, vc, n;
997   n = 0;
998   hc = int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
999                 T1_SIG_E) + ((f & (T1_SIG_W | T1_SGN_W)) == T1_SIG_W),
1000                1) - int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
1001                              (T1_SIG_E | T1_SGN_E)) +
1002                             ((f & (T1_SIG_W | T1_SGN_W)) ==
1003                              (T1_SIG_W | T1_SGN_W)), 1);
1004   vc = int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1005                 T1_SIG_N) + ((f & (T1_SIG_S | T1_SGN_S)) == T1_SIG_S),
1006                1) - int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1007                              (T1_SIG_N | T1_SGN_N)) +
1008                             ((f & (T1_SIG_S | T1_SGN_S)) ==
1009                              (T1_SIG_S | T1_SGN_S)), 1);
1010   if (hc < 0) {
1011     hc = -hc;
1012     vc = -vc;
1013   }
1014   if (!hc) {
1015     if (vc == -1)
1016       n = 1;
1017     else if (!vc)
1018       n = 0;
1019     else
1020       n = 1;
1021   } else if (hc == 1) {
1022     if (vc == -1)
1023       n = 2;
1024     else if (!vc)
1025       n = 3;
1026     else
1027       n = 4;
1028   }
1029   return T1_CTXNO_SC + n;
1030 }
1031
1032 int t1_init_ctxno_mag(int f)
1033 {
1034   int n;
1035   if (!(f & T1_REFINE))
1036     n = (f & (T1_SIG_OTH)) ? 1 : 0;
1037   else
1038     n = 2;
1039   return T1_CTXNO_MAG + n;
1040 }
1041
1042 int t1_init_spb(int f)
1043 {
1044   int hc, vc, n;
1045   hc = int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
1046                 T1_SIG_E) + ((f & (T1_SIG_W | T1_SGN_W)) == T1_SIG_W),
1047                1) - int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
1048                              (T1_SIG_E | T1_SGN_E)) +
1049                             ((f & (T1_SIG_W | T1_SGN_W)) ==
1050                              (T1_SIG_W | T1_SGN_W)), 1);
1051   vc = int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1052                 T1_SIG_N) + ((f & (T1_SIG_S | T1_SGN_S)) == T1_SIG_S),
1053                1) - int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1054                              (T1_SIG_N | T1_SGN_N)) +
1055                             ((f & (T1_SIG_S | T1_SGN_S)) ==
1056                              (T1_SIG_S | T1_SGN_S)), 1);
1057   if (!hc && !vc)
1058     n = 0;
1059   else
1060     n = (!(hc > 0 || (!hc && vc > 0)));
1061   return n;
1062 }
1063
1064 void t1_init_luts()
1065 {
1066   int i, j;
1067   double u, v, t;
1068   for (j = 0; j < 4; j++) {
1069     for (i = 0; i < 256; ++i) {
1070       t1_lut_ctxno_zc[(j << 8) | i] = t1_init_ctxno_zc(i, j);
1071     }
1072   }
1073   for (i = 0; i < 256; i++) {
1074     t1_lut_ctxno_sc[i] = t1_init_ctxno_sc(i << 4);
1075   }
1076   for (j = 0; j < 2; j++) {
1077     for (i = 0; i < 2048; ++i) {
1078       t1_lut_ctxno_mag[(j << 11) + i] =
1079         t1_init_ctxno_mag((j ? T1_REFINE : 0) | i);
1080     }
1081   }
1082   for (i = 0; i < 256; ++i) {
1083     t1_lut_spb[i] = t1_init_spb(i << 4);
1084   }
1085   /* FIXME FIXME FIXME */
1086   /* fprintf(stdout,"nmsedec luts:\n"); */
1087   for (i = 0; i < (1 << T1_NMSEDEC_BITS); i++) {
1088     t = i / pow(2, T1_NMSEDEC_FRACBITS);
1089     u = t;
1090     v = t - 1.5;
1091     t1_lut_nmsedec_sig[i] =
1092       int_max(0,
1093               (int) (floor
1094                      ((u * u - v * v) * pow(2,
1095                                             T1_NMSEDEC_FRACBITS) +
1096                       0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1097     t1_lut_nmsedec_sig0[i] =
1098       int_max(0,
1099               (int) (floor
1100                      ((u * u) * pow(2, T1_NMSEDEC_FRACBITS) +
1101                       0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1102     u = t - 1.0;
1103     if (i & (1 << (T1_NMSEDEC_BITS - 1))) {
1104       v = t - 1.5;
1105     } else {
1106       v = t - 0.5;
1107     }
1108     t1_lut_nmsedec_ref[i] =
1109       int_max(0,
1110               (int) (floor
1111                      ((u * u - v * v) * pow(2,
1112                                             T1_NMSEDEC_FRACBITS) +
1113                       0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1114     t1_lut_nmsedec_ref0[i] =
1115       int_max(0,
1116               (int) (floor
1117                      ((u * u) * pow(2, T1_NMSEDEC_FRACBITS) +
1118                       0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1119   }
1120 }