libopenjpeg/t2.c

   1 /*
   2  * Copyright (c) 2002-2007, Communications and Remote Sensing Laboratory, Universite catholique de Louvain (UCL), Belgium
   3  * Copyright (c) 2002-2007, Professor Benoit Macq
   4  * Copyright (c) 2001-2003, David Janssens
   5  * Copyright (c) 2002-2003, Yannick Verschueren
   6  * Copyright (c) 2003-2007, Francois-Olivier Devaux and Antonin Descampe
   7  * Copyright (c) 2005, Herve Drolon, FreeImage Team
   8  * All rights reserved.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  * 1. Redistributions of source code must retain the above copyright
  14  *    notice, this list of conditions and the following disclaimer.
  15  * 2. Redistributions in binary form must reproduce the above copyright
  16  *    notice, this list of conditions and the following disclaimer in the
  17  *    documentation and/or other materials provided with the distribution.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
  20  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  23  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  29  * POSSIBILITY OF SUCH DAMAGE.
  30  */
  31
  32 #include "opj_includes.h"
  33
  34 /** @defgroup T2 T2 - Implementation of a tier-2 coding */
  35 /*@{*/
  36
  37 /** @name Local static functions */
  38 /*@{*/
  39
  40 static void t2_putcommacode(opj_bio_t *bio, int n);
  41 static int t2_getcommacode(opj_bio_t *bio);
  42 /**
  43 Variable length code for signalling delta Zil (truncation point)
  44 @param bio Bit Input/Output component
  45 @param n delta Zil
  46 */
  47 static void t2_putnumpasses(opj_bio_t *bio, int n);
  48 static int t2_getnumpasses(opj_bio_t *bio);
  49 /**
  50 Encode a packet of a tile to a destination buffer
  51 @param tile Tile for which to write the packets
  52 @param tcp Tile coding parameters
  53 @param pi Packet identity
  54 @param dest Destination buffer
  55 @param len Length of the destination buffer
  56 @param cstr_info Codestream information structure
  57 @param tileno Number of the tile encoded
  58 @return
  59 */
  60 static int t2_encode_packet(opj_tcd_tile_t *tile, opj_tcp_t *tcp, opj_pi_iterator_t *pi, unsigned char *dest, int len, opj_codestream_info_t *cstr_info, int tileno);
  61 /**
  62 @param cblk
  63 @param index
  64 @param cblksty
  65 @param first
  66 */
  67 static void t2_init_seg(opj_tcd_cblk_dec_t* cblk, int index, int cblksty, int first);
  68 /**
  69 Decode a packet of a tile from a source buffer
  70 @param t2 T2 handle
  71 @param src Source buffer
  72 @param len Length of the source buffer
  73 @param tile Tile for which to write the packets
  74 @param tcp Tile coding parameters
  75 @param pi Packet identity
  76 @param pack_info Packet information
  77 @return
  78 */
  79 static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile,
  80                                                                                                                 opj_tcp_t *tcp, opj_pi_iterator_t *pi, opj_packet_info_t *pack_info);
  81
  82
  83 /**
  84 Decode a packet of a tile from a source buffer
  85 @param t2 T2 handle
  86 @param src Source buffer
  87 @param len Length of the source buffer
  88 @param tile Tile for which to write the packets
  89 @param tcp Tile coding parameters
  90 @param pi Packet identity
  91 @return
  92 */
  93 static opj_bool t2_decode_packet_v2(
  94                                                          opj_t2_v2_t* p_t2,
  95                                                          opj_tcd_tile_v2_t *p_tile,
  96                              opj_tcp_v2_t *p_tcp,
  97                                                          opj_pi_iterator_t *p_pi,
  98                                                          OPJ_BYTE *p_src,
  99                                                          OPJ_UINT32 * p_data_read,
 100                                                          OPJ_UINT32 p_max_length,
 101                                                          opj_packet_info_t *p_pack_info);
 102
 103 static opj_bool t2_skip_packet(
 104                                                          opj_t2_v2_t* p_t2,
 105                                                          opj_tcd_tile_v2_t *p_tile,
 106                              opj_tcp_v2_t *p_tcp,
 107                                                          opj_pi_iterator_t *p_pi,
 108                                                          OPJ_BYTE *p_src,
 109                                                          OPJ_UINT32 * p_data_read,
 110                                                          OPJ_UINT32 p_max_length,
 111                                                          opj_packet_info_t *p_pack_info);
 112
 113 static opj_bool t2_read_packet_header(
 114                                                          opj_t2_v2_t* p_t2,
 115                                                          opj_tcd_tile_v2_t *p_tile,
 116                              opj_tcp_v2_t *p_tcp,
 117                                                          opj_pi_iterator_t *p_pi,
 118                                                          opj_bool * p_is_data_present,
 119                                                          OPJ_BYTE *p_src_data,
 120                                                          OPJ_UINT32 * p_data_read,
 121                                                          OPJ_UINT32 p_max_length,
 122                                                          opj_packet_info_t *p_pack_info);
 123
 124 static opj_bool t2_read_packet_data(
 125                                                          opj_t2_v2_t* p_t2,
 126                                                          opj_tcd_tile_v2_t *p_tile,
 127                                                          opj_pi_iterator_t *p_pi,
 128                                                          OPJ_BYTE *p_src_data,
 129                                                          OPJ_UINT32 * p_data_read,
 130                                                          OPJ_UINT32 p_max_length,
 131                                                          opj_packet_info_t *pack_info);
 132
 133 static opj_bool t2_skip_packet_data(
 134                                                          opj_t2_v2_t* p_t2,
 135                                                          opj_tcd_tile_v2_t *p_tile,
 136                                                          opj_pi_iterator_t *p_pi,
 137                                                          OPJ_UINT32 * p_data_read,
 138                                                          OPJ_UINT32 p_max_length,
 139                                                          opj_packet_info_t *pack_info);
 140
 141 /**
 142 @param seg
 143 @param cblksty
 144 @param first
 145 */
 146 static opj_bool t2_init_seg_v2( opj_tcd_cblk_dec_v2_t* cblk,
 147                                                                 OPJ_UINT32 index,
 148                                                                 OPJ_UINT32 cblksty,
 149                                                                 OPJ_UINT32 first);
 150
 151 /*@}*/
 152
 153 /*@}*/
 154
 155 /* ----------------------------------------------------------------------- */
 156
 157 /* #define RESTART 0x04 */
 158
 159 static void t2_putcommacode(opj_bio_t *bio, int n) {
 160         while (--n >= 0) {
 161                 bio_write(bio, 1, 1);
 162         }
 163         bio_write(bio, 0, 1);
 164 }
 165
 166 static int t2_getcommacode(opj_bio_t *bio) {
 167         int n;
 168         for (n = 0; bio_read(bio, 1); n++) {
 169                 ;
 170         }
 171         return n;
 172 }
 173
 174 static void t2_putnumpasses(opj_bio_t *bio, int n) {
 175         if (n == 1) {
 176                 bio_write(bio, 0, 1);
 177         } else if (n == 2) {
 178                 bio_write(bio, 2, 2);
 179         } else if (n <= 5) {
 180                 bio_write(bio, 0xc | (n - 3), 4);
 181         } else if (n <= 36) {
 182                 bio_write(bio, 0x1e0 | (n - 6), 9);
 183         } else if (n <= 164) {
 184                 bio_write(bio, 0xff80 | (n - 37), 16);
 185         }
 186 }
 187
 188 static int t2_getnumpasses(opj_bio_t *bio) {
 189         int n;
 190         if (!bio_read(bio, 1))
 191                 return 1;
 192         if (!bio_read(bio, 1))
 193                 return 2;
 194         if ((n = bio_read(bio, 2)) != 3)
 195                 return (3 + n);
 196         if ((n = bio_read(bio, 5)) != 31)
 197                 return (6 + n);
 198         return (37 + bio_read(bio, 7));
 199 }
 200
 201 static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_iterator_t *pi, unsigned char *dest, int length, opj_codestream_info_t *cstr_info, int tileno) {
 202         int bandno, cblkno;
 203         unsigned char *c = dest;
 204
 205         int compno = pi->compno;        /* component value */
 206         int resno  = pi->resno;         /* resolution level value */
 207         int precno = pi->precno;        /* precinct value */
 208         int layno  = pi->layno;         /* quality layer value */
 209
 210         opj_tcd_tilecomp_t *tilec = &tile->comps[compno];
 211         opj_tcd_resolution_t *res = &tilec->resolutions[resno];
 212
 213         opj_bio_t *bio = NULL;  /* BIO component */
 214
 215         /* <SOP 0xff91> */
 216         if (tcp->csty & J2K_CP_CSTY_SOP) {
 217                 c[0] = 255;
 218                 c[1] = 145;
 219                 c[2] = 0;
 220                 c[3] = 4;
 221                 c[4] = (unsigned char)((tile->packno % 65536) / 256);
 222                 c[5] = (unsigned char)((tile->packno % 65536) % 256);
 223                 c += 6;
 224         }
 225         /* </SOP> */
 226
 227         if (!layno) {
 228                 for (bandno = 0; bandno < res->numbands; bandno++) {
 229                         opj_tcd_band_t *band = &res->bands[bandno];
 230                         opj_tcd_precinct_t *prc = &band->precincts[precno];
 231                         tgt_reset(prc->incltree);
 232                         tgt_reset(prc->imsbtree);
 233                         for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 234                                 opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
 235                                 cblk->numpasses = 0;
 236                                 tgt_setvalue(prc->imsbtree, cblkno, band->numbps - cblk->numbps);
 237                         }
 238                 }
 239         }
 240
 241         bio = bio_create();
 242         bio_init_enc(bio, c, length);
 243         bio_write(bio, 1, 1);           /* Empty header bit */
 244
 245         /* Writing Packet header */
 246         for (bandno = 0; bandno < res->numbands; bandno++) {
 247                 opj_tcd_band_t *band = &res->bands[bandno];
 248                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 249                 for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 250                         opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
 251                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 252                         if (!cblk->numpasses && layer->numpasses) {
 253                                 tgt_setvalue(prc->incltree, cblkno, layno);
 254                         }
 255                 }
 256                 for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 257                         opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
 258                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 259                         int increment = 0;
 260                         int nump = 0;
 261                         int len = 0, passno;
 262                         /* cblk inclusion bits */
 263                         if (!cblk->numpasses) {
 264                                 tgt_encode(bio, prc->incltree, cblkno, layno + 1);
 265                         } else {
 266                                 bio_write(bio, layer->numpasses != 0, 1);
 267                         }
 268                         /* if cblk not included, go to the next cblk  */
 269                         if (!layer->numpasses) {
 270                                 continue;
 271                         }
 272                         /* if first instance of cblk --> zero bit-planes information */
 273                         if (!cblk->numpasses) {
 274                                 cblk->numlenbits = 3;
 275                                 tgt_encode(bio, prc->imsbtree, cblkno, 999);
 276                         }
 277                         /* number of coding passes included */
 278                         t2_putnumpasses(bio, layer->numpasses);
 279
 280                         /* computation of the increase of the length indicator and insertion in the header     */
 281                         for (passno = cblk->numpasses; passno < cblk->numpasses + layer->numpasses; passno++) {
 282                                 opj_tcd_pass_t *pass = &cblk->passes[passno];
 283                                 nump++;
 284                                 len += pass->len;
 285                                 if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
 286                                         increment = int_max(increment, int_floorlog2(len) + 1 - (cblk->numlenbits + int_floorlog2(nump)));
 287                                         len = 0;
 288                                         nump = 0;
 289                                 }
 290                         }
 291                         t2_putcommacode(bio, increment);
 292
 293                         /* computation of the new Length indicator */
 294                         cblk->numlenbits += increment;
 295
 296                         /* insertion of the codeword segment length */
 297                         for (passno = cblk->numpasses; passno < cblk->numpasses + layer->numpasses; passno++) {
 298                                 opj_tcd_pass_t *pass = &cblk->passes[passno];
 299                                 nump++;
 300                                 len += pass->len;
 301                                 if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
 302                                         bio_write(bio, len, cblk->numlenbits + int_floorlog2(nump));
 303                                         len = 0;
 304                                         nump = 0;
 305                                 }
 306                         }
 307                 }
 308         }
 309
 310         if (bio_flush(bio)) {
 311                 bio_destroy(bio);
 312                 return -999;            /* modified to eliminate longjmp !! */
 313         }
 314
 315         c += bio_numbytes(bio);
 316         bio_destroy(bio);
 317
 318         /* <EPH 0xff92> */
 319         if (tcp->csty & J2K_CP_CSTY_EPH) {
 320                 c[0] = 255;
 321                 c[1] = 146;
 322                 c += 2;
 323         }
 324         /* </EPH> */
 325
 326         /* << INDEX */
 327         // End of packet header position. Currently only represents the distance to start of packet
 328         // Will be updated later by incrementing with packet start value
 329         if(cstr_info && cstr_info->index_write) {
 330                 opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
 331                 info_PK->end_ph_pos = (int)(c - dest);
 332         }
 333         /* INDEX >> */
 334
 335         /* Writing the packet body */
 336
 337         for (bandno = 0; bandno < res->numbands; bandno++) {
 338                 opj_tcd_band_t *band = &res->bands[bandno];
 339                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 340                 for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 341                         opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
 342                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 343                         if (!layer->numpasses) {
 344                                 continue;
 345                         }
 346                         if (c + layer->len > dest + length) {
 347                                 return -999;
 348                         }
 349
 350                         memcpy(c, layer->data, layer->len);
 351                         cblk->numpasses += layer->numpasses;
 352                         c += layer->len;
 353                         /* << INDEX */
 354                         if(cstr_info && cstr_info->index_write) {
 355                                 opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
 356                                 info_PK->disto += layer->disto;
 357                                 if (cstr_info->D_max < info_PK->disto) {
 358                                         cstr_info->D_max = info_PK->disto;
 359                                 }
 360                         }
 361                         /* INDEX >> */
 362                 }
 363         }
 364
 365         return (c - dest);
 366 }
 367
 368 static void t2_init_seg(opj_tcd_cblk_dec_t* cblk, int index, int cblksty, int first) {
 369         opj_tcd_seg_t* seg;
 370         cblk->segs = (opj_tcd_seg_t*) opj_realloc(cblk->segs, (index + 1) * sizeof(opj_tcd_seg_t));
 371         seg = &cblk->segs[index];
 372         seg->data = NULL;
 373         seg->dataindex = 0;
 374         seg->numpasses = 0;
 375         seg->len = 0;
 376         if (cblksty & J2K_CCP_CBLKSTY_TERMALL) {
 377                 seg->maxpasses = 1;
 378         }
 379         else if (cblksty & J2K_CCP_CBLKSTY_LAZY) {
 380                 if (first) {
 381                         seg->maxpasses = 10;
 382                 } else {
 383                         seg->maxpasses = (((seg - 1)->maxpasses == 1) || ((seg - 1)->maxpasses == 10)) ? 2 : 1;
 384                 }
 385         } else {
 386                 seg->maxpasses = 109;
 387         }
 388 }
 389
 390 static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile,
 391                                                                                                                 opj_tcp_t *tcp, opj_pi_iterator_t *pi, opj_packet_info_t *pack_info) {
 392         int bandno, cblkno;
 393         unsigned char *c = src;
 394
 395         opj_cp_t *cp = t2->cp;
 396
 397         int compno = pi->compno;        /* component value */
 398         int resno  = pi->resno;         /* resolution level value */
 399         int precno = pi->precno;        /* precinct value */
 400         int layno  = pi->layno;         /* quality layer value */
 401
 402         opj_tcd_resolution_t* res = &tile->comps[compno].resolutions[resno];
 403
 404         unsigned char *hd = NULL;
 405         int present;
 406
 407         opj_bio_t *bio = NULL;  /* BIO component */
 408
 409         if (layno == 0) {
 410                 for (bandno = 0; bandno < res->numbands; bandno++) {
 411                         opj_tcd_band_t *band = &res->bands[bandno];
 412                         opj_tcd_precinct_t *prc = &band->precincts[precno];
 413
 414                         if ((band->x1-band->x0 == 0)||(band->y1-band->y0 == 0)) continue;
 415
 416                         tgt_reset(prc->incltree);
 417                         tgt_reset(prc->imsbtree);
 418                         for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 419                                 opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
 420                                 cblk->numsegs = 0;
 421                         }
 422                 }
 423         }
 424
 425         /* SOP markers */
 426
 427         if (tcp->csty & J2K_CP_CSTY_SOP) {
 428                 if ((*c) != 0xff || (*(c + 1) != 0x91)) {
 429                         opj_event_msg(t2->cinfo, EVT_WARNING, "Expected SOP marker\n");
 430                 } else {
 431                         c += 6;
 432                 }
 433
 434                 /** TODO : check the Nsop value */
 435         }
 436
 437         /*
 438         When the marker PPT/PPM is used the packet header are store in PPT/PPM marker
 439         This part deal with this caracteristic
 440         step 1: Read packet header in the saved structure
 441         step 2: Return to codestream for decoding
 442         */
 443
 444         bio = bio_create();
 445
 446         if (cp->ppm == 1) {             /* PPM */
 447                 hd = cp->ppm_data;
 448                 bio_init_dec(bio, hd, cp->ppm_len);
 449         } else if (tcp->ppt == 1) {     /* PPT */
 450                 hd = tcp->ppt_data;
 451                 bio_init_dec(bio, hd, tcp->ppt_len);
 452         } else {                        /* Normal Case */
 453                 hd = c;
 454                 bio_init_dec(bio, hd, src+len-hd);
 455         }
 456
 457         present = bio_read(bio, 1);
 458
 459         if (!present) {
 460                 bio_inalign(bio);
 461                 hd += bio_numbytes(bio);
 462                 bio_destroy(bio);
 463
 464                 /* EPH markers */
 465
 466                 if (tcp->csty & J2K_CP_CSTY_EPH) {
 467                         if ((*hd) != 0xff || (*(hd + 1) != 0x92)) {
 468                                 printf("Error : expected EPH marker\n");
 469                         } else {
 470                                 hd += 2;
 471                         }
 472                 }
 473
 474                 /* << INDEX */
 475                 // End of packet header position. Currently only represents the distance to start of packet
 476                 // Will be updated later by incrementing with packet start value
 477                 if(pack_info) {
 478                         pack_info->end_ph_pos = (int)(c - src);
 479                 }
 480                 /* INDEX >> */
 481
 482                 if (cp->ppm == 1) {             /* PPM case */
 483                         cp->ppm_len += cp->ppm_data-hd;
 484                         cp->ppm_data = hd;
 485                         return (c - src);
 486                 }
 487                 if (tcp->ppt == 1) {    /* PPT case */
 488                         tcp->ppt_len+=tcp->ppt_data-hd;
 489                         tcp->ppt_data = hd;
 490                         return (c - src);
 491                 }
 492
 493                 return (hd - src);
 494         }
 495
 496         for (bandno = 0; bandno < res->numbands; bandno++) {
 497                 opj_tcd_band_t *band = &res->bands[bandno];
 498                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 499
 500                 if ((band->x1-band->x0 == 0)||(band->y1-band->y0 == 0)) continue;
 501
 502                 for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 503                         int included, increment, n, segno;
 504                         opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
 505                         /* if cblk not yet included before --> inclusion tagtree */
 506                         if (!cblk->numsegs) {
 507                                 included = tgt_decode(bio, prc->incltree, cblkno, layno + 1);
 508                                 /* else one bit */
 509                         } else {
 510                                 included = bio_read(bio, 1);
 511                         }
 512                         /* if cblk not included */
 513                         if (!included) {
 514                                 cblk->numnewpasses = 0;
 515                                 continue;
 516                         }
 517                         /* if cblk not yet included --> zero-bitplane tagtree */
 518                         if (!cblk->numsegs) {
 519                                 int i, numimsbs;
 520                                 for (i = 0; !tgt_decode(bio, prc->imsbtree, cblkno, i); i++) {
 521                                         ;
 522                                 }
 523                                 numimsbs = i - 1;
 524                                 cblk->numbps = band->numbps - numimsbs;
 525                                 cblk->numlenbits = 3;
 526                         }
 527                         /* number of coding passes */
 528                         cblk->numnewpasses = t2_getnumpasses(bio);
 529                         increment = t2_getcommacode(bio);
 530                         /* length indicator increment */
 531                         cblk->numlenbits += increment;
 532                         segno = 0;
 533                         if (!cblk->numsegs) {
 534                                 t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 1);
 535                         } else {
 536                                 segno = cblk->numsegs - 1;
 537                                 if (cblk->segs[segno].numpasses == cblk->segs[segno].maxpasses) {
 538                                         ++segno;
 539                                         t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 0);
 540                                 }
 541                         }
 542                         n = cblk->numnewpasses;
 543
 544                         do {
 545                                 cblk->segs[segno].numnewpasses = int_min(cblk->segs[segno].maxpasses - cblk->segs[segno].numpasses, n);
 546                                 cblk->segs[segno].newlen = bio_read(bio, cblk->numlenbits + int_floorlog2(cblk->segs[segno].numnewpasses));
 547                                 n -= cblk->segs[segno].numnewpasses;
 548                                 if (n > 0) {
 549                                         ++segno;
 550                                         t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 0);
 551                                 }
 552                         } while (n > 0);
 553                 }
 554         }
 555
 556         if (bio_inalign(bio)) {
 557                 bio_destroy(bio);
 558                 return -999;
 559         }
 560
 561         hd += bio_numbytes(bio);
 562         bio_destroy(bio);
 563
 564         /* EPH markers */
 565         if (tcp->csty & J2K_CP_CSTY_EPH) {
 566                 if ((*hd) != 0xff || (*(hd + 1) != 0x92)) {
 567                         opj_event_msg(t2->cinfo, EVT_ERROR, "Expected EPH marker\n");
 568                         return -999;
 569                 } else {
 570                         hd += 2;
 571                 }
 572         }
 573
 574         /* << INDEX */
 575         // End of packet header position. Currently only represents the distance to start of packet
 576         // Will be updated later by incrementing with packet start value
 577         if(pack_info) {
 578                 pack_info->end_ph_pos = (int)(hd - src);
 579         }
 580         /* INDEX >> */
 581
 582         if (cp->ppm==1) {
 583                 cp->ppm_len+=cp->ppm_data-hd;
 584                 cp->ppm_data = hd;
 585         } else if (tcp->ppt == 1) {
 586                 tcp->ppt_len+=tcp->ppt_data-hd;
 587                 tcp->ppt_data = hd;
 588         } else {
 589                 c=hd;
 590         }
 591
 592         for (bandno = 0; bandno < res->numbands; bandno++) {
 593                 opj_tcd_band_t *band = &res->bands[bandno];
 594                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 595
 596                 if ((band->x1-band->x0 == 0)||(band->y1-band->y0 == 0)) continue;
 597
 598                 for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
 599                         opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
 600                         opj_tcd_seg_t *seg = NULL;
 601                         if (!cblk->numnewpasses)
 602                                 continue;
 603                         if (!cblk->numsegs) {
 604                                 seg = &cblk->segs[0];
 605                                 cblk->numsegs++;
 606                                 cblk->len = 0;
 607                         } else {
 608                                 seg = &cblk->segs[cblk->numsegs - 1];
 609                                 if (seg->numpasses == seg->maxpasses) {
 610                                         seg++;
 611                                         cblk->numsegs++;
 612                                 }
 613                         }
 614
 615                         do {
 616                                 if (c + seg->newlen > src + len) {
 617                                         return -999;
 618                                 }
 619
 620 #ifdef USE_JPWL
 621                         /* we need here a j2k handle to verify if making a check to
 622                         the validity of cblocks parameters is selected from user (-W) */
 623
 624                                 /* let's check that we are not exceeding */
 625                                 if ((cblk->len + seg->newlen) > 8192) {
 626                                         opj_event_msg(t2->cinfo, EVT_WARNING,
 627                                                 "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
 628                                                 seg->newlen, cblkno, precno, bandno, resno, compno);
 629                                         if (!JPWL_ASSUME) {
 630                                                 opj_event_msg(t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
 631                                                 return -999;
 632                                         }
 633                                         seg->newlen = 8192 - cblk->len;
 634                                         opj_event_msg(t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", seg->newlen);
 635                                         break;
 636                                 };
 637
 638 #endif /* USE_JPWL */
 639
 640                                 cblk->data = (unsigned char*) opj_realloc(cblk->data, (cblk->len + seg->newlen) * sizeof(unsigned char*));
 641                                 memcpy(cblk->data + cblk->len, c, seg->newlen);
 642                                 if (seg->numpasses == 0) {
 643                                         seg->data = &cblk->data;
 644                                         seg->dataindex = cblk->len;
 645                                 }
 646                                 c += seg->newlen;
 647                                 cblk->len += seg->newlen;
 648                                 seg->len += seg->newlen;
 649                                 seg->numpasses += seg->numnewpasses;
 650                                 cblk->numnewpasses -= seg->numnewpasses;
 651                                 if (cblk->numnewpasses > 0) {
 652                                         seg++;
 653                                         cblk->numsegs++;
 654                                 }
 655                         } while (cblk->numnewpasses > 0);
 656                 }
 657         }
 658
 659         return (c - src);
 660 }
 661
 662 /* ----------------------------------------------------------------------- */
 663
 664 int t2_encode_packets(opj_t2_t* t2,int tileno, opj_tcd_tile_t *tile, int maxlayers, unsigned char *dest, int len, opj_codestream_info_t *cstr_info,int tpnum, int tppos,int pino, J2K_T2_MODE t2_mode, int cur_totnum_tp){
 665         unsigned char *c = dest;
 666         int e = 0;
 667         int compno;
 668         opj_pi_iterator_t *pi = NULL;
 669         int poc;
 670         opj_image_t *image = t2->image;
 671         opj_cp_t *cp = t2->cp;
 672         opj_tcp_t *tcp = &cp->tcps[tileno];
 673         int pocno = cp->cinema == CINEMA4K_24? 2: 1;
 674         int maxcomp = cp->max_comp_size > 0 ? image->numcomps : 1;
 675
 676         pi = pi_initialise_encode(image, cp, tileno, t2_mode);
 677         if(!pi) {
 678                 /* TODO: throw an error */
 679                 return -999;
 680         }
 681
 682         if(t2_mode == THRESH_CALC ){ /* Calculating threshold */
 683                 for(compno = 0; compno < maxcomp; compno++ ){
 684                         for(poc = 0; poc < pocno ; poc++){
 685                                 int comp_len = 0;
 686                                 int tpnum = compno;
 687                                 if (pi_create_encode(pi, cp,tileno,poc,tpnum,tppos,t2_mode,cur_totnum_tp)) {
 688                                         opj_event_msg(t2->cinfo, EVT_ERROR, "Error initializing Packet Iterator\n");
 689                                         pi_destroy(pi, cp, tileno);
 690                                         return -999;
 691                                 }
 692                                 while (pi_next(&pi[poc])) {
 693                                         if (pi[poc].layno < maxlayers) {
 694                                                 e = t2_encode_packet(tile, &cp->tcps[tileno], &pi[poc], c, dest + len - c, cstr_info, tileno);
 695                                                 comp_len = comp_len + e;
 696                                                 if (e == -999) {
 697                                                         break;
 698                                                 } else {
 699                                                         c += e;
 700                                                 }
 701                                         }
 702                                 }
 703                                 if (e == -999) break;
 704                                 if (cp->max_comp_size){
 705                                         if (comp_len > cp->max_comp_size){
 706                                                 e = -999;
 707                                                 break;
 708                                         }
 709                                 }
 710                         }
 711                         if (e == -999)  break;
 712                 }
 713         }else{  /* t2_mode == FINAL_PASS  */
 714                 pi_create_encode(pi, cp,tileno,pino,tpnum,tppos,t2_mode,cur_totnum_tp);
 715                 while (pi_next(&pi[pino])) {
 716                         if (pi[pino].layno < maxlayers) {
 717                                 e = t2_encode_packet(tile, &cp->tcps[tileno], &pi[pino], c, dest + len - c, cstr_info, tileno);
 718                                 if (e == -999) {
 719                                         break;
 720                                 } else {
 721                                         c += e;
 722                                 }
 723                                 /* INDEX >> */
 724                                 if(cstr_info) {
 725                                         if(cstr_info->index_write) {
 726                                                 opj_tile_info_t *info_TL = &cstr_info->tile[tileno];
 727                                                 opj_packet_info_t *info_PK = &info_TL->packet[cstr_info->packno];
 728                                                 if (!cstr_info->packno) {
 729                                                         info_PK->start_pos = info_TL->end_header + 1;
 730                                                 } else {
 731                                                         info_PK->start_pos = ((cp->tp_on | tcp->POC)&& info_PK->start_pos) ? info_PK->start_pos : info_TL->packet[cstr_info->packno - 1].end_pos + 1;
 732                                                 }
 733                                                 info_PK->end_pos = info_PK->start_pos + e - 1;
 734                                                 info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance
 735                                                                                                                                                                                                                                                 // to start of packet is incremented by value of start of packet
 736                                         }
 737
 738                                         cstr_info->packno++;
 739                                 }
 740                                 /* << INDEX */
 741                                 tile->packno++;
 742                         }
 743                 }
 744         }
 745
 746         pi_destroy(pi, cp, tileno);
 747
 748         if (e == -999) {
 749                 return e;
 750         }
 751
 752   return (c - dest);
 753 }
 754
 755 int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj_tcd_tile_t *tile, opj_codestream_info_t *cstr_info) {
 756         unsigned char *c = src;
 757         opj_pi_iterator_t *pi;
 758         int pino, e = 0;
 759         int n = 0, curtp = 0;
 760         int tp_start_packno;
 761
 762         opj_image_t *image = t2->image;
 763         opj_cp_t *cp = t2->cp;
 764
 765         /* create a packet iterator */
 766         pi = pi_create_decode(image, cp, tileno);
 767         if(!pi) {
 768                 /* TODO: throw an error */
 769                 return -999;
 770         }
 771
 772         tp_start_packno = 0;
 773
 774         for (pino = 0; pino <= cp->tcps[tileno].numpocs; pino++) {
 775                 while (pi_next(&pi[pino])) {
 776                         if ((cp->layer==0) || (cp->layer>=((pi[pino].layno)+1))) {
 777                                 opj_packet_info_t *pack_info;
 778                                 if (cstr_info)
 779                                         pack_info = &cstr_info->tile[tileno].packet[cstr_info->packno];
 780                                 else
 781                                         pack_info = NULL;
 782                                 e = t2_decode_packet(t2, c, src + len - c, tile, &cp->tcps[tileno], &pi[pino], pack_info);
 783                         } else {
 784                                 e = 0;
 785                         }
 786                         if(e == -999) return -999;
 787                         /* progression in resolution */
 788                         image->comps[pi[pino].compno].resno_decoded =
 789                                 (e > 0) ?
 790                                 int_max(pi[pino].resno, image->comps[pi[pino].compno].resno_decoded)
 791                                 : image->comps[pi[pino].compno].resno_decoded;
 792                         n++;
 793
 794                         /* INDEX >> */
 795                         if(cstr_info) {
 796                                 opj_tile_info_t *info_TL = &cstr_info->tile[tileno];
 797                                 opj_packet_info_t *info_PK = &info_TL->packet[cstr_info->packno];
 798                                 if (!cstr_info->packno) {
 799                                         info_PK->start_pos = info_TL->end_header + 1;
 800                                 } else if (info_TL->packet[cstr_info->packno-1].end_pos >= (int)cstr_info->tile[tileno].tp[curtp].tp_end_pos){ // New tile part
 801                                         info_TL->tp[curtp].tp_numpacks = cstr_info->packno - tp_start_packno; // Number of packets in previous tile-part
 802           info_TL->tp[curtp].tp_start_pack = tp_start_packno;
 803                                         tp_start_packno = cstr_info->packno;
 804                                         curtp++;
 805                                         info_PK->start_pos = cstr_info->tile[tileno].tp[curtp].tp_end_header+1;
 806                                 } else {
 807                                         info_PK->start_pos = (cp->tp_on && info_PK->start_pos) ? info_PK->start_pos : info_TL->packet[cstr_info->packno - 1].end_pos + 1;
 808                                 }
 809                                 info_PK->end_pos = info_PK->start_pos + e - 1;
 810                                 info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance
 811                                                                                                                                                                                                                                 // to start of packet is incremented by value of start of packet
 812                                 cstr_info->packno++;
 813                         }
 814                         /* << INDEX */
 815
 816                         if (e == -999) {                /* ADD */
 817                                 break;
 818                         } else {
 819                                 c += e;
 820                         }
 821                 }
 822         }
 823         /* INDEX >> */
 824         if(cstr_info) {
 825                 cstr_info->tile[tileno].tp[curtp].tp_numpacks = cstr_info->packno - tp_start_packno; // Number of packets in last tile-part
 826     cstr_info->tile[tileno].tp[curtp].tp_start_pack = tp_start_packno;
 827         }
 828         /* << INDEX */
 829
 830         /* don't forget to release pi */
 831         pi_destroy(pi, cp, tileno);
 832
 833         if (e == -999) {
 834                 return e;
 835         }
 836
 837         return (c - src);
 838 }
 839
 840 opj_bool t2_decode_packets_v2(
 841                                                 opj_t2_v2_t *p_t2,
 842                                                 OPJ_UINT32 p_tile_no,
 843                                                 struct opj_tcd_tile_v2 *p_tile,
 844                                                 OPJ_BYTE *p_src,
 845                                                 OPJ_UINT32 * p_data_read,
 846                                                 OPJ_UINT32 p_max_len,
 847                                                 struct opj_codestream_info_v2 *p_cstr_info)
 848 {
 849         OPJ_BYTE *l_current_data = p_src;
 850         opj_pi_iterator_t *l_pi = 00;
 851         OPJ_UINT32 pino;
 852         opj_image_header_t *l_image = p_t2->image;
 853         opj_cp_v2_t *l_cp = p_t2->cp;
 854         opj_cp_v2_t *cp = p_t2->cp;
 855         opj_tcp_v2_t *l_tcp = &(p_t2->cp->tcps[p_tile_no]);
 856         OPJ_UINT32 l_nb_bytes_read;
 857         OPJ_UINT32 l_nb_pocs = l_tcp->numpocs + 1;
 858         opj_pi_iterator_t *l_current_pi = 00;
 859         OPJ_UINT32 curtp = 0;
 860         OPJ_UINT32 tp_start_packno;
 861         opj_packet_info_t *l_pack_info = 00;
 862         opj_image_comp_header_t* l_img_comp = 00;
 863
 864
 865         if (p_cstr_info) {
 866                 l_pack_info = p_cstr_info->tile[p_tile_no].packet;
 867         }
 868
 869         /* create a packet iterator */
 870         l_pi = pi_create_decode_v2(l_image, l_cp, p_tile_no);
 871         if (!l_pi) {
 872                 return OPJ_FALSE;
 873         }
 874
 875         tp_start_packno = 0;
 876         l_current_pi = l_pi;
 877
 878         for     (pino = 0; pino <= l_tcp->numpocs; ++pino) {
 879
 880                 while (pi_next(l_current_pi)) {
 881
 882                         if (l_tcp->num_layers_to_decode > l_current_pi->layno
 883                                         && l_current_pi->resno < p_tile->comps[l_current_pi->compno].minimum_num_resolutions) {
 884                                 l_nb_bytes_read = 0;
 885
 886                                 if (! t2_decode_packet_v2(p_t2,p_tile,l_tcp,l_current_pi,l_current_data,&l_nb_bytes_read,p_max_len,l_pack_info)) {
 887                                         pi_destroy_v2(l_pi,l_nb_pocs);
 888                                         return OPJ_FALSE;
 889                                 }
 890
 891                                 l_img_comp = &(l_image->comps[l_current_pi->compno]);
 892                                 l_img_comp->resno_decoded = uint_max(l_current_pi->resno, l_img_comp->resno_decoded);
 893                         }
 894                         else {
 895                                 l_nb_bytes_read = 0;
 896                                 if (! t2_skip_packet(p_t2,p_tile,l_tcp,l_current_pi,l_current_data,&l_nb_bytes_read,p_max_len,l_pack_info)) {
 897                                         pi_destroy_v2(l_pi,l_nb_pocs);
 898                                         return OPJ_FALSE;
 899                                 }
 900                         }
 901
 902                         l_current_data += l_nb_bytes_read;
 903                         p_max_len -= l_nb_bytes_read;
 904
 905                         /* INDEX >> */
 906 #ifdef TODO_MSD
 907                         if(p_cstr_info) {
 908                                 opj_tile_info_v2_t *info_TL = &p_cstr_info->tile[p_tile_no];
 909                                 opj_packet_info_t *info_PK = &info_TL->packet[p_cstr_info->packno];
 910                                 if (!p_cstr_info->packno) {
 911                                         info_PK->start_pos = info_TL->end_header + 1;
 912                                 } else if (info_TL->packet[p_cstr_info->packno-1].end_pos >= (OPJ_INT32)p_cstr_info->tile[p_tile_no].tp[curtp].tp_end_pos){ // New tile part
 913                                         info_TL->tp[curtp].tp_numpacks = p_cstr_info->packno - tp_start_packno; // Number of packets in previous tile-part
 914                                         tp_start_packno = p_cstr_info->packno;
 915                                         curtp++;
 916                                         info_PK->start_pos = p_cstr_info->tile[p_tile_no].tp[curtp].tp_end_header+1;
 917                                 } else {
 918                                         info_PK->start_pos = (cp->m_specific_param.m_enc.m_tp_on && info_PK->start_pos) ? info_PK->start_pos : info_TL->packet[p_cstr_info->packno - 1].end_pos + 1;
 919                                 }
 920                                 info_PK->end_pos = info_PK->start_pos + l_nb_bytes_read - 1;
 921                                 info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance
 922                                 ++p_cstr_info->packno;
 923                         }
 924 #endif
 925                         /* << INDEX */
 926                 }
 927                 ++l_current_pi;
 928         }
 929         /* INDEX >> */
 930 #ifdef TODO_MSD
 931         if
 932                 (p_cstr_info) {
 933                 p_cstr_info->tile[p_tile_no].tp[curtp].tp_numpacks = p_cstr_info->packno - tp_start_packno; // Number of packets in last tile-part
 934         }
 935 #endif
 936         /* << INDEX */
 937
 938         /* don't forget to release pi */
 939         pi_destroy_v2(l_pi,l_nb_pocs);
 940         *p_data_read = l_current_data - p_src;
 941         return OPJ_TRUE;
 942 }
 943
 944 /* ----------------------------------------------------------------------- */
 945
 946 opj_t2_t* t2_create(opj_common_ptr cinfo, opj_image_t *image, opj_cp_t *cp) {
 947         /* create the tcd structure */
 948         opj_t2_t *t2 = (opj_t2_t*)opj_malloc(sizeof(opj_t2_t));
 949         if(!t2) return NULL;
 950         t2->cinfo = cinfo;
 951         t2->image = image;
 952         t2->cp = cp;
 953
 954         return t2;
 955 }
 956
 957 /**
 958  * Creates a Tier 2 handle
 959  *
 960  * @param       p_image         Source or destination image
 961  * @param       p_cp            Image coding parameters.
 962  * @return              a new T2 handle if successful, NULL otherwise.
 963 */
 964 opj_t2_v2_t* t2_create_v2(
 965                                         opj_image_header_t *p_image,
 966                                         opj_cp_v2_t *p_cp)
 967 {
 968         /* create the tcd structure */
 969         opj_t2_v2_t *l_t2 = (opj_t2_v2_t*)opj_malloc(sizeof(opj_t2_v2_t));
 970         if
 971                 (!l_t2)
 972         {
 973                 return 00;
 974         }
 975         memset(l_t2,0,sizeof(opj_t2_t));
 976         l_t2->image = p_image;
 977         l_t2->cp = p_cp;
 978         return l_t2;
 979 }
 980
 981 void t2_destroy(opj_t2_t *t2) {
 982         if(t2) {
 983                 opj_free(t2);
 984         }
 985 }
 986
 987 void t2_destroy_v2(opj_t2_v2_t *t2) {
 988         if(t2) {
 989                 opj_free(t2);
 990         }
 991 }
 992
 993
 994 static opj_bool t2_decode_packet_v2(
 995                                                          opj_t2_v2_t* p_t2,
 996                                                          opj_tcd_tile_v2_t *p_tile,
 997                              opj_tcp_v2_t *p_tcp,
 998                                                          opj_pi_iterator_t *p_pi,
 999                                                          OPJ_BYTE *p_src,
1000                                                          OPJ_UINT32 * p_data_read,
1001                                                          OPJ_UINT32 p_max_length,
1002                                                          opj_packet_info_t *p_pack_info)
1003 {
1004         opj_bool l_read_data;
1005         OPJ_UINT32 l_nb_bytes_read = 0;
1006         OPJ_UINT32 l_nb_total_bytes_read = 0;
1007
1008         *p_data_read = 0;
1009
1010         if (! t2_read_packet_header(p_t2,p_tile,p_tcp,p_pi,&l_read_data,p_src,&l_nb_bytes_read,p_max_length,p_pack_info)) {
1011                 return OPJ_FALSE;
1012         }
1013
1014         p_src += l_nb_bytes_read;
1015         l_nb_total_bytes_read += l_nb_bytes_read;
1016         p_max_length -= l_nb_bytes_read;
1017
1018         /* we should read data for the packet */
1019         if (l_read_data) {
1020                 l_nb_bytes_read = 0;
1021
1022                 if (! t2_read_packet_data(p_t2,p_tile,p_pi,p_src,&l_nb_bytes_read,p_max_length,p_pack_info)) {
1023                         return OPJ_FALSE;
1024                 }
1025
1026                 l_nb_total_bytes_read += l_nb_bytes_read;
1027         }
1028
1029         *p_data_read = l_nb_total_bytes_read;
1030
1031         return OPJ_TRUE;
1032 }
1033
1034 static opj_bool t2_skip_packet(
1035                                                          opj_t2_v2_t* p_t2,
1036                                                          opj_tcd_tile_v2_t *p_tile,
1037                              opj_tcp_v2_t *p_tcp,
1038                                                          opj_pi_iterator_t *p_pi,
1039                                                          OPJ_BYTE *p_src,
1040                                                          OPJ_UINT32 * p_data_read,
1041                                                          OPJ_UINT32 p_max_length,
1042                                                          opj_packet_info_t *p_pack_info)
1043 {
1044         opj_bool l_read_data;
1045         OPJ_UINT32 l_nb_bytes_read = 0;
1046         OPJ_UINT32 l_nb_total_bytes_read = 0;
1047
1048         *p_data_read = 0;
1049
1050         if (! t2_read_packet_header(p_t2,p_tile,p_tcp,p_pi,&l_read_data,p_src,&l_nb_bytes_read,p_max_length,p_pack_info)) {
1051                 return OPJ_FALSE;
1052         }
1053
1054         p_src += l_nb_bytes_read;
1055         l_nb_total_bytes_read += l_nb_bytes_read;
1056         p_max_length -= l_nb_bytes_read;
1057
1058         /* we should read data for the packet */
1059         if (l_read_data) {
1060                 l_nb_bytes_read = 0;
1061
1062                 if (! t2_skip_packet_data(p_t2,p_tile,p_pi,&l_nb_bytes_read,p_max_length,p_pack_info)) {
1063                         return OPJ_FALSE;
1064                 }
1065
1066                 l_nb_total_bytes_read += l_nb_bytes_read;
1067         }
1068         *p_data_read = l_nb_total_bytes_read;
1069
1070         return OPJ_TRUE;
1071 }
1072
1073
1074
1075 static opj_bool t2_read_packet_header(
1076                                                          opj_t2_v2_t* p_t2,
1077                                                          opj_tcd_tile_v2_t *p_tile,
1078                              opj_tcp_v2_t *p_tcp,
1079                                                          opj_pi_iterator_t *p_pi,
1080                                                          opj_bool * p_is_data_present,
1081                                                          OPJ_BYTE *p_src_data,
1082                                                          OPJ_UINT32 * p_data_read,
1083                                                          OPJ_UINT32 p_max_length,
1084                                                          opj_packet_info_t *p_pack_info)
1085 {
1086         /* loop */
1087         OPJ_UINT32 bandno, cblkno;
1088         OPJ_UINT32 l_nb_code_blocks;
1089         OPJ_UINT32 l_remaining_length;
1090         OPJ_UINT32 l_header_length;
1091         OPJ_UINT32 * l_modified_length_ptr = 00;
1092         OPJ_BYTE *l_current_data = p_src_data;
1093         opj_cp_v2_t *l_cp = p_t2->cp;
1094         opj_bio_t *l_bio = 00;  /* BIO component */
1095         opj_tcd_band_v2_t *l_band = 00;
1096         opj_tcd_cblk_dec_v2_t* l_cblk = 00;
1097         opj_tcd_resolution_v2_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
1098
1099         OPJ_BYTE *l_header_data = 00;
1100         OPJ_BYTE **l_header_data_start = 00;
1101
1102         OPJ_UINT32 l_present;
1103
1104         if (p_pi->layno == 0) {
1105                 l_band = l_res->bands;
1106
1107                 /* reset tagtrees */
1108                 for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1109                         opj_tcd_precinct_v2_t *l_prc = &l_band->precincts[p_pi->precno];
1110
1111                         if ( ! ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) ) {
1112                                 tgt_reset(l_prc->incltree);
1113                                 tgt_reset(l_prc->imsbtree);
1114                                 l_cblk = l_prc->cblks.dec;
1115
1116                                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1117                                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
1118                                         l_cblk->numsegs = 0;
1119                                         l_cblk->real_num_segs = 0;
1120                                         ++l_cblk;
1121                                 }
1122                         }
1123
1124                         ++l_band;
1125                 }
1126         }
1127
1128         /* SOP markers */
1129
1130         if (p_tcp->csty & J2K_CP_CSTY_SOP) {
1131                 if ((*l_current_data) != 0xff || (*(l_current_data + 1) != 0x91)) {
1132                         // TODO opj_event_msg(t2->cinfo->event_mgr, EVT_WARNING, "Expected SOP marker\n");
1133                 } else {
1134                         l_current_data += 6;
1135                 }
1136
1137                 /** TODO : check the Nsop value */
1138         }
1139
1140         /*
1141         When the marker PPT/PPM is used the packet header are store in PPT/PPM marker
1142         This part deal with this caracteristic
1143         step 1: Read packet header in the saved structure
1144         step 2: Return to codestream for decoding
1145         */
1146
1147         l_bio = bio_create();
1148         if (! l_bio) {
1149                 return OPJ_FALSE;
1150         }
1151
1152         if (l_cp->ppm == 1) { /* PPM */
1153                 l_header_data_start = &l_cp->ppm_data;
1154                 l_header_data = *l_header_data_start;
1155                 l_modified_length_ptr = &(l_cp->ppm_len);
1156
1157         }
1158         else if (p_tcp->ppt == 1) { /* PPT */
1159                 l_header_data_start = &(p_tcp->ppt_data);
1160                 l_header_data = *l_header_data_start;
1161                 l_modified_length_ptr = &(p_tcp->ppt_len);
1162         }
1163         else {  /* Normal Case */
1164                 l_header_data_start = &(l_current_data);
1165                 l_header_data = *l_header_data_start;
1166                 l_remaining_length = p_src_data+p_max_length-l_header_data;
1167                 l_modified_length_ptr = &(l_remaining_length);
1168         }
1169
1170         bio_init_dec(l_bio, l_header_data,*l_modified_length_ptr);
1171
1172         l_present = bio_read(l_bio, 1);
1173         if (!l_present) {
1174                 bio_inalign(l_bio);
1175                 l_header_data += bio_numbytes(l_bio);
1176                 bio_destroy(l_bio);
1177
1178                 /* EPH markers */
1179                 if (p_tcp->csty & J2K_CP_CSTY_EPH) {
1180                         if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
1181                                 printf("Error : expected EPH marker\n");
1182                         } else {
1183                                 l_header_data += 2;
1184                         }
1185                 }
1186
1187                 l_header_length = (l_header_data - *l_header_data_start);
1188                 *l_modified_length_ptr -= l_header_length;
1189                 *l_header_data_start += l_header_length;
1190
1191                 /* << INDEX */
1192                 // End of packet header position. Currently only represents the distance to start of packet
1193                 // Will be updated later by incrementing with packet start value
1194                 if (p_pack_info) {
1195                         p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
1196                 }
1197                 /* INDEX >> */
1198
1199                 * p_is_data_present = OPJ_FALSE;
1200                 *p_data_read = l_current_data - p_src_data;
1201                 return OPJ_TRUE;
1202         }
1203
1204         l_band = l_res->bands;
1205         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1206                 opj_tcd_precinct_v2_t *l_prc = &(l_band->precincts[p_pi->precno]);
1207
1208                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
1209                         ++l_band;
1210                         continue;
1211                 }
1212
1213                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1214                 l_cblk = l_prc->cblks.dec;
1215                 for (cblkno = 0; cblkno < l_nb_code_blocks; cblkno++) {
1216                         OPJ_UINT32 l_included,l_increment, l_segno;
1217                         OPJ_INT32 n;
1218
1219                         /* if cblk not yet included before --> inclusion tagtree */
1220                         if (!l_cblk->numsegs) {
1221                                 l_included = tgt_decode(l_bio, l_prc->incltree, cblkno, p_pi->layno + 1);
1222                                 /* else one bit */
1223                         }
1224                         else {
1225                                 l_included = bio_read(l_bio, 1);
1226                         }
1227
1228                         /* if cblk not included */
1229                         if (!l_included) {
1230                                 l_cblk->numnewpasses = 0;
1231                                 ++l_cblk;
1232                                 continue;
1233                         }
1234
1235                         /* if cblk not yet included --> zero-bitplane tagtree */
1236                         if (!l_cblk->numsegs) {
1237                                 OPJ_UINT32 i = 0;
1238
1239                                 while (!tgt_decode(l_bio, l_prc->imsbtree, cblkno, i)) {
1240                                         ++i;
1241                                 }
1242
1243                                 l_cblk->numbps = l_band->numbps + 1 - i;
1244                                 l_cblk->numlenbits = 3;
1245                         }
1246
1247                         /* number of coding passes */
1248                         l_cblk->numnewpasses = t2_getnumpasses(l_bio);
1249                         l_increment = t2_getcommacode(l_bio);
1250
1251                         /* length indicator increment */
1252                         l_cblk->numlenbits += l_increment;
1253                         l_segno = 0;
1254
1255                         if (!l_cblk->numsegs) {
1256                                 if (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 1)) {
1257                                         bio_destroy(l_bio);
1258                                         return OPJ_FALSE;
1259                                 }
1260                         }
1261                         else {
1262                                 l_segno = l_cblk->numsegs - 1;
1263                                 if (l_cblk->segs[l_segno].numpasses == l_cblk->segs[l_segno].maxpasses) {
1264                                         ++l_segno;
1265                                         if (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0)) {
1266                                                 bio_destroy(l_bio);
1267                                                 return OPJ_FALSE;
1268                                         }
1269                                 }
1270                         }
1271                         n = l_cblk->numnewpasses;
1272
1273                         do {
1274                                 l_cblk->segs[l_segno].numnewpasses = int_min(l_cblk->segs[l_segno].maxpasses - l_cblk->segs[l_segno].numpasses, n);
1275                                 l_cblk->segs[l_segno].newlen = bio_read(l_bio, l_cblk->numlenbits + uint_floorlog2(l_cblk->segs[l_segno].numnewpasses));
1276
1277                                 n -= l_cblk->segs[l_segno].numnewpasses;
1278                                 if (n > 0) {
1279                                         ++l_segno;
1280
1281                                         if (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0)) {
1282                                                 bio_destroy(l_bio);
1283                                                 return OPJ_FALSE;
1284                                         }
1285                                 }
1286                         } while (n > 0);
1287
1288                         ++l_cblk;
1289                 }
1290
1291                 ++l_band;
1292         }
1293
1294         if (bio_inalign(l_bio)) {
1295                 bio_destroy(l_bio);
1296                 return OPJ_FALSE;
1297         }
1298
1299         l_header_data += bio_numbytes(l_bio);
1300         bio_destroy(l_bio);
1301
1302         /* EPH markers */
1303         if (p_tcp->csty & J2K_CP_CSTY_EPH) {
1304                 if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
1305                         // TODO opj_event_msg(t2->cinfo->event_mgr, EVT_ERROR, "Expected EPH marker\n");
1306                 } else {
1307                         l_header_data += 2;
1308                 }
1309         }
1310
1311         l_header_length = (l_header_data - *l_header_data_start);
1312         *l_modified_length_ptr -= l_header_length;
1313         *l_header_data_start += l_header_length;
1314
1315         /* << INDEX */
1316         // End of packet header position. Currently only represents the distance to start of packet
1317         // Will be updated later by incrementing with packet start value
1318         if (p_pack_info) {
1319                 p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
1320         }
1321         /* INDEX >> */
1322
1323         *p_is_data_present = OPJ_TRUE;
1324         *p_data_read = l_current_data - p_src_data;
1325
1326         return OPJ_TRUE;
1327 }
1328
1329 static opj_bool t2_read_packet_data(
1330                                                          opj_t2_v2_t* p_t2,
1331                                                          opj_tcd_tile_v2_t *p_tile,
1332                                                          opj_pi_iterator_t *p_pi,
1333                                                          OPJ_BYTE *p_src_data,
1334                                                          OPJ_UINT32 * p_data_read,
1335                                                          OPJ_UINT32 p_max_length,
1336                                                          opj_packet_info_t *pack_info)
1337 {
1338         OPJ_UINT32 bandno, cblkno;
1339         OPJ_UINT32 l_nb_code_blocks;
1340         OPJ_BYTE *l_current_data = p_src_data;
1341         opj_tcd_band_v2_t *l_band = 00;
1342         opj_tcd_cblk_dec_v2_t* l_cblk = 00;
1343         opj_tcd_resolution_v2_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
1344
1345         l_band = l_res->bands;
1346         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1347                 opj_tcd_precinct_v2_t *l_prc = &l_band->precincts[p_pi->precno];
1348
1349                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
1350                         ++l_band;
1351                         continue;
1352                 }
1353
1354                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1355                 l_cblk = l_prc->cblks.dec;
1356
1357                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
1358                         opj_tcd_seg_t *l_seg = 00;
1359
1360                         if (!l_cblk->numnewpasses) {
1361                                 /* nothing to do */
1362                                 ++l_cblk;
1363                                 continue;
1364                         }
1365
1366                         if (!l_cblk->numsegs) {
1367                                 l_seg = l_cblk->segs;
1368                                 ++l_cblk->numsegs;
1369                                 l_cblk->len = 0;
1370                         }
1371                         else {
1372                                 l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
1373
1374                                 if (l_seg->numpasses == l_seg->maxpasses) {
1375                                         ++l_seg;
1376                                         ++l_cblk->numsegs;
1377                                 }
1378                         }
1379
1380                         do {
1381                                 if (l_current_data + l_seg->newlen > p_src_data + p_max_length) {
1382                                         return OPJ_FALSE;
1383                                 }
1384
1385 #ifdef USE_JPWL
1386                         /* we need here a j2k handle to verify if making a check to
1387                         the validity of cblocks parameters is selected from user (-W) */
1388
1389                                 /* let's check that we are not exceeding */
1390                                 if ((l_cblk->len + l_seg->newlen) > 8192) {
1391                                         opj_event_msg(p_t2->cinfo, EVT_WARNING,
1392                                                 "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1393                                                 l_seg->newlen, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1394                                         if (!JPWL_ASSUME) {
1395                                                 opj_event_msg(p_t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
1396                                                 return OPJ_FALSE;
1397                                         }
1398                                         l_seg->newlen = 8192 - l_cblk->len;
1399                                         opj_event_msg(p_t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", l_seg->newlen);
1400                                         break;
1401                                 };
1402
1403 #endif /* USE_JPWL */
1404
1405                                 memcpy(l_cblk->data + l_cblk->len, l_current_data, l_seg->newlen);
1406
1407                                 if (l_seg->numpasses == 0) {
1408                                         l_seg->data = &l_cblk->data;
1409                                         l_seg->dataindex = l_cblk->len;
1410                                 }
1411
1412                                 l_current_data += l_seg->newlen;
1413                                 l_seg->numpasses += l_seg->numnewpasses;
1414                                 l_cblk->numnewpasses -= l_seg->numnewpasses;
1415
1416                                 l_seg->real_num_passes = l_seg->numpasses;
1417                                 l_cblk->len += l_seg->newlen;
1418                                 l_seg->len += l_seg->newlen;
1419
1420                                 if (l_cblk->numnewpasses > 0) {
1421                                         ++l_seg;
1422                                         ++l_cblk->numsegs;
1423                                 }
1424                         } while (l_cblk->numnewpasses > 0);
1425
1426                         l_cblk->real_num_segs = l_cblk->numsegs;
1427                         ++l_cblk;
1428                 }
1429
1430                 ++l_band;
1431         }
1432
1433         *(p_data_read) = l_current_data - p_src_data;
1434
1435         return OPJ_TRUE;
1436 }
1437
1438 static opj_bool t2_skip_packet_data(
1439                                                          opj_t2_v2_t* p_t2,
1440                                                          opj_tcd_tile_v2_t *p_tile,
1441                                                          opj_pi_iterator_t *p_pi,
1442                                                          OPJ_UINT32 * p_data_read,
1443                                                          OPJ_UINT32 p_max_length,
1444                                                          opj_packet_info_t *pack_info)
1445 {
1446         OPJ_UINT32 bandno, cblkno;
1447         OPJ_UINT32 l_nb_code_blocks;
1448         opj_tcd_band_v2_t *l_band = 00;
1449         opj_tcd_cblk_dec_v2_t* l_cblk = 00;
1450         opj_tcd_resolution_v2_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
1451
1452         *p_data_read = 0;
1453         l_band = l_res->bands;
1454
1455         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1456                 opj_tcd_precinct_v2_t *l_prc = &l_band->precincts[p_pi->precno];
1457
1458                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
1459                         ++l_band;
1460                         continue;
1461                 }
1462
1463                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1464                 l_cblk = l_prc->cblks.dec;
1465
1466                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
1467                         opj_tcd_seg_t *l_seg = 00;
1468
1469                         if (!l_cblk->numnewpasses) {
1470                                 /* nothing to do */
1471                                 ++l_cblk;
1472                                 continue;
1473                         }
1474
1475                         if (!l_cblk->numsegs) {
1476                                 l_seg = l_cblk->segs;
1477                                 ++l_cblk->numsegs;
1478                                 l_cblk->len = 0;
1479                         }
1480                         else {
1481                                 l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
1482
1483                                 if (l_seg->numpasses == l_seg->maxpasses) {
1484                                         ++l_seg;
1485                                         ++l_cblk->numsegs;
1486                                 }
1487                         }
1488
1489                         do {
1490                                 if (* p_data_read + l_seg->newlen > p_max_length) {
1491                                         return OPJ_FALSE;
1492                                 }
1493
1494 #ifdef USE_JPWL
1495                         /* we need here a j2k handle to verify if making a check to
1496                         the validity of cblocks parameters is selected from user (-W) */
1497
1498                                 /* let's check that we are not exceeding */
1499                                 if ((l_cblk->len + l_seg->newlen) > 8192) {
1500                                         opj_event_msg(p_t2->cinfo, EVT_WARNING,
1501                                                 "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1502                                                 l_seg->newlen, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1503                                         if (!JPWL_ASSUME) {
1504                                                 opj_event_msg(p_t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
1505                                                 return -999;
1506                                         }
1507                                         l_seg->newlen = 8192 - l_cblk->len;
1508                                         opj_event_msg(p_t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", l_seg->newlen);
1509                                         break;
1510                                 };
1511
1512 #endif /* USE_JPWL */
1513                                 *(p_data_read) += l_seg->newlen;
1514
1515                                 l_seg->numpasses += l_seg->numnewpasses;
1516                                 l_cblk->numnewpasses -= l_seg->numnewpasses;
1517                                 if (l_cblk->numnewpasses > 0)
1518                                 {
1519                                         ++l_seg;
1520                                         ++l_cblk->numsegs;
1521                                 }
1522                         } while (l_cblk->numnewpasses > 0);
1523
1524                         ++l_cblk;
1525                 }
1526
1527                 ++l_band;
1528         }
1529
1530         return OPJ_TRUE;
1531 }
1532
1533
1534 static opj_bool t2_init_seg_v2(opj_tcd_cblk_dec_v2_t* cblk, OPJ_UINT32 index, OPJ_UINT32 cblksty, OPJ_UINT32 first)
1535 {
1536         opj_tcd_seg_t* seg = 00;
1537         OPJ_UINT32 l_nb_segs = index + 1;
1538
1539         if (l_nb_segs > cblk->m_current_max_segs) {
1540                 cblk->m_current_max_segs += J2K_DEFAULT_NB_SEGS;
1541
1542                 cblk->segs = (opj_tcd_seg_t*) opj_realloc(cblk->segs, cblk->m_current_max_segs * sizeof(opj_tcd_seg_t));
1543                 if(! cblk->segs) {
1544                         return OPJ_FALSE;
1545                 }
1546         }
1547
1548         seg = &cblk->segs[index];
1549         memset(seg,0,sizeof(opj_tcd_seg_t));
1550
1551         if (cblksty & J2K_CCP_CBLKSTY_TERMALL) {
1552                 seg->maxpasses = 1;
1553         }
1554         else if (cblksty & J2K_CCP_CBLKSTY_LAZY) {
1555                 if (first) {
1556                         seg->maxpasses = 10;
1557                 } else {
1558                         seg->maxpasses = (((seg - 1)->maxpasses == 1) || ((seg - 1)->maxpasses == 10)) ? 2 : 1;
1559                 }
1560         } else {
1561                 seg->maxpasses = 109;
1562         }
1563
1564         return OPJ_TRUE;
1565 }