WIP: create a new framework to output file information
[openjpeg.git] / libopenjpeg / t2.c
index 3e6f0e7b5e8751f0cbabd7f3f19fcc7e37b7cad8..e9f08abb22ae54ffc2a2f1130c2b470f54747b57 100644 (file)
@@ -53,17 +53,18 @@ Encode a packet of a tile to a destination buffer
 @param pi Packet identity
 @param dest Destination buffer
 @param len Length of the destination buffer
-@param image_info Structure to create an index file
+@param cstr_info Codestream information structure 
 @param tileno Number of the tile encoded
 @return 
 */
-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_image_info_t *image_info, int tileno);
+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);
 /**
-@param seg
+@param cblk
+@param index
 @param cblksty
 @param first
 */
-static void t2_init_seg(opj_tcd_seg_t *seg, int cblksty, int first);
+static void t2_init_seg(opj_tcd_cblk_dec_t* cblk, int index, int cblksty, int first);
 /**
 Decode a packet of a tile from a source buffer
 @param t2 T2 handle
@@ -72,9 +73,77 @@ Decode a packet of a tile from a source buffer
 @param tile Tile for which to write the packets
 @param tcp Tile coding parameters
 @param pi Packet identity
+@param pack_info Packet information
 @return 
 */
-static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile, opj_tcp_t *tcp, opj_pi_iterator_t *pi);
+static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile, 
+                                                                                                               opj_tcp_t *tcp, opj_pi_iterator_t *pi, opj_packet_info_t *pack_info);
+
+
+/**
+Decode a packet of a tile from a source buffer
+@param t2 T2 handle
+@param src Source buffer
+@param len Length of the source buffer
+@param tile Tile for which to write the packets
+@param tcp Tile coding parameters
+@param pi Packet identity
+@return
+*/
+static opj_bool t2_decode_packet_v2(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info);
+
+static opj_bool t2_skip_packet(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info);
+
+static opj_bool t2_read_packet_header(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        opj_bool * p_is_data_present,
+                                                        OPJ_BYTE *p_src_data,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info);
+
+static opj_bool t2_read_packet_data(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src_data,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *pack_info);
+
+static opj_bool t2_skip_packet_data(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *pack_info);
+
+/**
+@param seg
+@param cblksty
+@param first
+*/
+static opj_bool t2_init_seg_v2(opj_tcd_cblk_dec_t* cblk, OPJ_UINT32 index, OPJ_UINT32 cblksty, OPJ_UINT32 first);
 
 /*@}*/
 
@@ -126,9 +195,8 @@ static int t2_getnumpasses(opj_bio_t *bio) {
        return (37 + bio_read(bio, 7));
 }
 
-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_image_info_t * image_info, int tileno) {
+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) {
        int bandno, cblkno;
-       unsigned char *sop = 0, *eph = 0;
        unsigned char *c = dest;
 
        int compno = pi->compno;        /* component value */
@@ -143,15 +211,12 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
        
        /* <SOP 0xff91> */
        if (tcp->csty & J2K_CP_CSTY_SOP) {
-               sop = (unsigned char *) opj_malloc(6 * sizeof(unsigned char));
-               sop[0] = 255;
-               sop[1] = 145;
-               sop[2] = 0;
-               sop[3] = 4;
-               sop[4] = (image_info->num % 65536) / 256;
-               sop[5] = (image_info->num % 65536) % 256;
-               memcpy(c, sop, 6);
-               opj_free(sop);
+               c[0] = 255;
+               c[1] = 145;
+               c[2] = 0;
+               c[3] = 4;
+               c[4] = (unsigned char)((tile->packno % 65536) / 256);
+               c[5] = (unsigned char)((tile->packno % 65536) % 256);
                c += 6;
        }
        /* </SOP> */
@@ -163,7 +228,7 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
                        tgt_reset(prc->incltree);
                        tgt_reset(prc->imsbtree);
                        for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                               opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                               opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
                                cblk->numpasses = 0;
                                tgt_setvalue(prc->imsbtree, cblkno, band->numbps - cblk->numbps);
                        }
@@ -179,14 +244,14 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
                opj_tcd_band_t *band = &res->bands[bandno];
                opj_tcd_precinct_t *prc = &band->precincts[precno];
                for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                       opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                       opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
                        opj_tcd_layer_t *layer = &cblk->layers[layno];
                        if (!cblk->numpasses && layer->numpasses) {
                                tgt_setvalue(prc->incltree, cblkno, layno);
                        }
                }
                for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                       opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                       opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
                        opj_tcd_layer_t *layer = &cblk->layers[layno];
                        int increment = 0;
                        int nump = 0;
@@ -238,25 +303,31 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
                        }
                }
        }
-       
+
        if (bio_flush(bio)) {
+               bio_destroy(bio);
                return -999;            /* modified to eliminate longjmp !! */
        }
-       
-       c += bio_numbytes(bio);
 
+       c += bio_numbytes(bio);
        bio_destroy(bio);
        
        /* <EPH 0xff92> */
        if (tcp->csty & J2K_CP_CSTY_EPH) {
-               eph = (unsigned char *) opj_malloc(2 * sizeof(unsigned char));
-               eph[0] = 255;
-               eph[1] = 146;
-               memcpy(c, eph, 2);
-               opj_free(eph);
+               c[0] = 255;
+               c[1] = 146;
                c += 2;
        }
        /* </EPH> */
+
+       /* << INDEX */
+       // End of packet header position. Currently only represents the distance to start of packet
+       // Will be updated later by incrementing with packet start value
+       if(cstr_info && cstr_info->index_write) {
+               opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
+               info_PK->end_ph_pos = (int)(c - dest);
+       }
+       /* INDEX >> */
        
        /* Writing the packet body */
        
