src/gdcmopenjpeg/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, float 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, float 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   /* Changed by Dmitry Kolyadin */
 577   for (i = 0; i <= w; i++)
 578     for (j = 0; j <= h; j++){
 579       t1_flags[j][i] = 0;
 580     }
 581
 582   bpno = cblk->numbps - 1;
 583   passtype = 2;
 584
 585   mqc_resetstates();
 586   mqc_setstate(T1_CTXNO_UNI, 0, 46);
 587   mqc_setstate(T1_CTXNO_AGG, 0, 3);
 588   mqc_setstate(T1_CTXNO_ZC, 0, 4);
 589   mqc_init_enc(cblk->data);
 590
 591   for (passno = 0; bpno >= 0; passno++) {
 592     tcd_pass_t *pass = &cblk->passes[passno];
 593     int correction = 3;
 594     type = ((bpno < (cblk->numbps - 4)) && (passtype < 2)
 595        && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
 596       T1_TYPE_MQ;
 597
 598     switch (passtype) {
 599     case 0:
 600       t1_enc_sigpass(w, h, bpno, orient, &nmsedec, type, cblksty);
 601       break;
 602     case 1:
 603       t1_enc_refpass(w, h, bpno, &nmsedec, type, cblksty);
 604       break;
 605     case 2:
 606       t1_enc_clnpass(w, h, bpno, orient, &nmsedec, cblksty);
 607       /* code switch SEGMARK (i.e. SEGSYM) */
 608       if (cblksty & J2K_CCP_CBLKSTY_SEGSYM)
 609    mqc_segmark_enc();
 610       break;
 611     }
 612
 613     cumwmsedec += t1_getwmsedec(nmsedec, compno, level, orient, bpno, qmfbid, stepsize, numcomps);   /*mod fixed_quality*/
 614     tile->distotile += t1_getwmsedec(nmsedec, compno, level, orient, bpno, qmfbid, stepsize, numcomps);   /*add antonin quality*/
 615
 616
 617     /* Code switch "RESTART" (i.e. TERMALL) */
 618     if ((cblksty & J2K_CCP_CBLKSTY_TERMALL)
 619    && !((passtype == 2) && (bpno - 1 < 0))) {
 620       if (type == T1_TYPE_RAW) {
 621    mqc_flush();
 622    correction = 1;
 623    /* correction = mqc_bypass_flush_enc(); */
 624       } else {         /* correction = mqc_restart_enc(); */
 625    mqc_flush();
 626    correction = 1;
 627       }
 628       pass->term = 1;
 629     } else {
 630       if (((bpno < (cblk->numbps - 4) && (passtype > 0))
 631       || ((bpno == (cblk->numbps - 4)) && (passtype == 2)))
 632      && (cblksty & J2K_CCP_CBLKSTY_LAZY)) {
 633    if (type == T1_TYPE_RAW) {
 634      mqc_flush();
 635      correction = 1;
 636      /* correction = mqc_bypass_flush_enc(); */
 637    } else {      /* correction = mqc_restart_enc(); */
 638      mqc_flush();
 639      correction = 1;
 640    }
 641    pass->term = 1;
 642       } else {
 643    pass->term = 0;
 644       }
 645     }
 646
 647     if (++passtype == 3) {
 648       passtype = 0;
 649       bpno--;
 650     }
 651
 652     if (pass->term && bpno > 0) {
 653       type = ((bpno < (cblk->numbps - 4)) && (passtype < 2)
 654          && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
 655    T1_TYPE_MQ;
 656       if (type == T1_TYPE_RAW)
 657    mqc_bypass_init_enc();
 658       else
 659    mqc_restart_init_enc();
 660     }
 661
 662     pass->distortiondec = cumwmsedec;
 663     pass->rate = mqc_numbytes() + correction;   /* FIXME */
 664     pass->len =
 665       pass->rate - (passno == 0 ? 0 : cblk->passes[passno - 1].rate);
 666
 667     /* Code-switch "RESET" */
 668     if (cblksty & J2K_CCP_CBLKSTY_RESET)
 669       mqc_reset_enc();
 670   }
 671
 672   /* Code switch "ERTERM" (i.e. PTERM) */
 673   if (cblksty & J2K_CCP_CBLKSTY_PTERM)
 674     mqc_erterm_enc();
 675   else /* Default coding */ if (!(cblksty & J2K_CCP_CBLKSTY_LAZY))
 676     mqc_flush();
 677
 678   cblk->totalpasses = passno;
 679 }
 680
 681 void t1_decode_cblk(tcd_cblk_t * cblk, int orient, int roishift,
 682           int cblksty)
 683 {
 684   int i, j, w, h;
 685   int bpno, passtype;
 686   int segno, passno;
 687   char type = T1_TYPE_MQ; /*BYPASS mode*/
 688
 689   w = cblk->x1 - cblk->x0;
 690   h = cblk->y1 - cblk->y0;
 691
 692   /* Changed by Dmitry Kolyadin */
 693   for (j = 0; j <= h; j++){
 694     for (i = 0; i <= w; i++) {
 695       t1_flags[j][i] = 0;
 696   }
 697   }
 698
 699   /* Changed by Dmitry Kolyadin */
 700   for (i = 0; i < w; i++) {
 701       for (j = 0; j < h; j++){
 702    t1_data[j][i] = 0;
 703       }
 704   }
 705
 706   bpno = roishift + cblk->numbps - 1;
 707   passtype = 2;
 708
 709   mqc_resetstates();
 710   mqc_setstate(T1_CTXNO_UNI, 0, 46);
 711   mqc_setstate(T1_CTXNO_AGG, 0, 3);
 712   mqc_setstate(T1_CTXNO_ZC, 0, 4);
 713
 714   for (segno = 0; segno < cblk->numsegs; segno++) {
 715     tcd_seg_t *seg = &cblk->segs[segno];
 716
 717     /* Add BYPASS mode */
 718     type = ((bpno <= (cblk->numbps - 1) - 4) && (passtype < 2)
 719       && (cblksty & J2K_CCP_CBLKSTY_LAZY)) ? T1_TYPE_RAW :
 720     T1_TYPE_MQ;
 721     if (type == T1_TYPE_RAW)
 722       raw_init_dec(seg->data, seg->len);
 723     else
 724       mqc_init_dec(seg->data, seg->len);
 725     /* ddA */
 726
 727     for (passno = 0; passno < seg->numpasses; passno++) {
 728       switch (passtype) {
 729       case 0:
 730    t1_dec_sigpass(w, h, bpno+1, orient, type, cblksty);
 731    break;
 732       case 1:
 733    t1_dec_refpass(w, h, bpno+1, type, cblksty);
 734    break;
 735       case 2:
 736    t1_dec_clnpass(w, h, bpno+1, orient, cblksty);
 737    break;
 738       }
 739
 740       if ((cblksty & J2K_CCP_CBLKSTY_RESET) && type == T1_TYPE_MQ) {
 741    mqc_resetstates();
 742
 743    mqc_setstate(T1_CTXNO_UNI, 0, 46);
 744
 745    mqc_setstate(T1_CTXNO_AGG, 0, 3);
 746
 747    mqc_setstate(T1_CTXNO_ZC, 0, 4);
 748
 749       }
 750
 751       if (++passtype == 3) {
 752    passtype = 0;
 753    bpno--;
 754       }
 755     }
 756   }
 757 }
 758
 759 void t1_encode_cblks(tcd_tile_t * tile, j2k_tcp_t * tcp)
 760 {
 761   int compno, resno, bandno, precno, cblkno;
 762   int x, y, i, j, orient;
 763   tcd_tilecomp_t *tilec;
 764   tcd_resolution_t *res;
 765   tcd_band_t *band;
 766   tcd_precinct_t *prc;
 767   tcd_cblk_t *cblk;
 768
 769   tile->distotile = 0;      /*add fixed_quality*/
 770
 771   for (compno = 0; compno < tile->numcomps; compno++) {
 772     tilec = &tile->comps[compno];
 773     for (resno = 0; resno < tilec->numresolutions; resno++) {
 774       res = &tilec->resolutions[resno];
 775       for (bandno = 0; bandno < res->numbands; bandno++) {
 776    band = &res->bands[bandno];
 777    for (precno = 0; precno < res->pw * res->ph; precno++) {
 778      prc = &band->precincts[precno];
 779      for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 780        cblk = &prc->cblks[cblkno];
 781
 782        if (band->bandno == 0) {
 783          x = cblk->x0 - band->x0;
 784          y = cblk->y0 - band->y0;
 785        } else if (band->bandno == 1) {
 786          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 787          x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
 788          y = cblk->y0 - band->y0;
 789        } else if (band->bandno == 2) {
 790          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 791          x = cblk->x0 - band->x0;
 792          y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
 793        } else {      /* if (band->bandno == 3) */
 794          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 795          x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
 796          y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
 797        }
 798
 799        if (tcp->tccps[compno].qmfbid == 1) {
 800
 801          for (j = 0; j < cblk->y1 - cblk->y0; j++) {
 802       for (i = 0; i < cblk->x1 - cblk->x0; i++) {
 803         t1_data[j][i] =
 804           tilec->data[(x + i) +
 805             (y + j) * (tilec->x1 -
 806                   tilec->
 807                   x0)] << T1_NMSEDEC_FRACBITS;
 808       }
 809          }
 810        } else if (tcp->tccps[compno].qmfbid == 0) {
 811          for (j = 0; j < cblk->y1 - cblk->y0; j++) {
 812       for (i = 0; i < cblk->x1 - cblk->x0; i++) {
 813         t1_data[j][i] =
 814           fix_mul(tilec->
 815              data[x + i +
 816              (y + j) * (tilec->x1 -
 817                    tilec->
 818                    x0)],
 819              8192 * 8192 /
 820              ((int) floor(band->stepsize * 8192))) >> (13 - T1_NMSEDEC_FRACBITS);
 821       }
 822          }
 823        }
 824        orient = band->bandno;   /* FIXME */
 825        if (orient == 2) {
 826          orient = 1;
 827        } else if (orient == 1) {
 828          orient = 2;
 829        }
 830        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*/
 831      }         /* cblkno */
 832    }         /* precno */
 833       }            /* bandno */
 834     }            /* resno  */
 835   }            /* compo  */
 836 }
 837
 838
 839 void t1_decode_cblks(tcd_tile_t * tile, j2k_tcp_t * tcp)
 840 {
 841   int compno, resno, bandno, precno, cblkno;
 842
 843   for (compno = 0; compno < tile->numcomps; compno++) {
 844     tcd_tilecomp_t *tilec = &tile->comps[compno];
 845     for (resno = 0; resno < tilec->numresolutions; resno++) {
 846       tcd_resolution_t *res = &tilec->resolutions[resno];
 847       for (bandno = 0; bandno < res->numbands; bandno++) {
 848    tcd_band_t *band = &res->bands[bandno];
 849    for (precno = 0; precno < res->pw * res->ph; precno++) {
 850      tcd_precinct_t *prc = &band->precincts[precno];
 851      for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 852        int x, y, i, j, orient;
 853        tcd_cblk_t *cblk = &prc->cblks[cblkno];
 854        orient = band->bandno;   /* FIXME */
 855        if (orient == 2)
 856          orient = 1;
 857        else if (orient == 1)
 858          orient = 2;
 859        t1_decode_cblk(cblk, orient,
 860             tcp->tccps[compno].roishift,
 861             tcp->tccps[compno].cblksty);
 862        if (band->bandno == 0) {
 863          x = cblk->x0 - band->x0;
 864          y = cblk->y0 - band->y0;
 865        } else if (band->bandno == 1) {
 866          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 867          x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
 868          y = cblk->y0 - band->y0;
 869        } else if (band->bandno == 2) {
 870          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 871          x = cblk->x0 - band->x0;
 872          y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
 873        } else {      /* if (band->bandno == 3) */
 874          tcd_resolution_t *pres = &tilec->resolutions[resno - 1];
 875          x = pres->x1 - pres->x0 + cblk->x0 - band->x0;
 876          y = pres->y1 - pres->y0 + cblk->y0 - band->y0;
 877        }
 878
 879        if (tcp->tccps[compno].roishift) {
 880          int thresh, val, mag;
 881          thresh = 1 << tcp->tccps[compno].roishift;
 882          for (j = 0; j < cblk->y1 - cblk->y0; j++) {
 883       for (i = 0; i < cblk->x1 - cblk->x0; i++) {
 884         val = t1_data[j][i];
 885         mag = int_abs(val);
 886         if (mag >= thresh) {
 887           mag >>= tcp->tccps[compno].roishift;
 888           t1_data[j][i] = val < 0 ? -mag : mag;
 889         }
 890       }
 891          }
 892        }
 893
 894        if (tcp->tccps[compno].qmfbid == 1) {
 895          for (j = 0; j < cblk->y1 - cblk->y0; j++) {
 896       for (i = 0; i < cblk->x1 - cblk->x0; i++) {
 897                   int tmp=t1_data[j][i];
 898                   if (tmp>>1==0) tilec->data[x + i + (y + j) * (tilec->x1 - tilec->x0)] = 0;
 899         else tilec->data[x + i + (y + j) * (tilec->x1 - tilec->x0)] = tmp<0?(tmp>>1)+1:(tmp>>1);
 900       }
 901          }
 902        } else {      /* if (tcp->tccps[compno].qmfbid == 0) */
 903
 904          for (j = 0; j < cblk->y1 - cblk->y0; j++) {
 905       for (i = 0; i < cblk->x1 - cblk->x0; i++) {
 906                   double tmp=t1_data[j][i] * band->stepsize * 4096.0;
 907                   int tmp2;
 908         if (t1_data[j][i]>>1 == 0) {
 909           tilec->data[x + i + (y + j) * (tilec->x1 - tilec->x0)] = 0;
 910         } else {
 911                     tmp2=((int) (floor(fabs(tmp)))) + ((int) floor(fabs(tmp*2))%2);
 912           tilec->data[x + i + (y + j) * (tilec->x1 - tilec->x0)] = ((tmp<0)?-tmp2:tmp2);
 913         }
 914       }
 915          }
 916        }
 917      }
 918    }
 919       }
 920     }
 921   }
 922 }
 923
 924 int t1_init_ctxno_zc(int f, int orient)
 925 {
 926   int h, v, d, n, t, hv;
 927   n = 0;
 928   h = ((f & T1_SIG_W) != 0) + ((f & T1_SIG_E) != 0);
 929   v = ((f & T1_SIG_N) != 0) + ((f & T1_SIG_S) != 0);
 930   d = ((f & T1_SIG_NW) != 0) + ((f & T1_SIG_NE) !=
 931             0) + ((f & T1_SIG_SE) !=
 932                   0) + ((f & T1_SIG_SW) != 0);
 933   switch (orient) {
 934   case 2:
 935     t = h;
 936     h = v;
 937     v = t;
 938   case 0:
 939   case 1:
 940     if (!h) {
 941       if (!v) {
 942    if (!d)
 943      n = 0;
 944    else if (d == 1)
 945      n = 1;
 946    else
 947      n = 2;
 948       } else if (v == 1)
 949    n = 3;
 950       else
 951    n = 4;
 952     } else if (h == 1) {
 953       if (!v) {
 954    if (!d)
 955      n = 5;
 956    else
 957      n = 6;
 958       } else
 959    n = 7;
 960     } else
 961       n = 8;
 962     break;
 963   case 3:
 964     hv = h + v;
 965     if (!d) {
 966       if (!hv)
 967    n = 0;
 968       else if (hv == 1)
 969    n = 1;
 970       else
 971    n = 2;
 972     } else if (d == 1) {
 973       if (!hv)
 974    n = 3;
 975       else if (hv == 1)
 976    n = 4;
 977       else
 978    n = 5;
 979     } else if (d == 2) {
 980       if (!hv)
 981    n = 6;
 982       else
 983    n = 7;
 984     } else
 985       n = 8;
 986     break;
 987   }
 988   return T1_CTXNO_ZC + n;
 989 }
 990
 991 int t1_init_ctxno_sc(int f)
 992 {
 993   int hc, vc, n;
 994   n = 0;
 995   hc = int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
 996       T1_SIG_E) + ((f & (T1_SIG_W | T1_SGN_W)) == T1_SIG_W),
 997           1) - int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
 998               (T1_SIG_E | T1_SGN_E)) +
 999              ((f & (T1_SIG_W | T1_SGN_W)) ==
1000               (T1_SIG_W | T1_SGN_W)), 1);
1001   vc = int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1002       T1_SIG_N) + ((f & (T1_SIG_S | T1_SGN_S)) == T1_SIG_S),
1003           1) - int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1004               (T1_SIG_N | T1_SGN_N)) +
1005              ((f & (T1_SIG_S | T1_SGN_S)) ==
1006               (T1_SIG_S | T1_SGN_S)), 1);
1007   if (hc < 0) {
1008     hc = -hc;
1009     vc = -vc;
1010   }
1011   if (!hc) {
1012     if (vc == -1)
1013       n = 1;
1014     else if (!vc)
1015       n = 0;
1016     else
1017       n = 1;
1018   } else if (hc == 1) {
1019     if (vc == -1)
1020       n = 2;
1021     else if (!vc)
1022       n = 3;
1023     else
1024       n = 4;
1025   }
1026   return T1_CTXNO_SC + n;
1027 }
1028
1029 int t1_init_ctxno_mag(int f)
1030 {
1031   int n;
1032   if (!(f & T1_REFINE))
1033     n = (f & (T1_SIG_OTH)) ? 1 : 0;
1034   else
1035     n = 2;
1036   return T1_CTXNO_MAG + n;
1037 }
1038
1039 int t1_init_spb(int f)
1040 {
1041   int hc, vc, n;
1042   hc = int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
1043       T1_SIG_E) + ((f & (T1_SIG_W | T1_SGN_W)) == T1_SIG_W),
1044           1) - int_min(((f & (T1_SIG_E | T1_SGN_E)) ==
1045               (T1_SIG_E | T1_SGN_E)) +
1046              ((f & (T1_SIG_W | T1_SGN_W)) ==
1047               (T1_SIG_W | T1_SGN_W)), 1);
1048   vc = int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1049       T1_SIG_N) + ((f & (T1_SIG_S | T1_SGN_S)) == T1_SIG_S),
1050           1) - int_min(((f & (T1_SIG_N | T1_SGN_N)) ==
1051               (T1_SIG_N | T1_SGN_N)) +
1052              ((f & (T1_SIG_S | T1_SGN_S)) ==
1053               (T1_SIG_S | T1_SGN_S)), 1);
1054   if (!hc && !vc)
1055     n = 0;
1056   else
1057     n = (!(hc > 0 || (!hc && vc > 0)));
1058   return n;
1059 }
1060
1061 void t1_init_luts()
1062 {
1063   int i, j;
1064   double u, v, t;
1065   for (j = 0; j < 4; j++) {
1066     for (i = 0; i < 256; ++i) {
1067       t1_lut_ctxno_zc[(j << 8) | i] = t1_init_ctxno_zc(i, j);
1068     }
1069   }
1070   for (i = 0; i < 256; i++) {
1071     t1_lut_ctxno_sc[i] = t1_init_ctxno_sc(i << 4);
1072   }
1073   for (j = 0; j < 2; j++) {
1074     for (i = 0; i < 2048; ++i) {
1075       t1_lut_ctxno_mag[(j << 11) + i] =
1076    t1_init_ctxno_mag((j ? T1_REFINE : 0) | i);
1077     }
1078   }
1079   for (i = 0; i < 256; ++i) {
1080     t1_lut_spb[i] = t1_init_spb(i << 4);
1081   }
1082   /* FIXME FIXME FIXME */
1083   /* fprintf(stdout,"nmsedec luts:\n"); */
1084   for (i = 0; i < (1 << T1_NMSEDEC_BITS); i++) {
1085     t = i / pow(2, T1_NMSEDEC_FRACBITS);
1086     u = t;
1087     v = t - 1.5;
1088     t1_lut_nmsedec_sig[i] =
1089       int_max(0,
1090          (int) (floor
1091            ((u * u - v * v) * pow(2,
1092                    T1_NMSEDEC_FRACBITS) +
1093             0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1094     t1_lut_nmsedec_sig0[i] =
1095       int_max(0,
1096          (int) (floor
1097            ((u * u) * pow(2, T1_NMSEDEC_FRACBITS) +
1098             0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1099     u = t - 1.0;
1100     if (i & (1 << (T1_NMSEDEC_BITS - 1))) {
1101       v = t - 1.5;
1102     } else {
1103       v = t - 0.5;
1104     }
1105     t1_lut_nmsedec_ref[i] =
1106       int_max(0,
1107          (int) (floor
1108            ((u * u - v * v) * pow(2,
1109                    T1_NMSEDEC_FRACBITS) +
1110             0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1111     t1_lut_nmsedec_ref0[i] =
1112       int_max(0,
1113          (int) (floor
1114            ((u * u) * pow(2, T1_NMSEDEC_FRACBITS) +
1115             0.5) / pow(2, T1_NMSEDEC_FRACBITS) * 8192.0));
1116   }
1117 }