src/lib/openjp2/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  * Copyright (c) 2008;2011-2012, Centre National d'Etudes Spatiales (CNES), France
   9  * Copyright (c) 2012, CS Systemes d'Information, France
  10  * All rights reserved.
  11  *
  12  * Redistribution and use in source and binary forms, with or without
  13  * modification, are permitted provided that the following conditions
  14  * are met:
  15  * 1. Redistributions of source code must retain the above copyright
  16  *    notice, this list of conditions and the following disclaimer.
  17  * 2. Redistributions in binary form must reproduce the above copyright
  18  *    notice, this list of conditions and the following disclaimer in the
  19  *    documentation and/or other materials provided with the distribution.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
  22  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  25  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  26  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  27  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  28  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  29  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  30  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  31  * POSSIBILITY OF SUCH DAMAGE.
  32  */
  33
  34 #include "opj_includes.h"
  35
  36 /** @defgroup T2 T2 - Implementation of a tier-2 coding */
  37 /*@{*/
  38
  39 /** @name Local static functions */
  40 /*@{*/
  41
  42 static void opj_t2_putcommacode(opj_bio_t *bio, OPJ_INT32 n);
  43
  44 static OPJ_UINT32 opj_t2_getcommacode(opj_bio_t *bio);
  45 /**
  46 Variable length code for signalling delta Zil (truncation point)
  47 @param bio  Bit Input/Output component
  48 @param n    delta Zil
  49 */
  50 static void opj_t2_putnumpasses(opj_bio_t *bio, OPJ_UINT32 n);
  51 static OPJ_UINT32 opj_t2_getnumpasses(opj_bio_t *bio);
  52
  53 /**
  54 Encode a packet of a tile to a destination buffer
  55 @param tileno Number of the tile encoded
  56 @param tile Tile for which to write the packets
  57 @param tcp Tile coding parameters
  58 @param pi Packet identity
  59 @param dest Destination buffer
  60 @param p_data_written   FIXME DOC
  61 @param len Length of the destination buffer
  62 @param cstr_info Codestream information structure
  63 @return
  64 */
  65 static OPJ_BOOL opj_t2_encode_packet(   OPJ_UINT32 tileno,
  66                                         opj_tcd_tile_t *tile,
  67                                         opj_tcp_t *tcp,
  68                                         opj_pi_iterator_t *pi,
  69                                         OPJ_BYTE *dest,
  70                                         OPJ_UINT32 * p_data_written,
  71                                         OPJ_UINT32 len,
  72                                         opj_codestream_info_t *cstr_info);
  73
  74 /**
  75 Decode a packet of a tile from a source buffer
  76 @param t2 T2 handle
  77 @param tile Tile for which to write the packets
  78 @param tcp Tile coding parameters
  79 @param pi Packet identity
  80 @param src Source buffer
  81 @param data_read   FIXME DOC
  82 @param max_length  FIXME DOC
  83 @param pack_info Packet information
  84
  85 @return  FIXME DOC
  86 */
  87 static OPJ_BOOL opj_t2_decode_packet(   opj_t2_t* t2,
  88                                         opj_tcd_tile_t *tile,
  89                                         opj_tcp_t *tcp,
  90                                         opj_pi_iterator_t *pi,
  91                                         OPJ_BYTE *src,
  92                                         OPJ_UINT32 * data_read,
  93                                         OPJ_UINT32 max_length,
  94                                         opj_packet_info_t *pack_info);
  95
  96 static OPJ_BOOL opj_t2_skip_packet( opj_t2_t* p_t2,
  97                                     opj_tcd_tile_t *p_tile,
  98                                     opj_tcp_t *p_tcp,
  99                                     opj_pi_iterator_t *p_pi,
 100                                     OPJ_BYTE *p_src,
 101                                     OPJ_UINT32 * p_data_read,
 102                                     OPJ_UINT32 p_max_length,
 103                                     opj_packet_info_t *p_pack_info);
 104
 105 static OPJ_BOOL opj_t2_read_packet_header(  opj_t2_t* p_t2,
 106                                             opj_tcd_tile_t *p_tile,
 107                                             opj_tcp_t *p_tcp,
 108                                             opj_pi_iterator_t *p_pi,
 109                                             OPJ_BOOL * p_is_data_present,
 110                                             OPJ_BYTE *p_src_data,
 111                                             OPJ_UINT32 * p_data_read,
 112                                             OPJ_UINT32 p_max_length,
 113                                             opj_packet_info_t *p_pack_info);
 114
 115 static OPJ_BOOL opj_t2_read_packet_data(opj_t2_t* p_t2,
 116                                         opj_tcd_tile_t *p_tile,
 117                                         opj_pi_iterator_t *p_pi,
 118                                         OPJ_BYTE *p_src_data,
 119                                         OPJ_UINT32 * p_data_read,
 120                                         OPJ_UINT32 p_max_length,
 121                                         opj_packet_info_t *pack_info);
 122
 123 static OPJ_BOOL opj_t2_skip_packet_data(opj_t2_t* p_t2,
 124                                         opj_tcd_tile_t *p_tile,
 125                                         opj_pi_iterator_t *p_pi,
 126                                         OPJ_UINT32 * p_data_read,
 127                                         OPJ_UINT32 p_max_length,
 128                                         opj_packet_info_t *pack_info);
 129
 130 /**
 131 @param cblk
 132 @param index
 133 @param cblksty
 134 @param first
 135 */
 136 static OPJ_BOOL opj_t2_init_seg(    opj_tcd_cblk_dec_t* cblk,
 137                                     OPJ_UINT32 index,
 138                                     OPJ_UINT32 cblksty,
 139                                     OPJ_UINT32 first);
 140
 141 /*@}*/
 142
 143 /*@}*/
 144
 145 /* ----------------------------------------------------------------------- */
 146
 147 /* #define RESTART 0x04 */
 148 static void opj_t2_putcommacode(opj_bio_t *bio, OPJ_INT32 n) {
 149         while (--n >= 0) {
 150                 opj_bio_write(bio, 1, 1);
 151         }
 152         opj_bio_write(bio, 0, 1);
 153 }
 154
 155 OPJ_UINT32 opj_t2_getcommacode(opj_bio_t *bio)
 156 {
 157     OPJ_UINT32 n = 0;
 158     while (opj_bio_read(bio, 1)) {
 159             ++n;
 160     }
 161     return n;
 162 }
 163
 164 void opj_t2_putnumpasses(opj_bio_t *bio, OPJ_UINT32 n) {
 165         if (n == 1) {
 166                 opj_bio_write(bio, 0, 1);
 167         } else if (n == 2) {
 168                 opj_bio_write(bio, 2, 2);
 169         } else if (n <= 5) {
 170                 opj_bio_write(bio, 0xc | (n - 3), 4);
 171         } else if (n <= 36) {
 172                 opj_bio_write(bio, 0x1e0 | (n - 6), 9);
 173         } else if (n <= 164) {
 174                 opj_bio_write(bio, 0xff80 | (n - 37), 16);
 175         }
 176 }
 177
 178 OPJ_UINT32 opj_t2_getnumpasses(opj_bio_t *bio) {
 179         OPJ_UINT32 n;
 180         if (!opj_bio_read(bio, 1))
 181                 return 1;
 182         if (!opj_bio_read(bio, 1))
 183                 return 2;
 184         if ((n = opj_bio_read(bio, 2)) != 3)
 185                 return (3 + n);
 186         if ((n = opj_bio_read(bio, 5)) != 31)
 187                 return (6 + n);
 188         return (37 + opj_bio_read(bio, 7));
 189 }
 190
 191 /* ----------------------------------------------------------------------- */
 192
 193 OPJ_BOOL opj_t2_encode_packets( opj_t2_t* p_t2,
 194                                 OPJ_UINT32 p_tile_no,
 195                                 opj_tcd_tile_t *p_tile,
 196                                 OPJ_UINT32 p_maxlayers,
 197                                 OPJ_BYTE *p_dest,
 198                                 OPJ_UINT32 * p_data_written,
 199                                 OPJ_UINT32 p_max_len,
 200                                 opj_codestream_info_t *cstr_info,
 201                                 OPJ_UINT32 p_tp_num,
 202                                 OPJ_INT32 p_tp_pos,
 203                                 OPJ_UINT32 p_pino,
 204                                 J2K_T2_MODE p_t2_mode)
 205 {
 206         OPJ_BYTE *l_current_data = p_dest;
 207         OPJ_UINT32 l_nb_bytes = 0;
 208         OPJ_UINT32 compno;
 209         OPJ_UINT32 poc;
 210         opj_pi_iterator_t *l_pi = 00;
 211         opj_pi_iterator_t *l_current_pi = 00;
 212         opj_image_t *l_image = p_t2->image;
 213         opj_cp_t *l_cp = p_t2->cp;
 214         opj_tcp_t *l_tcp = &l_cp->tcps[p_tile_no];
 215         OPJ_UINT32 pocno = l_cp->m_specific_param.m_enc.m_cinema == OPJ_CINEMA4K_24? 2: 1;
 216         OPJ_UINT32 l_max_comp = l_cp->m_specific_param.m_enc.m_max_comp_size > 0 ? l_image->numcomps : 1;
 217         OPJ_UINT32 l_nb_pocs = l_tcp->numpocs + 1;
 218
 219         l_pi = opj_pi_initialise_encode(l_image, l_cp, p_tile_no, p_t2_mode);
 220         if (!l_pi) {
 221                 return OPJ_FALSE;
 222         }
 223
 224         * p_data_written = 0;
 225
 226         if (p_t2_mode == THRESH_CALC ){ /* Calculating threshold */
 227                 l_current_pi = l_pi;
 228
 229                 for     (compno = 0; compno < l_max_comp; ++compno) {
 230                         OPJ_UINT32 l_comp_len = 0;
 231                         l_current_pi = l_pi;
 232
 233                         for (poc = 0; poc < pocno ; ++poc) {
 234                                 OPJ_UINT32 l_tp_num = compno;
 235
 236                                 /* TODO MSD : check why this function cannot fail (cf. v1) */
 237                                 opj_pi_create_encode(l_pi, l_cp,p_tile_no,poc,l_tp_num,p_tp_pos,p_t2_mode);
 238
 239                                 while (opj_pi_next(l_current_pi)) {
 240                                         if (l_current_pi->layno < p_maxlayers) {
 241                                                 l_nb_bytes = 0;
 242
 243                                                 if (! opj_t2_encode_packet(p_tile_no,p_tile, l_tcp, l_current_pi, l_current_data, &l_nb_bytes, p_max_len, cstr_info)) {
 244                                                         opj_pi_destroy(l_pi, l_nb_pocs);
 245                                                         return OPJ_FALSE;
 246                                                 }
 247
 248                                                 l_comp_len += l_nb_bytes;
 249                                                 l_current_data += l_nb_bytes;
 250                                                 p_max_len -= l_nb_bytes;
 251
 252                                                 * p_data_written += l_nb_bytes;
 253                                         }
 254                                 }
 255
 256                                 if (l_cp->m_specific_param.m_enc.m_max_comp_size) {
 257                                         if (l_comp_len > l_cp->m_specific_param.m_enc.m_max_comp_size) {
 258                                                 opj_pi_destroy(l_pi, l_nb_pocs);
 259                                                 return OPJ_FALSE;
 260                                         }
 261                                 }
 262
 263                                 ++l_current_pi;
 264                         }
 265                 }
 266         }
 267         else {  /* t2_mode == FINAL_PASS  */
 268                 opj_pi_create_encode(l_pi, l_cp,p_tile_no,p_pino,p_tp_num,p_tp_pos,p_t2_mode);
 269
 270                 l_current_pi = &l_pi[p_pino];
 271
 272                 while (opj_pi_next(l_current_pi)) {
 273                         if (l_current_pi->layno < p_maxlayers) {
 274                                 l_nb_bytes=0;
 275
 276                                 if (! opj_t2_encode_packet(p_tile_no,p_tile, l_tcp, l_current_pi, l_current_data, &l_nb_bytes, p_max_len, cstr_info)) {
 277                                         opj_pi_destroy(l_pi, l_nb_pocs);
 278                                         return OPJ_FALSE;
 279                                 }
 280
 281                                 l_current_data += l_nb_bytes;
 282                                 p_max_len -= l_nb_bytes;
 283
 284                                 * p_data_written += l_nb_bytes;
 285
 286                                 /* INDEX >> */
 287                                 if(cstr_info) {
 288                                         if(cstr_info->index_write) {
 289                                                 opj_tile_info_t *info_TL = &cstr_info->tile[p_tile_no];
 290                                                 opj_packet_info_t *info_PK = &info_TL->packet[cstr_info->packno];
 291                                                 if (!cstr_info->packno) {
 292                                                         info_PK->start_pos = info_TL->end_header + 1;
 293                                                 } else {
 294                                                         info_PK->start_pos = ((l_cp->m_specific_param.m_enc.m_tp_on | l_tcp->POC)&& info_PK->start_pos) ? info_PK->start_pos : info_TL->packet[cstr_info->packno - 1].end_pos + 1;
 295                                                 }
 296                                                 info_PK->end_pos = info_PK->start_pos + l_nb_bytes - 1;
 297                                                 info_PK->end_ph_pos += info_PK->start_pos - 1;  /* End of packet header which now only represents the distance
 298                                                                                                                                                                                                                                                    to start of packet is incremented by value of start of packet*/
 299                                         }
 300
 301                                         cstr_info->packno++;
 302                                 }
 303                                 /* << INDEX */
 304                                 ++p_tile->packno;
 305                         }
 306                 }
 307         }
 308
 309         opj_pi_destroy(l_pi, l_nb_pocs);
 310
 311         return OPJ_TRUE;
 312 }
 313
 314 /* see issue 80 */
 315 #if 0
 316 #define JAS_FPRINTF fprintf
 317 #else
 318 #define JAS_FPRINTF
 319 #endif
 320
 321 OPJ_BOOL opj_t2_decode_packets( opj_t2_t *p_t2,
 322                                 OPJ_UINT32 p_tile_no,
 323                                 opj_tcd_tile_t *p_tile,
 324                                 OPJ_BYTE *p_src,
 325                                 OPJ_UINT32 * p_data_read,
 326                                 OPJ_UINT32 p_max_len,
 327                                 opj_codestream_index_t *p_cstr_index)
 328 {
 329         OPJ_BYTE *l_current_data = p_src;
 330         opj_pi_iterator_t *l_pi = 00;
 331         OPJ_UINT32 pino;
 332         opj_image_t *l_image = p_t2->image;
 333         opj_cp_t *l_cp = p_t2->cp;
 334         opj_tcp_t *l_tcp = &(p_t2->cp->tcps[p_tile_no]);
 335         OPJ_UINT32 l_nb_bytes_read;
 336         OPJ_UINT32 l_nb_pocs = l_tcp->numpocs + 1;
 337         opj_pi_iterator_t *l_current_pi = 00;
 338 #ifdef TODO_MSD
 339         OPJ_UINT32 curtp = 0;
 340         OPJ_UINT32 tp_start_packno;
 341 #endif
 342         opj_packet_info_t *l_pack_info = 00;
 343         opj_image_comp_t* l_img_comp = 00;
 344
 345         OPJ_ARG_NOT_USED(p_cstr_index);
 346
 347 #ifdef TODO_MSD
 348         if (p_cstr_index) {
 349                 l_pack_info = p_cstr_index->tile_index[p_tile_no].packet;
 350         }
 351 #endif
 352
 353         /* create a packet iterator */
 354         l_pi = opj_pi_create_decode(l_image, l_cp, p_tile_no);
 355         if (!l_pi) {
 356                 return OPJ_FALSE;
 357         }
 358
 359
 360         l_current_pi = l_pi;
 361
 362         for     (pino = 0; pino <= l_tcp->numpocs; ++pino) {
 363
 364                 /* if the resolution needed is too low, one dim of the tilec could be equal to zero
 365                  * and no packets are used to decode this resolution and
 366                  * l_current_pi->resno is always >= p_tile->comps[l_current_pi->compno].minimum_num_resolutions
 367                  * and no l_img_comp->resno_decoded are computed
 368                  */
 369                 OPJ_BOOL* first_pass_failed = (OPJ_BOOL*)opj_malloc(l_image->numcomps * sizeof(OPJ_BOOL));
 370                 if (!first_pass_failed)
 371                 {
 372                     opj_pi_destroy(l_pi,l_nb_pocs);
 373                     return OPJ_FALSE;
 374                 }
 375                 memset(first_pass_failed, OPJ_TRUE, l_image->numcomps * sizeof(OPJ_BOOL));
 376
 377                 while (opj_pi_next(l_current_pi)) {
 378                   JAS_FPRINTF( stderr, "packet offset=00000166 prg=%d cmptno=%02d rlvlno=%02d prcno=%03d lyrno=%02d\n\n",
 379                     l_current_pi->poc.prg1, l_current_pi->compno, l_current_pi->resno, l_current_pi->precno, l_current_pi->layno );
 380
 381                         if (l_tcp->num_layers_to_decode > l_current_pi->layno
 382                                         && l_current_pi->resno < p_tile->comps[l_current_pi->compno].minimum_num_resolutions) {
 383                                 l_nb_bytes_read = 0;
 384
 385                                 first_pass_failed[l_current_pi->compno] = OPJ_FALSE;
 386
 387                                 if (! opj_t2_decode_packet(p_t2,p_tile,l_tcp,l_current_pi,l_current_data,&l_nb_bytes_read,p_max_len,l_pack_info)) {
 388                                         opj_pi_destroy(l_pi,l_nb_pocs);
 389                                         opj_free(first_pass_failed);
 390                                         return OPJ_FALSE;
 391                                 }
 392
 393                                 l_img_comp = &(l_image->comps[l_current_pi->compno]);
 394                                 l_img_comp->resno_decoded = opj_uint_max(l_current_pi->resno, l_img_comp->resno_decoded);
 395                         }
 396                         else {
 397                                 l_nb_bytes_read = 0;
 398                                 if (! opj_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)) {
 399                                         opj_pi_destroy(l_pi,l_nb_pocs);
 400                                         opj_free(first_pass_failed);
 401                                         return OPJ_FALSE;
 402                                 }
 403                         }
 404
 405                         if (first_pass_failed[l_current_pi->compno]) {
 406                                 l_img_comp = &(l_image->comps[l_current_pi->compno]);
 407                                 if (l_img_comp->resno_decoded == 0)
 408                                         l_img_comp->resno_decoded = p_tile->comps[l_current_pi->compno].minimum_num_resolutions - 1;
 409                         }
 410
 411                         l_current_data += l_nb_bytes_read;
 412                         p_max_len -= l_nb_bytes_read;
 413
 414                         /* INDEX >> */
 415 #ifdef TODO_MSD
 416                         if(p_cstr_info) {
 417                                 opj_tile_info_v2_t *info_TL = &p_cstr_info->tile[p_tile_no];
 418                                 opj_packet_info_t *info_PK = &info_TL->packet[p_cstr_info->packno];
 419                                 tp_start_packno = 0;
 420                                 if (!p_cstr_info->packno) {
 421                                         info_PK->start_pos = info_TL->end_header + 1;
 422                                 } 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 */
 423                                         info_TL->tp[curtp].tp_numpacks = p_cstr_info->packno - tp_start_packno; /* Number of packets in previous tile-part */
 424                                         tp_start_packno = p_cstr_info->packno;
 425                                         curtp++;
 426                                         info_PK->start_pos = p_cstr_info->tile[p_tile_no].tp[curtp].tp_end_header+1;
 427                                 } else {
 428                                         info_PK->start_pos = (l_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;
 429                                 }
 430                                 info_PK->end_pos = info_PK->start_pos + l_nb_bytes_read - 1;
 431                                 info_PK->end_ph_pos += info_PK->start_pos - 1;  /* End of packet header which now only represents the distance */
 432                                 ++p_cstr_info->packno;
 433                         }
 434 #endif
 435                         /* << INDEX */
 436                 }
 437                 ++l_current_pi;
 438
 439                 opj_free(first_pass_failed);
 440         }
 441         /* INDEX >> */
 442 #ifdef TODO_MSD
 443         if
 444                 (p_cstr_info) {
 445                 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 */
 446         }
 447 #endif
 448         /* << INDEX */
 449
 450         /* don't forget to release pi */
 451         opj_pi_destroy(l_pi,l_nb_pocs);
 452         *p_data_read = (OPJ_UINT32)(l_current_data - p_src);
 453         return OPJ_TRUE;
 454 }
 455
 456 /* ----------------------------------------------------------------------- */
 457
 458 /**
 459  * Creates a Tier 2 handle
 460  *
 461  * @param       p_image         Source or destination image
 462  * @param       p_cp            Image coding parameters.
 463  * @return              a new T2 handle if successful, NULL otherwise.
 464 */
 465 opj_t2_t* opj_t2_create(opj_image_t *p_image, opj_cp_t *p_cp)
 466 {
 467         /* create the t2 structure */
 468         opj_t2_t *l_t2 = (opj_t2_t*)opj_malloc(sizeof(opj_t2_t));
 469         if (!l_t2) {
 470                 return NULL;
 471         }
 472         memset(l_t2,0,sizeof(opj_t2_t));
 473
 474         l_t2->image = p_image;
 475         l_t2->cp = p_cp;
 476
 477         return l_t2;
 478 }
 479
 480 void opj_t2_destroy(opj_t2_t *t2) {
 481         if(t2) {
 482                 opj_free(t2);
 483         }
 484 }
 485
 486 OPJ_BOOL opj_t2_decode_packet(  opj_t2_t* p_t2,
 487                                 opj_tcd_tile_t *p_tile,
 488                                 opj_tcp_t *p_tcp,
 489                                 opj_pi_iterator_t *p_pi,
 490                                 OPJ_BYTE *p_src,
 491                                 OPJ_UINT32 * p_data_read,
 492                                 OPJ_UINT32 p_max_length,
 493                                 opj_packet_info_t *p_pack_info)
 494 {
 495         OPJ_BOOL l_read_data;
 496         OPJ_UINT32 l_nb_bytes_read = 0;
 497         OPJ_UINT32 l_nb_total_bytes_read = 0;
 498
 499         *p_data_read = 0;
 500
 501         if (! opj_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)) {
 502                 return OPJ_FALSE;
 503         }
 504
 505         p_src += l_nb_bytes_read;
 506         l_nb_total_bytes_read += l_nb_bytes_read;
 507         p_max_length -= l_nb_bytes_read;
 508
 509         /* we should read data for the packet */
 510         if (l_read_data) {
 511                 l_nb_bytes_read = 0;
 512
 513                 if (! opj_t2_read_packet_data(p_t2,p_tile,p_pi,p_src,&l_nb_bytes_read,p_max_length,p_pack_info)) {
 514                         return OPJ_FALSE;
 515                 }
 516
 517                 l_nb_total_bytes_read += l_nb_bytes_read;
 518         }
 519
 520         *p_data_read = l_nb_total_bytes_read;
 521
 522         return OPJ_TRUE;
 523 }
 524
 525 OPJ_BOOL opj_t2_encode_packet(  OPJ_UINT32 tileno,
 526                                 opj_tcd_tile_t * tile,
 527                                 opj_tcp_t * tcp,
 528                                 opj_pi_iterator_t *pi,
 529                                 OPJ_BYTE *dest,
 530                                 OPJ_UINT32 * p_data_written,
 531                                 OPJ_UINT32 length,
 532                                 opj_codestream_info_t *cstr_info)
 533 {
 534         OPJ_UINT32 bandno, cblkno;
 535         OPJ_BYTE* c = dest;
 536         OPJ_UINT32 l_nb_bytes;
 537         OPJ_UINT32 compno = pi->compno;     /* component value */
 538         OPJ_UINT32 resno  = pi->resno;      /* resolution level value */
 539         OPJ_UINT32 precno = pi->precno;     /* precinct value */
 540         OPJ_UINT32 layno  = pi->layno;      /* quality layer value */
 541         OPJ_UINT32 l_nb_blocks;
 542         opj_tcd_band_t *band = 00;
 543         opj_tcd_cblk_enc_t* cblk = 00;
 544         opj_tcd_pass_t *pass = 00;
 545
 546         opj_tcd_tilecomp_t *tilec = &tile->comps[compno];
 547         opj_tcd_resolution_t *res = &tilec->resolutions[resno];
 548
 549         opj_bio_t *bio = 00;    /* BIO component */
 550
 551         /* <SOP 0xff91> */
 552         if (tcp->csty & J2K_CP_CSTY_SOP) {
 553                 c[0] = 255;
 554                 c[1] = 145;
 555                 c[2] = 0;
 556                 c[3] = 4;
 557 #if 0
 558                 c[4] = (tile->packno % 65536) / 256;
 559                 c[5] = (tile->packno % 65536) % 256;
 560 #else
 561                 c[4] = (tile->packno >> 8) & 0xff; /* packno is uint32_t */
 562                 c[5] = tile->packno & 0xff;
 563 #endif
 564                 c += 6;
 565                 length -= 6;
 566         }
 567         /* </SOP> */
 568
 569         if (!layno) {
 570                 band = res->bands;
 571
 572                 for(bandno = 0; bandno < res->numbands; ++bandno) {
 573                         opj_tcd_precinct_t *prc = &band->precincts[precno];
 574
 575                         opj_tgt_reset(prc->incltree);
 576                         opj_tgt_reset(prc->imsbtree);
 577
 578                         l_nb_blocks = prc->cw * prc->ch;
 579                         for     (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
 580                                 cblk = &prc->cblks.enc[cblkno];
 581
 582                                 cblk->numpasses = 0;
 583                                 opj_tgt_setvalue(prc->imsbtree, cblkno, band->numbps - (OPJ_INT32)cblk->numbps);
 584                         }
 585                         ++band;
 586                 }
 587         }
 588
 589         bio = opj_bio_create();
 590         opj_bio_init_enc(bio, c, length);
 591         opj_bio_write(bio, 1, 1);           /* Empty header bit */
 592
 593         /* Writing Packet header */
 594         band = res->bands;
 595         for (bandno = 0; bandno < res->numbands; ++bandno)      {
 596                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 597
 598                 l_nb_blocks = prc->cw * prc->ch;
 599                 cblk = prc->cblks.enc;
 600
 601                 for (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
 602                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 603
 604                         if (!cblk->numpasses && layer->numpasses) {
 605                                 opj_tgt_setvalue(prc->incltree, cblkno, (OPJ_INT32)layno);
 606                         }
 607
 608                         ++cblk;
 609                 }
 610
 611                 cblk = prc->cblks.enc;
 612                 for (cblkno = 0; cblkno < l_nb_blocks; cblkno++) {
 613                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 614                         OPJ_UINT32 increment = 0;
 615                         OPJ_UINT32 nump = 0;
 616                         OPJ_UINT32 len = 0, passno;
 617                         OPJ_UINT32 l_nb_passes;
 618
 619                         /* cblk inclusion bits */
 620                         if (!cblk->numpasses) {
 621                                 opj_tgt_encode(bio, prc->incltree, cblkno, (OPJ_INT32)(layno + 1));
 622                         } else {
 623                                 opj_bio_write(bio, layer->numpasses != 0, 1);
 624                         }
 625
 626                         /* if cblk not included, go to the next cblk  */
 627                         if (!layer->numpasses) {
 628                                 ++cblk;
 629                                 continue;
 630                         }
 631
 632                         /* if first instance of cblk --> zero bit-planes information */
 633                         if (!cblk->numpasses) {
 634                                 cblk->numlenbits = 3;
 635                                 opj_tgt_encode(bio, prc->imsbtree, cblkno, 999);
 636                         }
 637
 638                         /* number of coding passes included */
 639                         opj_t2_putnumpasses(bio, layer->numpasses);
 640                         l_nb_passes = cblk->numpasses + layer->numpasses;
 641                         pass = cblk->passes +  cblk->numpasses;
 642
 643                         /* computation of the increase of the length indicator and insertion in the header     */
 644                         for (passno = cblk->numpasses; passno < l_nb_passes; ++passno) {
 645                                 ++nump;
 646                                 len += pass->len;
 647
 648                                 if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
 649                                   increment = (OPJ_UINT32)opj_int_max((OPJ_INT32)increment, opj_int_floorlog2((OPJ_INT32)len) + 1
 650                                     - ((OPJ_INT32)cblk->numlenbits + opj_int_floorlog2((OPJ_INT32)nump)));
 651                                         len = 0;
 652                                         nump = 0;
 653                                 }
 654
 655                                 ++pass;
 656                         }
 657                         opj_t2_putcommacode(bio, (OPJ_INT32)increment);
 658
 659                         /* computation of the new Length indicator */
 660                         cblk->numlenbits += increment;
 661
 662                         pass = cblk->passes +  cblk->numpasses;
 663                         /* insertion of the codeword segment length */
 664                         for (passno = cblk->numpasses; passno < l_nb_passes; ++passno) {
 665                                 nump++;
 666                                 len += pass->len;
 667
 668                                 if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
 669                                         opj_bio_write(bio, (OPJ_UINT32)len, cblk->numlenbits + (OPJ_UINT32)opj_int_floorlog2((OPJ_INT32)nump));
 670                                         len = 0;
 671                                         nump = 0;
 672                                 }
 673                                 ++pass;
 674                         }
 675
 676                         ++cblk;
 677                 }
 678
 679                 ++band;
 680         }
 681
 682         if (!opj_bio_flush(bio)) {
 683                 opj_bio_destroy(bio);
 684                 return OPJ_FALSE;               /* modified to eliminate longjmp !! */
 685         }
 686
 687         l_nb_bytes = (OPJ_UINT32)opj_bio_numbytes(bio);
 688         c += l_nb_bytes;
 689         length -= l_nb_bytes;
 690
 691         opj_bio_destroy(bio);
 692
 693         /* <EPH 0xff92> */
 694         if (tcp->csty & J2K_CP_CSTY_EPH) {
 695                 c[0] = 255;
 696                 c[1] = 146;
 697                 c += 2;
 698                 length -= 2;
 699         }
 700         /* </EPH> */
 701
 702         /* << INDEX */
 703         /* End of packet header position. Currently only represents the distance to start of packet
 704            Will be updated later by incrementing with packet start value*/
 705         if(cstr_info && cstr_info->index_write) {
 706                 opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
 707                 info_PK->end_ph_pos = (OPJ_INT32)(c - dest);
 708         }
 709         /* INDEX >> */
 710
 711         /* Writing the packet body */
 712         band = res->bands;
 713         for (bandno = 0; bandno < res->numbands; bandno++) {
 714                 opj_tcd_precinct_t *prc = &band->precincts[precno];
 715
 716                 l_nb_blocks = prc->cw * prc->ch;
 717                 cblk = prc->cblks.enc;
 718
 719                 for (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
 720                         opj_tcd_layer_t *layer = &cblk->layers[layno];
 721
 722                         if (!layer->numpasses) {
 723                                 ++cblk;
 724                                 continue;
 725                         }
 726
 727                         if (layer->len > length) {
 728                                 return OPJ_FALSE;
 729                         }
 730
 731                         memcpy(c, layer->data, layer->len);
 732                         cblk->numpasses += layer->numpasses;
 733                         c += layer->len;
 734                         length -= layer->len;
 735
 736                         /* << INDEX */
 737                         if(cstr_info && cstr_info->index_write) {
 738                                 opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
 739                                 info_PK->disto += layer->disto;
 740                                 if (cstr_info->D_max < info_PK->disto) {
 741                                         cstr_info->D_max = info_PK->disto;
 742                                 }
 743                         }
 744
 745                         ++cblk;
 746                         /* INDEX >> */
 747                 }
 748                 ++band;
 749         }
 750
 751         assert( c >= dest );
 752         * p_data_written += (OPJ_UINT32)(c - dest);
 753
 754         return OPJ_TRUE;
 755 }
 756
 757 static OPJ_BOOL opj_t2_skip_packet( opj_t2_t* p_t2,
 758                                     opj_tcd_tile_t *p_tile,
 759                                     opj_tcp_t *p_tcp,
 760                                     opj_pi_iterator_t *p_pi,
 761                                     OPJ_BYTE *p_src,
 762                                     OPJ_UINT32 * p_data_read,
 763                                     OPJ_UINT32 p_max_length,
 764                                     opj_packet_info_t *p_pack_info)
 765 {
 766         OPJ_BOOL l_read_data;
 767         OPJ_UINT32 l_nb_bytes_read = 0;
 768         OPJ_UINT32 l_nb_total_bytes_read = 0;
 769
 770         *p_data_read = 0;
 771
 772         if (! opj_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)) {
 773                 return OPJ_FALSE;
 774         }
 775
 776         p_src += l_nb_bytes_read;
 777         l_nb_total_bytes_read += l_nb_bytes_read;
 778         p_max_length -= l_nb_bytes_read;
 779
 780         /* we should read data for the packet */
 781         if (l_read_data) {
 782                 l_nb_bytes_read = 0;
 783
 784                 if (! opj_t2_skip_packet_data(p_t2,p_tile,p_pi,&l_nb_bytes_read,p_max_length,p_pack_info)) {
 785                         return OPJ_FALSE;
 786                 }
 787
 788                 l_nb_total_bytes_read += l_nb_bytes_read;
 789         }
 790         *p_data_read = l_nb_total_bytes_read;
 791
 792         return OPJ_TRUE;
 793 }
 794
 795
 796 OPJ_BOOL opj_t2_read_packet_header( opj_t2_t* p_t2,
 797                                     opj_tcd_tile_t *p_tile,
 798                                     opj_tcp_t *p_tcp,
 799                                     opj_pi_iterator_t *p_pi,
 800                                     OPJ_BOOL * p_is_data_present,
 801                                     OPJ_BYTE *p_src_data,
 802                                     OPJ_UINT32 * p_data_read,
 803                                     OPJ_UINT32 p_max_length,
 804                                     opj_packet_info_t *p_pack_info)
 805
 806 {
 807         /* loop */
 808         OPJ_UINT32 bandno, cblkno;
 809         OPJ_UINT32 l_nb_code_blocks;
 810         OPJ_UINT32 l_remaining_length;
 811         OPJ_UINT32 l_header_length;
 812         OPJ_UINT32 * l_modified_length_ptr = 00;
 813         OPJ_BYTE *l_current_data = p_src_data;
 814         opj_cp_t *l_cp = p_t2->cp;
 815         opj_bio_t *l_bio = 00;  /* BIO component */
 816         opj_tcd_band_t *l_band = 00;
 817         opj_tcd_cblk_dec_t* l_cblk = 00;
 818         opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
 819
 820         OPJ_BYTE *l_header_data = 00;
 821         OPJ_BYTE **l_header_data_start = 00;
 822
 823         OPJ_UINT32 l_present;
 824
 825         if (p_pi->layno == 0) {
 826                 l_band = l_res->bands;
 827
 828                 /* reset tagtrees */
 829                 for (bandno = 0; bandno < l_res->numbands; ++bandno) {
 830                         opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
 831
 832                         if ( ! ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) ) {
 833                                 opj_tgt_reset(l_prc->incltree);
 834                                 opj_tgt_reset(l_prc->imsbtree);
 835                                 l_cblk = l_prc->cblks.dec;
 836
 837                                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
 838                                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
 839                                         l_cblk->numsegs = 0;
 840                                         l_cblk->real_num_segs = 0;
 841                                         ++l_cblk;
 842                                 }
 843                         }
 844
 845                         ++l_band;
 846                 }
 847         }
 848
 849         /* SOP markers */
 850
 851         if (p_tcp->csty & J2K_CP_CSTY_SOP) {
 852                 if ((*l_current_data) != 0xff || (*(l_current_data + 1) != 0x91)) {
 853                         /* TODO opj_event_msg(t2->cinfo->event_mgr, EVT_WARNING, "Expected SOP marker\n"); */
 854                         fprintf(stderr, "Error : expected SOP marker\n");
 855                 } else {
 856                         l_current_data += 6;
 857                 }
 858
 859                 /** TODO : check the Nsop value */
 860         }
 861
 862         /*
 863         When the marker PPT/PPM is used the packet header are store in PPT/PPM marker
 864         This part deal with this caracteristic
 865         step 1: Read packet header in the saved structure
 866         step 2: Return to codestream for decoding
 867         */
 868
 869         l_bio = opj_bio_create();
 870         if (! l_bio) {
 871                 return OPJ_FALSE;
 872         }
 873
 874         if (l_cp->ppm == 1) { /* PPM */
 875                 l_header_data_start = &l_cp->ppm_data;
 876                 l_header_data = *l_header_data_start;
 877                 l_modified_length_ptr = &(l_cp->ppm_len);
 878
 879         }
 880         else if (p_tcp->ppt == 1) { /* PPT */
 881                 l_header_data_start = &(p_tcp->ppt_data);
 882                 l_header_data = *l_header_data_start;
 883                 l_modified_length_ptr = &(p_tcp->ppt_len);
 884         }
 885         else {  /* Normal Case */
 886                 l_header_data_start = &(l_current_data);
 887                 l_header_data = *l_header_data_start;
 888                 l_remaining_length = (OPJ_UINT32)(p_src_data+p_max_length-l_header_data);
 889                 l_modified_length_ptr = &(l_remaining_length);
 890         }
 891
 892         opj_bio_init_dec(l_bio, l_header_data,*l_modified_length_ptr);
 893
 894         l_present = opj_bio_read(l_bio, 1);
 895         JAS_FPRINTF(stderr, "present=%d \n", l_present );
 896         if (!l_present) {
 897             /* TODO MSD: no test to control the output of this function*/
 898                 opj_bio_inalign(l_bio);
 899                 l_header_data += opj_bio_numbytes(l_bio);
 900                 opj_bio_destroy(l_bio);
 901
 902                 /* EPH markers */
 903                 if (p_tcp->csty & J2K_CP_CSTY_EPH) {
 904                         if (p_max_length < 2) {
 905                                 fprintf(stderr, "Not enough space for expected EPH marker\n");
 906                         } else if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
 907                                 fprintf(stderr, "Error : expected EPH marker\n");
 908                         } else {
 909                                 l_header_data += 2;
 910                         }
 911                 }
 912
 913                 l_header_length = (OPJ_UINT32)(l_header_data - *l_header_data_start);
 914                 *l_modified_length_ptr -= l_header_length;
 915                 *l_header_data_start += l_header_length;
 916
 917                 /* << INDEX */
 918                 /* End of packet header position. Currently only represents the distance to start of packet
 919                    Will be updated later by incrementing with packet start value */
 920                 if (p_pack_info) {
 921                         p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
 922                 }
 923                 /* INDEX >> */
 924
 925                 * p_is_data_present = OPJ_FALSE;
 926                 *p_data_read = (OPJ_UINT32)(l_current_data - p_src_data);
 927                 return OPJ_TRUE;
 928         }
 929
 930         l_band = l_res->bands;
 931         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
 932                 opj_tcd_precinct_t *l_prc = &(l_band->precincts[p_pi->precno]);
 933
 934                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
 935                         ++l_band;
 936                         continue;
 937                 }
 938
 939                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
 940                 l_cblk = l_prc->cblks.dec;
 941                 for (cblkno = 0; cblkno < l_nb_code_blocks; cblkno++) {
 942                         OPJ_UINT32 l_included,l_increment, l_segno;
 943                         OPJ_INT32 n;
 944
 945                         /* if cblk not yet included before --> inclusion tagtree */
 946                         if (!l_cblk->numsegs) {
 947                                 l_included = opj_tgt_decode(l_bio, l_prc->incltree, cblkno, (OPJ_INT32)(p_pi->layno + 1));
 948                                 /* else one bit */
 949                         }
 950                         else {
 951                                 l_included = opj_bio_read(l_bio, 1);
 952                         }
 953
 954                         /* if cblk not included */
 955                         if (!l_included) {
 956                                 l_cblk->numnewpasses = 0;
 957                                 ++l_cblk;
 958         JAS_FPRINTF(stderr, "included=%d \n", l_included);
 959                                 continue;
 960                         }
 961
 962                         /* if cblk not yet included --> zero-bitplane tagtree */
 963                         if (!l_cblk->numsegs) {
 964                                 OPJ_UINT32 i = 0;
 965
 966                                 while (!opj_tgt_decode(l_bio, l_prc->imsbtree, cblkno, (OPJ_INT32)i)) {
 967                                         ++i;
 968                                 }
 969
 970                                 l_cblk->numbps = (OPJ_UINT32)l_band->numbps + 1 - i;
 971                                 l_cblk->numlenbits = 3;
 972                         }
 973
 974                         /* number of coding passes */
 975                         l_cblk->numnewpasses = opj_t2_getnumpasses(l_bio);
 976                         l_increment = opj_t2_getcommacode(l_bio);
 977
 978                         /* length indicator increment */
 979                         l_cblk->numlenbits += l_increment;
 980                         l_segno = 0;
 981
 982                         if (!l_cblk->numsegs) {
 983                                 if (! opj_t2_init_seg(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 1)) {
 984                                         opj_bio_destroy(l_bio);
 985                                         return OPJ_FALSE;
 986                                 }
 987                         }
 988                         else {
 989                                 l_segno = l_cblk->numsegs - 1;
 990                                 if (l_cblk->segs[l_segno].numpasses == l_cblk->segs[l_segno].maxpasses) {
 991                                         ++l_segno;
 992                                         if (! opj_t2_init_seg(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0)) {
 993                                                 opj_bio_destroy(l_bio);
 994                                                 return OPJ_FALSE;
 995                                         }
 996                                 }
 997                         }
 998                         n = (OPJ_INT32)l_cblk->numnewpasses;
 999
1000                         do {
1001                                 l_cblk->segs[l_segno].numnewpasses = (OPJ_UINT32)opj_int_min((OPJ_INT32)(l_cblk->segs[l_segno].maxpasses - l_cblk->segs[l_segno].numpasses), n);
1002                                 l_cblk->segs[l_segno].newlen = opj_bio_read(l_bio, l_cblk->numlenbits + opj_uint_floorlog2(l_cblk->segs[l_segno].numnewpasses));
1003                                         JAS_FPRINTF(stderr, "included=%d numnewpasses=%d increment=%d len=%d \n", l_included, l_cblk->segs[l_segno].numnewpasses, l_increment, l_cblk->segs[l_segno].newlen );
1004
1005                                 n -= (OPJ_INT32)l_cblk->segs[l_segno].numnewpasses;
1006                                 if (n > 0) {
1007                                         ++l_segno;
1008
1009                                         if (! opj_t2_init_seg(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0)) {
1010                                                 opj_bio_destroy(l_bio);
1011                                                 return OPJ_FALSE;
1012                                         }
1013                                 }
1014                         } while (n > 0);
1015
1016                         ++l_cblk;
1017                 }
1018
1019                 ++l_band;
1020         }
1021
1022         if (!opj_bio_inalign(l_bio)) {
1023                 opj_bio_destroy(l_bio);
1024                 return OPJ_FALSE;
1025         }
1026
1027         l_header_data += opj_bio_numbytes(l_bio);
1028         opj_bio_destroy(l_bio);
1029
1030         /* EPH markers */
1031         if (p_tcp->csty & J2K_CP_CSTY_EPH) {
1032                 if (p_max_length < 2) {
1033                         fprintf(stderr, "Not enough space for expected EPH marker\n");
1034                 } else if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
1035                         /* TODO opj_event_msg(t2->cinfo->event_mgr, EVT_ERROR, "Expected EPH marker\n"); */
1036                         fprintf(stderr, "Error : expected EPH marker\n");
1037                 } else {
1038                         l_header_data += 2;
1039                 }
1040         }
1041
1042         l_header_length = (OPJ_UINT32)(l_header_data - *l_header_data_start);
1043         JAS_FPRINTF( stderr, "hdrlen=%d \n", l_header_length );
1044         JAS_FPRINTF( stderr, "packet body\n");
1045         *l_modified_length_ptr -= l_header_length;
1046         *l_header_data_start += l_header_length;
1047
1048         /* << INDEX */
1049         /* End of packet header position. Currently only represents the distance to start of packet
1050          Will be updated later by incrementing with packet start value */
1051         if (p_pack_info) {
1052                 p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
1053         }
1054         /* INDEX >> */
1055
1056         *p_is_data_present = OPJ_TRUE;
1057         *p_data_read = (OPJ_UINT32)(l_current_data - p_src_data);
1058
1059         return OPJ_TRUE;
1060 }
1061
1062 OPJ_BOOL opj_t2_read_packet_data(   opj_t2_t* p_t2,
1063                                     opj_tcd_tile_t *p_tile,
1064                                     opj_pi_iterator_t *p_pi,
1065                                     OPJ_BYTE *p_src_data,
1066                                     OPJ_UINT32 * p_data_read,
1067                                     OPJ_UINT32 p_max_length,
1068                                     opj_packet_info_t *pack_info)
1069 {
1070         OPJ_UINT32 bandno, cblkno;
1071         OPJ_UINT32 l_nb_code_blocks;
1072         OPJ_BYTE *l_current_data = p_src_data;
1073         opj_tcd_band_t *l_band = 00;
1074         opj_tcd_cblk_dec_t* l_cblk = 00;
1075         opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
1076
1077         OPJ_ARG_NOT_USED(p_t2);
1078         OPJ_ARG_NOT_USED(pack_info);
1079
1080         l_band = l_res->bands;
1081         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1082                 opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
1083
1084                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
1085                         ++l_band;
1086                         continue;
1087                 }
1088
1089                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1090                 l_cblk = l_prc->cblks.dec;
1091
1092                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
1093                         opj_tcd_seg_t *l_seg = 00;
1094
1095                         if (!l_cblk->numnewpasses) {
1096                                 /* nothing to do */
1097                                 ++l_cblk;
1098                                 continue;
1099                         }
1100
1101                         if (!l_cblk->numsegs) {
1102                                 l_seg = l_cblk->segs;
1103                                 ++l_cblk->numsegs;
1104                                 l_cblk->data_current_size = 0;
1105                         }
1106                         else {
1107                                 l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
1108
1109                                 if (l_seg->numpasses == l_seg->maxpasses) {
1110                                         ++l_seg;
1111                                         ++l_cblk->numsegs;
1112                                 }
1113                         }
1114
1115                         do {
1116                                 if (l_current_data + l_seg->newlen > p_src_data + p_max_length) {
1117                                         fprintf(stderr, "read: segment too long (%d) with max (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1118                                                 l_seg->newlen, p_max_length, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1119                                         return OPJ_FALSE;
1120                                 }
1121
1122 #ifdef USE_JPWL
1123                         /* we need here a j2k handle to verify if making a check to
1124                         the validity of cblocks parameters is selected from user (-W) */
1125
1126                                 /* let's check that we are not exceeding */
1127                                 if ((l_cblk->len + l_seg->newlen) > 8192) {
1128                                         opj_event_msg(p_t2->cinfo, EVT_WARNING,
1129                                                 "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1130                                                 l_seg->newlen, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1131                                         if (!JPWL_ASSUME) {
1132                                                 opj_event_msg(p_t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
1133                                                 return OPJ_FALSE;
1134                                         }
1135                                         l_seg->newlen = 8192 - l_cblk->len;
1136                                         opj_event_msg(p_t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", l_seg->newlen);
1137                                         break;
1138                                 };
1139
1140 #endif /* USE_JPWL */
1141                                 /* Check if the cblk->data have allocated enough memory */
1142                                 if ((l_cblk->data_current_size + l_seg->newlen) > l_cblk->data_max_size) {
1143                                     OPJ_BYTE* new_cblk_data = (OPJ_BYTE*) opj_realloc(l_cblk->data, l_cblk->data_current_size + l_seg->newlen);
1144                                     if(! new_cblk_data) {
1145                                         opj_free(l_cblk->data);
1146                                         l_cblk->data_max_size = 0;
1147                                         /* opj_event_msg(p_manager, EVT_ERROR, "Not enough memory to realloc code block cata!\n"); */
1148                                         return OPJ_FALSE;
1149                                     }
1150                                     l_cblk->data_max_size = l_cblk->data_current_size + l_seg->newlen;
1151                                     l_cblk->data = new_cblk_data;
1152                                 }
1153
1154                                 memcpy(l_cblk->data + l_cblk->data_current_size, l_current_data, l_seg->newlen);
1155
1156                                 if (l_seg->numpasses == 0) {
1157                                         l_seg->data = &l_cblk->data;
1158                                         l_seg->dataindex = l_cblk->data_current_size;
1159                                 }
1160
1161                                 l_current_data += l_seg->newlen;
1162                                 l_seg->numpasses += l_seg->numnewpasses;
1163                                 l_cblk->numnewpasses -= l_seg->numnewpasses;
1164
1165                                 l_seg->real_num_passes = l_seg->numpasses;
1166                                 l_cblk->data_current_size += l_seg->newlen;
1167                                 l_seg->len += l_seg->newlen;
1168
1169                                 if (l_cblk->numnewpasses > 0) {
1170                                         ++l_seg;
1171                                         ++l_cblk->numsegs;
1172                                 }
1173                         } while (l_cblk->numnewpasses > 0);
1174
1175                         l_cblk->real_num_segs = l_cblk->numsegs;
1176                         ++l_cblk;
1177                 } /* next code_block */
1178
1179                 ++l_band;
1180         }
1181
1182         *(p_data_read) = (OPJ_UINT32)(l_current_data - p_src_data);
1183
1184         return OPJ_TRUE;
1185 }
1186
1187 OPJ_BOOL opj_t2_skip_packet_data(   opj_t2_t* p_t2,
1188                                     opj_tcd_tile_t *p_tile,
1189                                     opj_pi_iterator_t *p_pi,
1190                                     OPJ_UINT32 * p_data_read,
1191                                     OPJ_UINT32 p_max_length,
1192                                     opj_packet_info_t *pack_info)
1193 {
1194         OPJ_UINT32 bandno, cblkno;
1195         OPJ_UINT32 l_nb_code_blocks;
1196         opj_tcd_band_t *l_band = 00;
1197         opj_tcd_cblk_dec_t* l_cblk = 00;
1198         opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
1199
1200         OPJ_ARG_NOT_USED(p_t2);
1201         OPJ_ARG_NOT_USED(pack_info);
1202
1203         *p_data_read = 0;
1204         l_band = l_res->bands;
1205
1206         for (bandno = 0; bandno < l_res->numbands; ++bandno) {
1207                 opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
1208
1209                 if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)) {
1210                         ++l_band;
1211                         continue;
1212                 }
1213
1214                 l_nb_code_blocks = l_prc->cw * l_prc->ch;
1215                 l_cblk = l_prc->cblks.dec;
1216
1217                 for (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno) {
1218                         opj_tcd_seg_t *l_seg = 00;
1219
1220                         if (!l_cblk->numnewpasses) {
1221                                 /* nothing to do */
1222                                 ++l_cblk;
1223                                 continue;
1224                         }
1225
1226                         if (!l_cblk->numsegs) {
1227                                 l_seg = l_cblk->segs;
1228                                 ++l_cblk->numsegs;
1229                                 l_cblk->data_current_size = 0;
1230                         }
1231                         else {
1232                                 l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
1233
1234                                 if (l_seg->numpasses == l_seg->maxpasses) {
1235                                         ++l_seg;
1236                                         ++l_cblk->numsegs;
1237                                 }
1238                         }
1239
1240                         do {
1241                                 if (* p_data_read + l_seg->newlen > p_max_length) {
1242                                         fprintf(stderr, "skip: segment too long (%d) with max (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1243                                                 l_seg->newlen, p_max_length, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1244                                         return OPJ_FALSE;
1245                                 }
1246
1247 #ifdef USE_JPWL
1248                         /* we need here a j2k handle to verify if making a check to
1249                         the validity of cblocks parameters is selected from user (-W) */
1250
1251                                 /* let's check that we are not exceeding */
1252                                 if ((l_cblk->len + l_seg->newlen) > 8192) {
1253                                         opj_event_msg(p_t2->cinfo, EVT_WARNING,
1254                                                 "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
1255                                                 l_seg->newlen, cblkno, p_pi->precno, bandno, p_pi->resno, p_pi->compno);
1256                                         if (!JPWL_ASSUME) {
1257                                                 opj_event_msg(p_t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
1258                                                 return -999;
1259                                         }
1260                                         l_seg->newlen = 8192 - l_cblk->len;
1261                                         opj_event_msg(p_t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", l_seg->newlen);
1262                                         break;
1263                                 };
1264
1265 #endif /* USE_JPWL */
1266                                         JAS_FPRINTF(stderr, "p_data_read (%d) newlen (%d) \n", *p_data_read, l_seg->newlen );
1267                                 *(p_data_read) += l_seg->newlen;
1268
1269                                 l_seg->numpasses += l_seg->numnewpasses;
1270                                 l_cblk->numnewpasses -= l_seg->numnewpasses;
1271                                 if (l_cblk->numnewpasses > 0)
1272                                 {
1273                                         ++l_seg;
1274                                         ++l_cblk->numsegs;
1275                                 }
1276                         } while (l_cblk->numnewpasses > 0);
1277
1278                         ++l_cblk;
1279                 }
1280
1281                 ++l_band;
1282         }
1283
1284         return OPJ_TRUE;
1285 }
1286
1287
1288 OPJ_BOOL opj_t2_init_seg(   opj_tcd_cblk_dec_t* cblk,
1289                             OPJ_UINT32 index,
1290                             OPJ_UINT32 cblksty,
1291                             OPJ_UINT32 first)
1292 {
1293         opj_tcd_seg_t* seg = 00;
1294         OPJ_UINT32 l_nb_segs = index + 1;
1295
1296         if (l_nb_segs > cblk->m_current_max_segs) {
1297                 opj_tcd_seg_t* new_segs;
1298                 cblk->m_current_max_segs += OPJ_J2K_DEFAULT_NB_SEGS;
1299
1300                 new_segs = (opj_tcd_seg_t*) opj_realloc(cblk->segs, cblk->m_current_max_segs * sizeof(opj_tcd_seg_t));
1301                 if(! new_segs) {
1302                         opj_free(cblk->segs);
1303                         cblk->segs = NULL;
1304                         cblk->m_current_max_segs = 0;
1305                         /* opj_event_msg(p_manager, EVT_ERROR, "Not enough memory to initialize segment %d\n", l_nb_segs); */
1306                         return OPJ_FALSE;
1307                 }
1308                 cblk->segs = new_segs;
1309         }
1310
1311         seg = &cblk->segs[index];
1312         memset(seg,0,sizeof(opj_tcd_seg_t));
1313
1314         if (cblksty & J2K_CCP_CBLKSTY_TERMALL) {
1315                 seg->maxpasses = 1;
1316         }
1317         else if (cblksty & J2K_CCP_CBLKSTY_LAZY) {
1318                 if (first) {
1319                         seg->maxpasses = 10;
1320                 } else {
1321                         seg->maxpasses = (((seg - 1)->maxpasses == 1) || ((seg - 1)->maxpasses == 10)) ? 2 : 1;
1322                 }
1323         } else {
1324                 seg->maxpasses = 109;
1325         }
1326
1327         return OPJ_TRUE;
1328 }