@@ -264,7 +335,7 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
                opj_tcd_band_t *band = &res->bands[bandno];
                opj_tcd_precinct_t *prc = &band->precincts[precno];
                for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                       opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                       opj_tcd_cblk_enc_t* cblk = &prc->cblks.enc[cblkno];
                        opj_tcd_layer_t *layer = &cblk->layers[layno];
                        if (!layer->numpasses) {
                                continue;
@@ -276,23 +347,27 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
                        memcpy(c, layer->data, layer->len);
                        cblk->numpasses += layer->numpasses;
                        c += layer->len;
-                       /* ADD for index Cfr. Marcela --> delta disto by packet */
-                       if(image_info && image_info->index_write && image_info->index_on) {
-                               opj_tile_info_t *info_TL = &image_info->tile[tileno];
-                               opj_packet_info_t *info_PK = &info_TL->packet[image_info->num];
+                       /* << INDEX */ 
+                       if(cstr_info && cstr_info->index_write) {
+                               opj_packet_info_t *info_PK = &cstr_info->tile[tileno].packet[cstr_info->packno];
                                info_PK->disto += layer->disto;
-                               if (image_info->D_max < info_PK->disto) {
-                                       image_info->D_max = info_PK->disto;
+                               if (cstr_info->D_max < info_PK->disto) {
+                                       cstr_info->D_max = info_PK->disto;
                                }
                        }
-                       /* </ADD> */
+                       /* INDEX >> */
                }
        }
        
        return (c - dest);
 }
 
-static void t2_init_seg(opj_tcd_seg_t * seg, int cblksty, int first) {
+static void t2_init_seg(opj_tcd_cblk_dec_t* cblk, int index, int cblksty, int first) {
+       opj_tcd_seg_t* seg;
+       cblk->segs = (opj_tcd_seg_t*) opj_realloc(cblk->segs, (index + 1) * sizeof(opj_tcd_seg_t));
+       seg = &cblk->segs[index];
+       seg->data = NULL;
+       seg->dataindex = 0;
        seg->numpasses = 0;
        seg->len = 0;
        if (cblksty & J2K_CCP_CBLKSTY_TERMALL) {
@@ -309,7 +384,8 @@ static void t2_init_seg(opj_tcd_seg_t * seg, int cblksty, int first) {
        }
 }
 
-static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile, opj_tcp_t *tcp, opj_pi_iterator_t *pi) {
+static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_tile_t *tile, 
+                                                                                                               opj_tcp_t *tcp, opj_pi_iterator_t *pi, opj_packet_info_t *pack_info) {
        int bandno, cblkno;
        unsigned char *c = src;
 
@@ -320,9 +396,8 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
        int precno = pi->precno;        /* precinct value */
        int layno  = pi->layno;         /* quality layer value */
 
-       opj_tcd_tilecomp_t *tilec = &tile->comps[compno];
-       opj_tcd_resolution_t *res = &tilec->resolutions[resno];
-       
+       opj_tcd_resolution_t* res = &tile->comps[compno].resolutions[resno];
+
        unsigned char *hd = NULL;
        int present;
        
@@ -338,7 +413,7 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                        tgt_reset(prc->incltree);
                        tgt_reset(prc->imsbtree);
                        for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                               opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                               opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
                                cblk->numsegs = 0;
                        }
                }
@@ -392,6 +467,14 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                                hd += 2;
                        }
                }
+
+               /* << INDEX */
+               // End of packet header position. Currently only represents the distance to start of packet
+               // Will be updated later by incrementing with packet start value
+               if(pack_info) {
+                       pack_info->end_ph_pos = (int)(c - src);
+               }
+               /* INDEX >> */
                
                if (cp->ppm == 1) {             /* PPM case */
                        cp->ppm_len += cp->ppm_data-hd;
@@ -414,9 +497,8 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                if ((band->x1-band->x0 == 0)||(band->y1-band->y0 == 0)) continue;
                
                for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                       int included, increment, n;
-                       opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
-                       opj_tcd_seg_t *seg = NULL;
+                       int included, increment, n, segno;
+                       opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
                        /* if cblk not yet included before --> inclusion tagtree */
                        if (!cblk->numsegs) {
                                included = tgt_decode(bio, prc->incltree, cblkno, layno + 1);
@@ -444,23 +526,25 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                        increment = t2_getcommacode(bio);
                        /* length indicator increment */
                        cblk->numlenbits += increment;
+                       segno = 0;
                        if (!cblk->numsegs) {
-                               seg = &cblk->segs[0];
-                               t2_init_seg(seg, tcp->tccps[compno].cblksty, 1);
+                               t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 1);
                        } else {
-                               seg = &cblk->segs[cblk->numsegs - 1];
-                               if (seg->numpasses == seg->maxpasses) {
-                                       t2_init_seg(++seg, tcp->tccps[compno].cblksty, 0);
+                               segno = cblk->numsegs - 1;
+                               if (cblk->segs[segno].numpasses == cblk->segs[segno].maxpasses) {
+                                       ++segno;
+                                       t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 0);
                                }
                        }
                        n = cblk->numnewpasses;
                        
                        do {
-                               seg->numnewpasses = int_min(seg->maxpasses - seg->numpasses, n);
-                               seg->newlen = bio_read(bio, cblk->numlenbits + int_floorlog2(seg->numnewpasses));
-                               n -= seg->numnewpasses;
+                               cblk->segs[segno].numnewpasses = int_min(cblk->segs[segno].maxpasses - cblk->segs[segno].numpasses, n);
+                               cblk->segs[segno].newlen = bio_read(bio, cblk->numlenbits + int_floorlog2(cblk->segs[segno].numnewpasses));
+                               n -= cblk->segs[segno].numnewpasses;
                                if (n > 0) {
-                                       t2_init_seg(++seg, tcp->tccps[compno].cblksty, 0);
+                                       ++segno;
+                                       t2_init_seg(cblk, segno, tcp->tccps[compno].cblksty, 0);
                                }
                        } while (n > 0);
                }
@@ -478,10 +562,19 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
        if (tcp->csty & J2K_CP_CSTY_EPH) {
                if ((*hd) != 0xff || (*(hd + 1) != 0x92)) {
                        opj_event_msg(t2->cinfo, EVT_ERROR, "Expected EPH marker\n");
+                       return -999;
                } else {
                        hd += 2;
                }
        }
+
+       /* << INDEX */
+       // End of packet header position. Currently only represents the distance to start of packet
+       // Will be updated later by incrementing with packet start value
+       if(pack_info) {
+               pack_info->end_ph_pos = (int)(hd - src);
+       }
+       /* INDEX >> */
        
        if (cp->ppm==1) {
                cp->ppm_len+=cp->ppm_data-hd;
@@ -500,7 +593,7 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                if ((band->x1-band->x0 == 0)||(band->y1-band->y0 == 0)) continue;
                
                for (cblkno = 0; cblkno < prc->cw * prc->ch; cblkno++) {
-                       opj_tcd_cblk_t *cblk = &prc->cblks[cblkno];
+                       opj_tcd_cblk_dec_t* cblk = &prc->cblks.dec[cblkno];
                        opj_tcd_seg_t *seg = NULL;
                        if (!cblk->numnewpasses)
                                continue;
@@ -521,28 +614,31 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                                        return -999;
                                }
 
-/* UniPG>> */
 #ifdef USE_JPWL
                        /* we need here a j2k handle to verify if making a check to
                        the validity of cblocks parameters is selected from user (-W) */
 
                                /* let's check that we are not exceeding */
                                if ((cblk->len + seg->newlen) > 8192) {
-                                       fprintf(stderr, "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
+                                       opj_event_msg(t2->cinfo, EVT_WARNING,
+                                               "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
                                                seg->newlen, cblkno, precno, bandno, resno, compno);
-                                       if (!JPWL_ASSUME)
-                                               exit(-1);
+                                       if (!JPWL_ASSUME) {
+                                               opj_event_msg(t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
+                                               return -999;
+                                       }
                                        seg->newlen = 8192 - cblk->len;
-                                       fprintf(stderr, "      - truncating segment to %d\n", seg->newlen);
+                                       opj_event_msg(t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", seg->newlen);
                                        break;
                                };
 
 #endif /* USE_JPWL */
-/* <<UniPG */
                                
+                               cblk->data = (unsigned char*) opj_realloc(cblk->data, (cblk->len + seg->newlen) * sizeof(unsigned char*));
                                memcpy(cblk->data + cblk->len, c, seg->newlen);
                                if (seg->numpasses == 0) {
-                                       seg->data = cblk->data + cblk->len;
+                                       seg->data = &cblk->data;
+                                       seg->dataindex = cblk->len;
                                }
                                c += seg->newlen;
                                cblk->len += seg->newlen;
@@ -562,71 +658,103 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
 
 /* ----------------------------------------------------------------------- */
 
-int t2_encode_packets(opj_t2_t* t2,int tileno, opj_tcd_tile_t *tile, int maxlayers, unsigned char *dest, int len, opj_image_info_t *image_info,opj_pi_iterator_t *tcd_pi,int tpnum, int tppos,int pino, char final_encoding){
+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){
        unsigned char *c = dest;
        int e = 0;
+       int compno;
        opj_pi_iterator_t *pi = NULL;
-
+       int poc;
        opj_image_t *image = t2->image;
        opj_cp_t *cp = t2->cp;
-
-       if(final_encoding == 0){
-               pi = pi_initialise_encode(image, cp, tileno,pino);
-       }else{
-               pi = tcd_pi;
-       }
+       opj_tcp_t *tcp = &cp->tcps[tileno];
+       int pocno = cp->cinema == CINEMA4K_24? 2: 1;
+       int maxcomp = cp->max_comp_size > 0 ? image->numcomps : 1;
+       
+       pi = pi_initialise_encode(image, cp, tileno, t2_mode);
        if(!pi) {
                /* TODO: throw an error */
                return -999;
        }
        
-       pi_create_encode(pi, cp,tileno,pino,tpnum,tppos,final_encoding); 
-
-       if(image_info) {
-               image_info->num = 0;
-       }
-
-       while (pi_next(&pi[pino])) {
-               if (pi[pino].layno < maxlayers) {
-                       e = t2_encode_packet(tile, &cp->tcps[tileno], &pi[pino], c, dest + len - c, image_info, tileno);
-                       if (e == -999) {
-                               break;
-                       } else {
-                               c += e;
+       if(t2_mode == THRESH_CALC ){ /* Calculating threshold */
+               for(compno = 0; compno < maxcomp; compno++ ){
+                       for(poc = 0; poc < pocno ; poc++){
+                               int comp_len = 0;
+                               int tpnum = compno;
+                               if (pi_create_encode(pi, cp,tileno,poc,tpnum,tppos,t2_mode,cur_totnum_tp)) {
+                                       opj_event_msg(t2->cinfo, EVT_ERROR, "Error initializing Packet Iterator\n");
+                                       pi_destroy(pi, cp, tileno);
+                                       return -999;
+                               }
+                               while (pi_next(&pi[poc])) {
+                                       if (pi[poc].layno < maxlayers) {
+                                               e = t2_encode_packet(tile, &cp->tcps[tileno], &pi[poc], c, dest + len - c, cstr_info, tileno);
+                                               comp_len = comp_len + e;
+                                               if (e == -999) {
+                                                       break;
+                                               } else {
+                                                       c += e;
+                                               }
+                                       }
+                               }
+                               if (e == -999) break;
+                               if (cp->max_comp_size){
+                                       if (comp_len > cp->max_comp_size){
+                                               e = -999;
+                                               break;
+                                       }
+                               }
                        }
-                       /* INDEX >> */
-                       if(image_info && image_info->index_on) {
-                               if(image_info->index_write) {
-                                       opj_tile_info_t *info_TL = &image_info->tile[tileno];
-                                       opj_packet_info_t *info_PK = &info_TL->packet[image_info->num];
-                                       if (!image_info->num) {
-                                               info_PK->start_pos = info_TL->end_header + 1;
-                                       } else {
-                                               info_PK->start_pos = info_TL->packet[image_info->num - 1].end_pos + 1;
+                       if (e == -999)  break;
+               }
+       }else{  /* t2_mode == FINAL_PASS  */
+               pi_create_encode(pi, cp,tileno,pino,tpnum,tppos,t2_mode,cur_totnum_tp);
+               while (pi_next(&pi[pino])) {
+                       if (pi[pino].layno < maxlayers) {
+                               e = t2_encode_packet(tile, &cp->tcps[tileno], &pi[pino], c, dest + len - c, cstr_info, tileno);
+                               if (e == -999) {
+                                       break;
+                               } else {
+                                       c += e;
+                               }
+                               /* INDEX >> */
+                               if(cstr_info) {
+                                       if(cstr_info->index_write) {
+                                               opj_tile_info_t *info_TL = &cstr_info->tile[tileno];
+                                               opj_packet_info_t *info_PK = &info_TL->packet[cstr_info->packno];
+                                               if (!cstr_info->packno) {
+                                                       info_PK->start_pos = info_TL->end_header + 1;
+                                               } else {
+                                                       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;
+                                               }
+                                               info_PK->end_pos = info_PK->start_pos + e - 1;
+                                               info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance 
+                                                                                                                                                                                                                                               // to start of packet is incremented by value of start of packet
                                        }
-                                       info_PK->end_pos = info_PK->start_pos + e - 1;
+                                       
+                                       cstr_info->packno++;
                                }
-
-                               image_info->num++;
+                               /* << INDEX */
+                               tile->packno++;
                        }
-                       /* << INDEX */
                }
        }
-       if(final_encoding == 0){
-               pi_destroy(pi, cp, tileno);
-       }
+       
+       pi_destroy(pi, cp, tileno);
+       
        if (e == -999) {
                return e;
        }
-
-    return (c - dest);
+       
+  return (c - dest);
 }
 
-int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj_tcd_tile_t *tile) {
+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) {
        unsigned char *c = src;
        opj_pi_iterator_t *pi;
        int pino, e = 0;
-       int n = 0;
+       int n = 0, curtp = 0;
+       int tp_start_packno;
 
        opj_image_t *image = t2->image;
        opj_cp_t *cp = t2->cp;
@@ -637,29 +765,64 @@ int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj
                /* TODO: throw an error */
                return -999;
        }
+
+       tp_start_packno = 0;
        
        for (pino = 0; pino <= cp->tcps[tileno].numpocs; pino++) {
                while (pi_next(&pi[pino])) {
                        if ((cp->layer==0) || (cp->layer>=((pi[pino].layno)+1))) {
-                               e = t2_decode_packet(t2, c, src + len - c, tile, &cp->tcps[tileno], &pi[pino]);
+                               opj_packet_info_t *pack_info;
+                               if (cstr_info)
+                                       pack_info = &cstr_info->tile[tileno].packet[cstr_info->packno];
+                               else
+                                       pack_info = NULL;
+                               e = t2_decode_packet(t2, c, src + len - c, tile, &cp->tcps[tileno], &pi[pino], pack_info);
                        } else {
                                e = 0;
                        }
-                       
+                       if(e == -999) return -999;
                        /* progression in resolution */
                        image->comps[pi[pino].compno].resno_decoded =   
                                (e > 0) ? 
                                int_max(pi[pino].resno, image->comps[pi[pino].compno].resno_decoded) 
                                : image->comps[pi[pino].compno].resno_decoded;
                        n++;
+
+                       /* INDEX >> */
+                       if(cstr_info) {
+                               opj_tile_info_t *info_TL = &cstr_info->tile[tileno];
+                               opj_packet_info_t *info_PK = &info_TL->packet[cstr_info->packno];
+                               if (!cstr_info->packno) {
+                                       info_PK->start_pos = info_TL->end_header + 1;
+                               } else if (info_TL->packet[cstr_info->packno-1].end_pos >= (int)cstr_info->tile[tileno].tp[curtp].tp_end_pos){ // New tile part
+                                       info_TL->tp[curtp].tp_numpacks = cstr_info->packno - tp_start_packno; // Number of packets in previous tile-part
+          info_TL->tp[curtp].tp_start_pack = tp_start_packno;
+                                       tp_start_packno = cstr_info->packno;
+                                       curtp++;
+                                       info_PK->start_pos = cstr_info->tile[tileno].tp[curtp].tp_end_header+1;
+                               } else {
+                                       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;
+                               }
+                               info_PK->end_pos = info_PK->start_pos + e - 1;
+                               info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance 
+                                                                                                                                                                                                                               // to start of packet is incremented by value of start of packet
+                               cstr_info->packno++;
+                       }
+                       /* << INDEX */
                        
                        if (e == -999) {                /* ADD */
                                break;
                        } else {
                                c += e;
-                       }
+                       }                       
                }
        }
+       /* INDEX >> */
+       if(cstr_info) {
+               cstr_info->tile[tileno].tp[curtp].tp_numpacks = cstr_info->packno - tp_start_packno; // Number of packets in last tile-part
+    cstr_info->tile[tileno].tp[curtp].tp_start_pack = tp_start_packno;
+       }
+       /* << INDEX */
 
        /* don't forget to release pi */
        pi_destroy(pi, cp, tileno);
@@ -668,7 +831,107 @@ int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj
                return e;
        }
        
-    return (c - src);
+       return (c - src);
+}
+
+opj_bool t2_decode_packets_v2(
+                                               opj_t2_v2_t *p_t2,
+                                               OPJ_UINT32 p_tile_no,
+                                               struct opj_tcd_tile *p_tile,
+                                               OPJ_BYTE *p_src,
+                                               OPJ_UINT32 * p_data_read,
+                                               OPJ_UINT32 p_max_len,
+                                               struct opj_codestream_info_v2 *p_cstr_info)
+{
+       OPJ_BYTE *l_current_data = p_src;
+       opj_pi_iterator_t *l_pi = 00;
+       OPJ_UINT32 pino;
+       opj_image_header_t *l_image = p_t2->image;
+       opj_cp_v2_t *l_cp = p_t2->cp;
+       opj_cp_v2_t *cp = p_t2->cp;
+       opj_tcp_v2_t *l_tcp = &(p_t2->cp->tcps[p_tile_no]);
+       OPJ_UINT32 l_nb_bytes_read;
+       OPJ_UINT32 l_nb_pocs = l_tcp->numpocs + 1;
+       opj_pi_iterator_t *l_current_pi = 00;
+       OPJ_UINT32 curtp = 0;
+       OPJ_UINT32 tp_start_packno;
+       opj_packet_info_t *l_pack_info = 00;
+       opj_image_comp_header_t* l_img_comp = 00;
+
+
+       if (p_cstr_info) {
+               l_pack_info = p_cstr_info->tile[p_tile_no].packet;
+       }
+
+       /* create a packet iterator */
+       l_pi = pi_create_decode_v2(l_image, l_cp, p_tile_no);
+       if (!l_pi) {
+               return OPJ_FALSE;
+       }
+
+       tp_start_packno = 0;
+       l_current_pi = l_pi;
+
+       for     (pino = 0; pino <= l_tcp->numpocs; ++pino) {
+
+               while (pi_next(l_current_pi)) {
+
+                       if (l_tcp->num_layers_to_decode > l_current_pi->layno
+                                       && l_current_pi->resno < p_tile->comps[l_current_pi->compno].minimum_num_resolutions) {
+                               l_nb_bytes_read = 0;
+
+                               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)) {
+                                       pi_destroy_v2(l_pi,l_nb_pocs);
+                                       return OPJ_FALSE;
+                               }
+
+                               l_img_comp = &(l_image->comps[l_current_pi->compno]);
+                               l_img_comp->resno_decoded = uint_max(l_current_pi->resno, l_img_comp->resno_decoded);
+                       }
+                       else {
+                               l_nb_bytes_read = 0;
+                               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)) {
+                                       pi_destroy_v2(l_pi,l_nb_pocs);
+                                       return OPJ_FALSE;
+                               }
+                       }
+
+                       l_current_data += l_nb_bytes_read;
+                       p_max_len -= l_nb_bytes_read;
+
+                       /* INDEX >> */
+                       if(p_cstr_info) {
+                               opj_tile_info_v2_t *info_TL = &p_cstr_info->tile[p_tile_no];
+                               opj_packet_info_t *info_PK = &info_TL->packet[p_cstr_info->packno];
+                               if (!p_cstr_info->packno) {
+                                       info_PK->start_pos = info_TL->end_header + 1;
+                               } 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
+                                       info_TL->tp[curtp].tp_numpacks = p_cstr_info->packno - tp_start_packno; // Number of packets in previous tile-part
+                                       tp_start_packno = p_cstr_info->packno;
+                                       curtp++;
+                                       info_PK->start_pos = p_cstr_info->tile[p_tile_no].tp[curtp].tp_end_header+1;
+                               } else {
+                                       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;
+                               }
+                               info_PK->end_pos = info_PK->start_pos + l_nb_bytes_read - 1;
+                               info_PK->end_ph_pos += info_PK->start_pos - 1;  // End of packet header which now only represents the distance
+                               ++p_cstr_info->packno;
+                       }
+                       /* << INDEX */
+               }
+               ++l_current_pi;
+       }
+       /* INDEX >> */
+       if
+               (p_cstr_info) {
+               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
+       }
+       /* << INDEX */
+
+       /* don't forget to release pi */
+       pi_destroy_v2(l_pi,l_nb_pocs);
+       *p_data_read = l_current_data - p_src;
+       return OPJ_TRUE;
 }
 
 /* ----------------------------------------------------------------------- */
@@ -684,9 +947,660 @@ opj_t2_t* t2_create(opj_common_ptr cinfo, opj_image_t *image, opj_cp_t *cp) {
        return t2;
 }
 
+/**
+ * Creates a Tier 2 handle
+ *
+ * @param      p_image         Source or destination image
+ * @param      p_cp            Image coding parameters.
+ * @return             a new T2 handle if successful, NULL otherwise.
+*/
+opj_t2_v2_t* t2_create_v2(
+                                       opj_image_header_t *p_image,
+                                       opj_cp_v2_t *p_cp)
+{
+       /* create the tcd structure */
+       opj_t2_v2_t *l_t2 = (opj_t2_v2_t*)opj_malloc(sizeof(opj_t2_v2_t));
+       if
+               (!l_t2)
+       {
+               return 00;
+       }
+       memset(l_t2,0,sizeof(opj_t2_t));
+       l_t2->image = p_image;
+       l_t2->cp = p_cp;
+       return l_t2;
+}
+
 void t2_destroy(opj_t2_t *t2) {
        if(t2) {
                opj_free(t2);
        }
 }
 
+void t2_destroy_v2(opj_t2_v2_t *t2) {
+       if(t2) {
+               opj_free(t2);
+       }
+}
+
+
+static opj_bool t2_decode_packet_v2(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info)
+{
+       opj_bool l_read_data;
+       OPJ_UINT32 l_nb_bytes_read = 0;
+       OPJ_UINT32 l_nb_total_bytes_read = 0;
+
+       *p_data_read = 0;
+
+       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)) {
+               return OPJ_FALSE;
+       }
+
+       p_src += l_nb_bytes_read;
+       l_nb_total_bytes_read += l_nb_bytes_read;
+       p_max_length -= l_nb_bytes_read;
+
+       /* we should read data for the packet */
+       if (l_read_data) {
+               l_nb_bytes_read = 0;
+
+               if (! t2_read_packet_data(p_t2,p_tile,p_pi,p_src,&l_nb_bytes_read,p_max_length,p_pack_info)) {
+                       return OPJ_FALSE;
+               }
+
+               l_nb_total_bytes_read += l_nb_bytes_read;
+       }
+
+       *p_data_read = l_nb_total_bytes_read;
+
+       return OPJ_FALSE;
+}
+
+static opj_bool t2_skip_packet(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info)
+{
+       opj_bool l_read_data;
+       OPJ_UINT32 l_nb_bytes_read = 0;
+       OPJ_UINT32 l_nb_total_bytes_read = 0;
+
+       *p_data_read = 0;
+
+       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))
+       {
+               return OPJ_FALSE;
+       }
+       p_src += l_nb_bytes_read;
+       l_nb_total_bytes_read += l_nb_bytes_read;
+       p_max_length -= l_nb_bytes_read;
+       /* we should read data for the packet */
+       if
+               (l_read_data)
+       {
+               l_nb_bytes_read = 0;
+               if
+                       (! t2_skip_packet_data(p_t2,p_tile,p_pi,&l_nb_bytes_read,p_max_length,p_pack_info))
+               {
+                       return OPJ_FALSE;
+               }
+               l_nb_total_bytes_read += l_nb_bytes_read;
+       }
+       *p_data_read = l_nb_total_bytes_read;
+       return OPJ_TRUE;
+}
+
+
+
+static opj_bool t2_read_packet_header(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                             opj_tcp_v2_t *p_tcp,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        opj_bool * p_is_data_present,
+                                                        OPJ_BYTE *p_src_data,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *p_pack_info)
+{
+       /* loop */
+       OPJ_UINT32 bandno, cblkno;
+       OPJ_UINT32 l_nb_code_blocks;
+       OPJ_UINT32 l_remaining_length;
+       OPJ_UINT32 l_header_length;
+       OPJ_UINT32 * l_modified_length_ptr = 00;
+       OPJ_BYTE *l_current_data = p_src_data;
+       opj_cp_v2_t *l_cp = p_t2->cp;
+       opj_bio_t *l_bio = 00;  /* BIO component */
+       opj_tcd_band_t *l_band = 00;
+       opj_tcd_cblk_dec_t* l_cblk = 00;
+       opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
+
+       OPJ_BYTE *l_header_data = 00;
+       OPJ_BYTE **l_header_data_start = 00;
+
+       OPJ_UINT32 l_present;
+
+       if
+               (p_pi->layno == 0)
+       {
+               l_band = l_res->bands;
+               /* reset tagtrees */
+               for
+                       (bandno = 0; bandno < l_res->numbands; ++bandno)
+               {
+                       opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
+
+                       if (
+                               ! ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0)))
+                       {
+                               tgt_reset(l_prc->incltree);
+                               tgt_reset(l_prc->imsbtree);
+                               l_cblk = l_prc->cblks.dec;
+                               l_nb_code_blocks = l_prc->cw * l_prc->ch;
+                               for
+                                       (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno)
+                               {
+                                       l_cblk->numsegs = 0;
+                                       l_cblk->real_num_segs = 0;
+                                       ++l_cblk;
+                               }
+                       }
+                       ++l_band;
+               }
+       }
+
+       /* SOP markers */
+
+       if (p_tcp->csty & J2K_CP_CSTY_SOP) {
+               if ((*l_current_data) != 0xff || (*(l_current_data + 1) != 0x91)) {
+                       // TODO opj_event_msg(t2->cinfo->event_mgr, EVT_WARNING, "Expected SOP marker\n");
+               } else {
+                       l_current_data += 6;
+               }
+
+               /** TODO : check the Nsop value */
+       }
+
+       /*
+       When the marker PPT/PPM is used the packet header are store in PPT/PPM marker
+       This part deal with this caracteristic
+       step 1: Read packet header in the saved structure
+       step 2: Return to codestream for decoding
+       */
+
+       l_bio = bio_create();
+       if
+               (! l_bio)
+       {
+               return OPJ_FALSE;
+       }
+
+       if
+               (l_cp->ppm == 1)
+       {               /* PPM */
+               l_header_data_start = &l_cp->ppm_data;
+               l_header_data = *l_header_data_start;
+               l_modified_length_ptr = &(l_cp->ppm_len);
+
+       }
+       else if
+               (p_tcp->ppt == 1)
+       {       /* PPT */
+               l_header_data_start = &(p_tcp->ppt_data);
+               l_header_data = *l_header_data_start;
+               l_modified_length_ptr = &(p_tcp->ppt_len);
+       }
+       else
+       {       /* Normal Case */
+               l_header_data_start = &(l_current_data);
+               l_header_data = *l_header_data_start;
+               l_remaining_length = p_src_data+p_max_length-l_header_data;
+               l_modified_length_ptr = &(l_remaining_length);
+       }
+       bio_init_dec(l_bio, l_header_data,*l_modified_length_ptr);
+       l_present = bio_read(l_bio, 1);
+       if
+               (!l_present)
+       {
+               bio_inalign(l_bio);
+               l_header_data += bio_numbytes(l_bio);
+               bio_destroy(l_bio);
+               /* EPH markers */
+               if (p_tcp->csty & J2K_CP_CSTY_EPH) {
+                       if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
+                               printf("Error : expected EPH marker\n");
+                       } else {
+                               l_header_data += 2;
+                       }
+               }
+               l_header_length = (l_header_data - *l_header_data_start);
+               *l_modified_length_ptr -= l_header_length;
+               *l_header_data_start += l_header_length;
+               /* << INDEX */
+               // End of packet header position. Currently only represents the distance to start of packet
+               // Will be updated later by incrementing with packet start value
+               if
+                       (p_pack_info)
+               {
+                       p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
+               }
+               /* INDEX >> */
+               * p_is_data_present = OPJ_FALSE;
+               *p_data_read = l_current_data - p_src_data;
+               return OPJ_TRUE;
+       }
+
+       l_band = l_res->bands;
+       for
+               (bandno = 0; bandno < l_res->numbands; ++bandno)
+       {
+               opj_tcd_precinct_t *l_prc = &(l_band->precincts[p_pi->precno]);
+
+               if ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0))
+               {
+                       ++l_band;
+                       continue;
+               }
+               l_nb_code_blocks = l_prc->cw * l_prc->ch;
+               l_cblk = l_prc->cblks.dec;
+               for
+                       (cblkno = 0; cblkno < l_nb_code_blocks; cblkno++)
+               {
+                       OPJ_UINT32 l_included,l_increment, l_segno;
+                       OPJ_INT32 n;
+                       /* if cblk not yet included before --> inclusion tagtree */
+                       if
+                               (!l_cblk->numsegs)
+                       {
+                               l_included = tgt_decode(l_bio, l_prc->incltree, cblkno, p_pi->layno + 1);
+                               /* else one bit */
+                       }
+                       else
+                       {
+                               l_included = bio_read(l_bio, 1);
+                       }
+                       /* if cblk not included */
+                       if
+                               (!l_included)
+                       {
+                               l_cblk->numnewpasses = 0;
+                               ++l_cblk;
+                               continue;
+                       }
+                       /* if cblk not yet included --> zero-bitplane tagtree */
+                       if
+                               (!l_cblk->numsegs)
+                       {
+                               OPJ_UINT32 i = 0;
+                               while
+                                       (!tgt_decode(l_bio, l_prc->imsbtree, cblkno, i))
+                               {
+                                       ++i;
+                               }
+                               l_cblk->numbps = l_band->numbps + 1 - i;
+                               l_cblk->numlenbits = 3;
+                       }
+                       /* number of coding passes */
+                       l_cblk->numnewpasses = t2_getnumpasses(l_bio);
+                       l_increment = t2_getcommacode(l_bio);
+                       /* length indicator increment */
+                       l_cblk->numlenbits += l_increment;
+                       l_segno = 0;
+                       if
+                               (!l_cblk->numsegs)
+                       {
+                               if
+                                       (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 1))
+                               {
+                                       bio_destroy(l_bio);
+                                       return OPJ_FALSE;
+                               }
+
+                       }
+                       else
+                       {
+                               l_segno = l_cblk->numsegs - 1;
+                               if
+                                       (l_cblk->segs[l_segno].numpasses == l_cblk->segs[l_segno].maxpasses)
+                               {
+                                       ++l_segno;
+                                       if
+                                               (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0))
+                                       {
+                                               bio_destroy(l_bio);
+                                               return OPJ_FALSE;
+                                       }
+                               }
+                       }
+                       n = l_cblk->numnewpasses;
+
+                       do {
+                               l_cblk->segs[l_segno].numnewpasses = int_min(l_cblk->segs[l_segno].maxpasses - l_cblk->segs[l_segno].numpasses, n);
+                               l_cblk->segs[l_segno].newlen = bio_read(l_bio, l_cblk->numlenbits + uint_floorlog2(l_cblk->segs[l_segno].numnewpasses));
+                               n -= l_cblk->segs[l_segno].numnewpasses;
+                               if
+                                       (n > 0)
+                               {
+                                       ++l_segno;
+                                       if
+                                               (! t2_init_seg_v2(l_cblk, l_segno, p_tcp->tccps[p_pi->compno].cblksty, 0))
+                                       {
+                                               bio_destroy(l_bio);
+                                               return OPJ_FALSE;
+                                       }
+                               }
+                       }
+                       while (n > 0);
+                       ++l_cblk;
+               }
+               ++l_band;
+       }
+
+       if
+               (bio_inalign(l_bio))
+       {
+               bio_destroy(l_bio);
+               return OPJ_FALSE;
+       }
+
+       l_header_data += bio_numbytes(l_bio);
+       bio_destroy(l_bio);
+
+       /* EPH markers */
+       if (p_tcp->csty & J2K_CP_CSTY_EPH) {
+               if ((*l_header_data) != 0xff || (*(l_header_data + 1) != 0x92)) {
+                       // TODO opj_event_msg(t2->cinfo->event_mgr, EVT_ERROR, "Expected EPH marker\n");
+               } else {
+                       l_header_data += 2;
+               }
+       }
+
+
+       l_header_length = (l_header_data - *l_header_data_start);
+       *l_modified_length_ptr -= l_header_length;
+       *l_header_data_start += l_header_length;
+       /* << INDEX */
+       // End of packet header position. Currently only represents the distance to start of packet
+       // Will be updated later by incrementing with packet start value
+       if
+               (p_pack_info)
+       {
+               p_pack_info->end_ph_pos = (OPJ_INT32)(l_current_data - p_src_data);
+       }
+       /* INDEX >> */
+       * p_is_data_present = OPJ_TRUE;
+       *p_data_read = l_current_data - p_src_data;
+       return OPJ_TRUE;
+}
+
+static opj_bool t2_read_packet_data(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_BYTE *p_src_data,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *pack_info)
+{
+       OPJ_UINT32 bandno, cblkno;
+       OPJ_UINT32 l_nb_code_blocks;
+       OPJ_BYTE *l_current_data = p_src_data;
+       opj_tcd_band_t *l_band = 00;
+       opj_tcd_cblk_dec_t* l_cblk = 00;
+       opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
+
+       l_band = l_res->bands;
+       for
+               (bandno = 0; bandno < l_res->numbands; ++bandno)
+       {
+               opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
+
+               if
+                       ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0))
+               {
+                       ++l_band;
+                       continue;
+               }
+               l_nb_code_blocks = l_prc->cw * l_prc->ch;
+               l_cblk = l_prc->cblks.dec;
+               for
+                       (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno)
+               {
+                       opj_tcd_seg_t *l_seg = 00;
+                       if
+                               (!l_cblk->numnewpasses)
+                       {
+                               /* nothing to do */
+                               ++l_cblk;
+                               continue;
+                       }
+                       if
+                               (!l_cblk->numsegs)
+                       {
+                               l_seg = l_cblk->segs;
+                               ++l_cblk->numsegs;
+                               l_cblk->len = 0;
+                       }
+                       else
+                       {
+                               l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
+                               if
+                                       (l_seg->numpasses == l_seg->maxpasses)
+                               {
+                                       ++l_seg;
+                                       ++l_cblk->numsegs;
+                               }
+                       }
+
+                       do
+                       {
+                               if
+                                       (l_current_data + l_seg->newlen > p_src_data + p_max_length)
+                               {
+                                       return OPJ_FALSE;
+                               }
+
+#ifdef USE_JPWL
+                       /* we need here a j2k handle to verify if making a check to
+                       the validity of cblocks parameters is selected from user (-W) */
+
+                               /* let's check that we are not exceeding */
+                               if ((cblk->len + seg->newlen) > 8192) {
+                                       opj_event_msg(t2->cinfo, EVT_WARNING,
+                                               "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
+                                               seg->newlen, cblkno, precno, bandno, resno, compno);
+                                       if (!JPWL_ASSUME) {
+                                               opj_event_msg(t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
+                                               return -999;
+                                       }
+                                       seg->newlen = 8192 - cblk->len;
+                                       opj_event_msg(t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", seg->newlen);
+                                       break;
+                               };
+
+#endif /* USE_JPWL */
+
+                               memcpy(l_cblk->data + l_cblk->len, l_current_data, l_seg->newlen);
+                               if
+                                       (l_seg->numpasses == 0)
+                               {
+                                       l_seg->data = &l_cblk->data;
+                                       l_seg->dataindex = l_cblk->len;
+                               }
+                               l_current_data += l_seg->newlen;
+                               l_seg->numpasses += l_seg->numnewpasses;
+                               l_cblk->numnewpasses -= l_seg->numnewpasses;
+
+                               l_seg->real_num_passes = l_seg->numpasses;
+                               l_cblk->len += l_seg->newlen;
+                               l_seg->len += l_seg->newlen;
+                               if
+                                       (l_cblk->numnewpasses > 0)
+                               {
+                                       ++l_seg;
+                                       ++l_cblk->numsegs;
+                               }
+                       }
+                       while (l_cblk->numnewpasses > 0);
+                       l_cblk->real_num_segs = l_cblk->numsegs;
+                       ++l_cblk;
+               }
+               ++l_band;
+       }
+       *(p_data_read) = l_current_data - p_src_data;
+       return OPJ_TRUE;
+}
+
+static opj_bool t2_skip_packet_data(
+                                                        opj_t2_v2_t* p_t2,
+                                                        opj_tcd_tile_t *p_tile,
+                                                        opj_pi_iterator_t *p_pi,
+                                                        OPJ_UINT32 * p_data_read,
+                                                        OPJ_UINT32 p_max_length,
+                                                        opj_packet_info_t *pack_info)
+{
+       OPJ_UINT32 bandno, cblkno;
+       OPJ_UINT32 l_nb_code_blocks;
+       opj_tcd_band_t *l_band = 00;
+       opj_tcd_cblk_dec_t* l_cblk = 00;
+
+       opj_tcd_resolution_t* l_res = &p_tile->comps[p_pi->compno].resolutions[p_pi->resno];
+
+       *p_data_read = 0;
+       l_band = l_res->bands;
+       for
+               (bandno = 0; bandno < l_res->numbands; ++bandno)
+       {
+               opj_tcd_precinct_t *l_prc = &l_band->precincts[p_pi->precno];
+
+               if
+                       ((l_band->x1-l_band->x0 == 0)||(l_band->y1-l_band->y0 == 0))
+               {
+                       ++l_band;
+                       continue;
+               }
+               l_nb_code_blocks = l_prc->cw * l_prc->ch;
+               l_cblk = l_prc->cblks.dec;
+               for
+                       (cblkno = 0; cblkno < l_nb_code_blocks; ++cblkno)
+               {
+                       opj_tcd_seg_t *l_seg = 00;
+                       if
+                               (!l_cblk->numnewpasses)
+                       {
+                               /* nothing to do */
+                               ++l_cblk;
+                               continue;
+                       }
+                       if
+                               (!l_cblk->numsegs)
+                       {
+                               l_seg = l_cblk->segs;
+                               ++l_cblk->numsegs;
+                               l_cblk->len = 0;
+                       }
+                       else
+                       {
+                               l_seg = &l_cblk->segs[l_cblk->numsegs - 1];
+                               if
+                                       (l_seg->numpasses == l_seg->maxpasses)
+                               {
+                                       ++l_seg;
+                                       ++l_cblk->numsegs;
+                               }
+                       }
+
+                       do
+                       {
+                               if
+                                       (* p_data_read + l_seg->newlen > p_max_length)
+                               {
+                                       return OPJ_FALSE;
+                               }
+
+#ifdef USE_JPWL
+                       /* we need here a j2k handle to verify if making a check to
+                       the validity of cblocks parameters is selected from user (-W) */
+
+                               /* let's check that we are not exceeding */
+                               if ((cblk->len + seg->newlen) > 8192) {
+                                       opj_event_msg(t2->cinfo, EVT_WARNING,
+                                               "JPWL: segment too long (%d) for codeblock %d (p=%d, b=%d, r=%d, c=%d)\n",
+                                               seg->newlen, cblkno, precno, bandno, resno, compno);
+                                       if (!JPWL_ASSUME) {
+                                               opj_event_msg(t2->cinfo, EVT_ERROR, "JPWL: giving up\n");
+                                               return -999;
+                                       }
+                                       seg->newlen = 8192 - cblk->len;
+                                       opj_event_msg(t2->cinfo, EVT_WARNING, "      - truncating segment to %d\n", seg->newlen);
+                                       break;
+                               };
+
+#endif /* USE_JPWL */
+                               *(p_data_read) += l_seg->newlen;
+                               l_seg->numpasses += l_seg->numnewpasses;
+                               l_cblk->numnewpasses -= l_seg->numnewpasses;
+                               if
+                                       (l_cblk->numnewpasses > 0)
+                               {
+                                       ++l_seg;
+                                       ++l_cblk->numsegs;
+                               }
+                       }
+                       while (l_cblk->numnewpasses > 0);
+                       ++l_cblk;
+               }
+               ++l_band;
+       }
+       return OPJ_TRUE;
+}
+
+
+static opj_bool t2_init_seg_v2(opj_tcd_cblk_dec_t* cblk, OPJ_UINT32 index, OPJ_UINT32 cblksty, OPJ_UINT32 first)
+{
+       opj_tcd_seg_t* seg = 00;
+       OPJ_UINT32 l_nb_segs = index + 1;
+
+       if
+               (l_nb_segs > cblk->m_current_max_segs)
+       {
+               cblk->m_current_max_segs += J2K_DEFAULT_NB_SEGS;
+        cblk->segs = (opj_tcd_seg_t*) opj_realloc(cblk->segs, cblk->m_current_max_segs * sizeof(opj_tcd_seg_t));
+               if
+                       (! cblk->segs)
+               {
+                       return OPJ_FALSE;
+               }
+       }
+       seg = &cblk->segs[index];
+       memset(seg,0,sizeof(opj_tcd_seg_t));
+
+       if (cblksty & J2K_CCP_CBLKSTY_TERMALL) {
+               seg->maxpasses = 1;
+       }
+       else if (cblksty & J2K_CCP_CBLKSTY_LAZY) {
+               if (first) {
+                       seg->maxpasses = 10;
+               } else {
+                       seg->maxpasses = (((seg - 1)->maxpasses == 1) || ((seg - 1)->maxpasses == 10)) ? 2 : 1;
+               }
+       } else {
+               seg->maxpasses = 109;
+       }
+       return OPJ_TRUE;
+}