remove deprecated v1 style function j2k_read_cod
[openjpeg.git] / libopenjpeg / t2.c
index 76f435215a7af362f1fa0d33d107534d74da06ae..a091ef2230643e5a3c545de5f23a996ad0169fee 100644 (file)
@@ -58,6 +58,28 @@ Encode a packet of a tile to a destination buffer
 @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_codestream_info_t *cstr_info, int tileno);
+
+/**
+Encode a packet of a tile to a destination buffer
+@param tile Tile for which to write the packets
+@param tcp Tile coding parameters
+@param pi Packet identity
+@param dest Destination buffer
+@param len Length of the destination buffer
+@param cstr_info Codestream information structure
+@param tileno Number of the tile encoded
+@return
+*/
+static opj_bool t2_encode_packet_v2(
+                                                        OPJ_UINT32 tileno,
+                                                        opj_tcd_tile_v2_t *tile,
+                                                        opj_tcp_v2_t *tcp,
+                                                        opj_pi_iterator_t *pi,
+                                                        OPJ_BYTE *dest,
+                                                        OPJ_UINT32 * p_data_written,
+                                                        OPJ_UINT32 len,
+                                                        opj_codestream_info_t *cstr_info);
+
 /**
 @param cblk
 @param index
@@ -83,22 +105,23 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
 /**
 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
+@param src Source buffer
+@param pack_info Packet information
+
 @return
 */
 static opj_bool t2_decode_packet_v2(
-                                                        opj_t2_v2_t* p_t2,
-                                                        opj_tcd_tile_v2_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_t2_v2_t* t2,
+                                                        opj_tcd_tile_v2_t *tile,
+                             opj_tcp_v2_t *tcp,
+                                                        opj_pi_iterator_t *pi,
+                                                        OPJ_BYTE *src,
+                                                        OPJ_UINT32 * data_read,
+                                                        OPJ_UINT32 max_length,
+                                                        opj_packet_info_t *pack_info);
 
 static opj_bool t2_skip_packet(
                                                         opj_t2_v2_t* p_t2,
@@ -139,7 +162,8 @@ static opj_bool t2_skip_packet_data(
                                                         opj_packet_info_t *pack_info);
 
 /**
-@param seg
+@param cblk
+@param index
 @param cblksty
 @param first
 */
@@ -324,8 +348,8 @@ static int t2_encode_packet(opj_tcd_tile_t * tile, opj_tcp_t * tcp, opj_pi_itera
        /* </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
+       /* 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);
@@ -472,8 +496,8 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
                }
 
                /* << 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
+               /* 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);
                }
@@ -572,8 +596,8 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
        }
 
        /* << 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
+       /* 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);
        }
@@ -637,7 +661,7 @@ static int t2_decode_packet(opj_t2_t* t2, unsigned char *src, int len, opj_tcd_t
 
 #endif /* USE_JPWL */
                                
-                               cblk->data = (unsigned char*) opj_realloc(cblk->data, (cblk->len + seg->newlen) * sizeof(unsigned char*));
+                               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;
@@ -731,8 +755,8 @@ int t2_encode_packets(opj_t2_t* t2,int tileno, opj_tcd_tile_t *tile, int maxlaye
                                                        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_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++;
@@ -752,6 +776,128 @@ int t2_encode_packets(opj_t2_t* t2,int tileno, opj_tcd_tile_t *tile, int maxlaye
   return (c - dest);
 }
 
+opj_bool t2_encode_packets_v2(
+                                          opj_t2_v2_t* p_t2,
+                                          OPJ_UINT32 p_tile_no,
+                                          opj_tcd_tile_v2_t *p_tile,
+                                          OPJ_UINT32 p_maxlayers,
+                                          OPJ_BYTE *p_dest,
+                                          OPJ_UINT32 * p_data_written,
+                                          OPJ_UINT32 p_max_len,
+                                          opj_codestream_info_t *cstr_info,
+                                          OPJ_UINT32 p_tp_num,
+                                          OPJ_INT32 p_tp_pos,
+                                          OPJ_UINT32 p_pino,
+                                          J2K_T2_MODE p_t2_mode)
+{
+       OPJ_BYTE *l_current_data = p_dest;
+       OPJ_UINT32 l_nb_bytes = 0;
+       OPJ_UINT32 compno;
+       OPJ_UINT32 poc;
+       opj_pi_iterator_t *l_pi = 00;
+       opj_pi_iterator_t *l_current_pi = 00;
+       opj_image_t *l_image = p_t2->image;
+       opj_cp_v2_t *l_cp = p_t2->cp;
+       opj_tcp_v2_t *l_tcp = &l_cp->tcps[p_tile_no];
+       OPJ_UINT32 pocno = l_cp->m_specific_param.m_enc.m_cinema == CINEMA4K_24? 2: 1;
+       OPJ_UINT32 l_max_comp = l_cp->m_specific_param.m_enc.m_max_comp_size > 0 ? l_image->numcomps : 1;
+       OPJ_UINT32 l_nb_pocs = l_tcp->numpocs + 1;
+
+       l_pi = pi_initialise_encode_v2(l_image, l_cp, p_tile_no, p_t2_mode);
+       if (!l_pi) {
+               return OPJ_FALSE;
+       }
+
+       * p_data_written = 0;
+
+       if (p_t2_mode == THRESH_CALC ){ /* Calculating threshold */
+               l_current_pi = l_pi;
+
+               for     (compno = 0; compno < l_max_comp; ++compno) {
+                       OPJ_UINT32 l_comp_len = 0;
+                       l_current_pi = l_pi;
+
+                       for (poc = 0; poc < pocno ; ++poc) {
+                               OPJ_UINT32 l_tp_num = compno;
+
+                               pi_create_encode_v2(l_pi, l_cp,p_tile_no,poc,l_tp_num,p_tp_pos,p_t2_mode);
+
+                               while (pi_next(l_current_pi)) {
+                                       if (l_current_pi->layno < p_maxlayers) {
+                                               l_nb_bytes = 0;
+
+                                               if (! t2_encode_packet_v2(p_tile_no,p_tile, l_tcp, l_current_pi, l_current_data, &l_nb_bytes, p_max_len, cstr_info)) {
+                                                       pi_destroy_v2(l_pi, l_nb_pocs);
+                                                       return OPJ_FALSE;
+                                               }
+
+                                               l_comp_len += l_nb_bytes;
+                                               l_current_data += l_nb_bytes;
+                                               p_max_len -= l_nb_bytes;
+
+                                               * p_data_written += l_nb_bytes;
+                                       }
+                               }
+
+                               if (l_cp->m_specific_param.m_enc.m_max_comp_size) {
+                                       if (l_comp_len > l_cp->m_specific_param.m_enc.m_max_comp_size) {
+                                               pi_destroy_v2(l_pi, l_nb_pocs);
+                                               return OPJ_FALSE;
+                                       }
+                               }
+
+                               ++l_current_pi;
+                       }
+               }
+       }
+       else {  /* t2_mode == FINAL_PASS  */
+               pi_create_encode_v2(l_pi, l_cp,p_tile_no,p_pino,p_tp_num,p_tp_pos,p_t2_mode);
+
+               l_current_pi = &l_pi[p_pino];
+
+               while (pi_next(l_current_pi)) {
+                       if (l_current_pi->layno < p_maxlayers) {
+                               l_nb_bytes=0;
+
+                               if (! t2_encode_packet_v2(p_tile_no,p_tile, l_tcp, l_current_pi, l_current_data, &l_nb_bytes, p_max_len, cstr_info)) {
+                                       pi_destroy_v2(l_pi, l_nb_pocs);
+                                       return OPJ_FALSE;
+                               }
+
+                               l_current_data += l_nb_bytes;
+                               p_max_len -= l_nb_bytes;
+
+                               * p_data_written += l_nb_bytes;
+
+                               /* INDEX >> */
+                               if(cstr_info) {
+                                       if(cstr_info->index_write) {
+                                               opj_tile_info_t *info_TL = &cstr_info->tile[p_tile_no];
+                                               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 = ((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;
+                                               }
+                                               info_PK->end_pos = info_PK->start_pos + l_nb_bytes - 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 */
+                               ++p_tile->packno;
+                       }
+               }
+       }
+
+       pi_destroy_v2(l_pi, l_nb_pocs);
+
+       return OPJ_TRUE;
+}
+
+
 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;
@@ -797,8 +943,8 @@ int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj
                                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
+                               } 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++;
@@ -807,8 +953,8 @@ int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj
                                        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
+                               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 */
@@ -822,7 +968,7 @@ int t2_decode_packets(opj_t2_t *t2, unsigned char *src, int len, int tileno, opj
        }
        /* 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_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 */
@@ -844,12 +990,12 @@ opj_bool t2_decode_packets_v2(
                                                OPJ_BYTE *p_src,
                                                OPJ_UINT32 * p_data_read,
                                                OPJ_UINT32 p_max_len,
-                                               struct opj_codestream_info_v2 *p_cstr_info)
+                                               opj_codestream_index_t *p_cstr_index)
 {
        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_image_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]);
@@ -859,12 +1005,13 @@ opj_bool t2_decode_packets_v2(
        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;
+       opj_image_comp_t* l_img_comp = 00;
 
-
-       if (p_cstr_info) {
-               l_pack_info = p_cstr_info->tile[p_tile_no].packet;
+#ifdef TODO_MSD
+       if (p_cstr_index) {
+               l_pack_info = p_cstr_index->tile_index[p_tile_no].packet;
        }
+#endif
 
        /* create a packet iterator */
        l_pi = pi_create_decode_v2(l_image, l_cp, p_tile_no);
@@ -877,12 +1024,23 @@ opj_bool t2_decode_packets_v2(
 
        for     (pino = 0; pino <= l_tcp->numpocs; ++pino) {
 
+               /* if the resolution needed is to low, one dim of the tilec could be equal to zero
+                * and no packets are used to encode this resolution and
+                * l_current_pi->resno is always >= p_tile->comps[l_current_pi->compno].minimum_num_resolutions
+                * and no l_img_comp->resno_decoded are computed
+                */
+               opj_bool* first_pass_failed = (opj_bool*)opj_malloc(l_image->numcomps * sizeof(opj_bool));
+               memset(first_pass_failed, OPJ_TRUE, l_image->numcomps * sizeof(opj_bool));
+
                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;
 
+                               first_pass_failed[l_current_pi->compno] = OPJ_FALSE;
+
                                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;
@@ -899,6 +1057,12 @@ opj_bool t2_decode_packets_v2(
                                }
                        }
 
+                       if (first_pass_failed[l_current_pi->compno]) {
+                               l_img_comp = &(l_image->comps[l_current_pi->compno]);
+                               if (l_img_comp->resno_decoded == 0)
+                                       l_img_comp->resno_decoded = p_tile->comps[l_current_pi->compno].minimum_num_resolutions - 1;
+                       }
+
                        l_current_data += l_nb_bytes_read;
                        p_max_len -= l_nb_bytes_read;
 
@@ -909,8 +1073,8 @@ opj_bool t2_decode_packets_v2(
                                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
+                               } 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;
@@ -918,19 +1082,21 @@ opj_bool t2_decode_packets_v2(
                                        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
+                               info_PK->end_ph_pos += info_PK->start_pos - 1;  /* End of packet header which now only represents the distance */
                                ++p_cstr_info->packno;
                        }
 #endif
                        /* << INDEX */
                }
                ++l_current_pi;
+
+               opj_free(first_pass_failed);
        }
        /* INDEX >> */
 #ifdef TODO_MSD
        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
+               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 */
        }
 #endif
        /* << INDEX */
@@ -961,20 +1127,19 @@ opj_t2_t* t2_create(opj_common_ptr cinfo, opj_image_t *image, opj_cp_t *cp) {
  * @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)
+opj_t2_v2_t* t2_create_v2(     opj_image_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;
+       if (!l_t2) {
+               return NULL;
        }
-       memset(l_t2,0,sizeof(opj_t2_t));
+       memset(l_t2,0,sizeof(opj_t2_v2_t));
+
        l_t2->image = p_image;
        l_t2->cp = p_cp;
+
        return l_t2;
 }
 
@@ -1031,6 +1196,232 @@ static opj_bool t2_decode_packet_v2(
        return OPJ_TRUE;
 }
 
+static opj_bool t2_encode_packet_v2(
+                                                        OPJ_UINT32 tileno,
+                                                        opj_tcd_tile_v2_t * tile,
+                                                        opj_tcp_v2_t * tcp,
+                                                        opj_pi_iterator_t *pi,
+                                                        OPJ_BYTE *dest,
+                                                        OPJ_UINT32 * p_data_written,
+                                                        OPJ_UINT32 length,
+                                                        opj_codestream_info_t *cstr_info)
+{
+       OPJ_UINT32 bandno, cblkno;
+       OPJ_BYTE *c = dest;
+       OPJ_UINT32 l_nb_bytes;
+       OPJ_UINT32 compno = pi->compno; /* component value */
+       OPJ_UINT32 resno  = pi->resno;          /* resolution level value */
+       OPJ_UINT32 precno = pi->precno; /* precinct value */
+       OPJ_UINT32 layno  = pi->layno;          /* quality layer value */
+       OPJ_UINT32 l_nb_blocks;
+       opj_tcd_band_v2_t *band = 00;
+       opj_tcd_cblk_enc_v2_t* cblk = 00;
+       opj_tcd_pass_v2_t *pass = 00;
+
+       opj_tcd_tilecomp_v2_t *tilec = &tile->comps[compno];
+       opj_tcd_resolution_v2_t *res = &tilec->resolutions[resno];
+
+       opj_bio_t *bio = 00;    /* BIO component */
+
+       /* <SOP 0xff91> */
+       if (tcp->csty & J2K_CP_CSTY_SOP) {
+               c[0] = 255;
+               c[1] = 145;
+               c[2] = 0;
+               c[3] = 4;
+               c[4] = (tile->packno % 65536) / 256;
+               c[5] = (tile->packno % 65536) % 256;
+               c += 6;
+               length -= 6;
+       }
+       /* </SOP> */
+
+       if (!layno) {
+               band = res->bands;
+
+               for(bandno = 0; bandno < res->numbands; ++bandno) {
+                       opj_tcd_precinct_v2_t *prc = &band->precincts[precno];
+
+                       tgt_reset(prc->incltree);
+                       tgt_reset(prc->imsbtree);
+
+                       l_nb_blocks = prc->cw * prc->ch;
+                       for     (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
+                               opj_tcd_cblk_enc_v2_t* cblk = &prc->cblks.enc[cblkno];
+
+                               cblk->numpasses = 0;
+                               tgt_setvalue(prc->imsbtree, cblkno, band->numbps - cblk->numbps);
+                       }
+                       ++band;
+               }
+       }
+
+       bio = bio_create();
+       bio_init_enc(bio, c, length);
+       bio_write(bio, 1, 1);           /* Empty header bit */
+
+       /* Writing Packet header */
+       band = res->bands;
+       for (bandno = 0; bandno < res->numbands; ++bandno)      {
+               opj_tcd_precinct_v2_t *prc = &band->precincts[precno];
+
+               l_nb_blocks = prc->cw * prc->ch;
+               cblk = prc->cblks.enc;
+
+               for (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
+                       opj_tcd_layer_t *layer = &cblk->layers[layno];
+
+                       if (!cblk->numpasses && layer->numpasses) {
+                               tgt_setvalue(prc->incltree, cblkno, layno);
+                       }
+
+                       ++cblk;
+               }
+
+               cblk = prc->cblks.enc;
+               for (cblkno = 0; cblkno < l_nb_blocks; cblkno++) {
+                       opj_tcd_layer_t *layer = &cblk->layers[layno];
+                       OPJ_UINT32 increment = 0;
+                       OPJ_UINT32 nump = 0;
+                       OPJ_UINT32 len = 0, passno;
+                       OPJ_UINT32 l_nb_passes;
+
+                       /* cblk inclusion bits */
+                       if (!cblk->numpasses) {
+                               tgt_encode(bio, prc->incltree, cblkno, layno + 1);
+                       } else {
+                               bio_write(bio, layer->numpasses != 0, 1);
+                       }
+
+                       /* if cblk not included, go to the next cblk  */
+                       if (!layer->numpasses) {
+                               ++cblk;
+                               continue;
+                       }
+
+                       /* if first instance of cblk --> zero bit-planes information */
+                       if (!cblk->numpasses) {
+                               cblk->numlenbits = 3;
+                               tgt_encode(bio, prc->imsbtree, cblkno, 999);
+                       }
+
+                       /* number of coding passes included */
+                       t2_putnumpasses(bio, layer->numpasses);
+                       l_nb_passes = cblk->numpasses + layer->numpasses;
+                       pass = cblk->passes +  cblk->numpasses;
+
+                       /* computation of the increase of the length indicator and insertion in the header     */
+                       for (passno = cblk->numpasses; passno < l_nb_passes; ++passno) {
+                               ++nump;
+                               len += pass->len;
+
+                               if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
+                                       increment = int_max(increment, int_floorlog2(len) + 1 - (cblk->numlenbits + int_floorlog2(nump)));
+                                       len = 0;
+                                       nump = 0;
+                               }
+
+                               ++pass;
+                       }
+                       t2_putcommacode(bio, increment);
+
+                       /* computation of the new Length indicator */
+                       cblk->numlenbits += increment;
+
+                       pass = cblk->passes +  cblk->numpasses;
+                       /* insertion of the codeword segment length */
+                       for (passno = cblk->numpasses; passno < l_nb_passes; ++passno) {
+                               nump++;
+                               len += pass->len;
+
+                               if (pass->term || passno == (cblk->numpasses + layer->numpasses) - 1) {
+                                       bio_write(bio, len, cblk->numlenbits + int_floorlog2(nump));
+                                       len = 0;
+                                       nump = 0;
+                               }
+                               ++pass;
+                       }
+
+                       ++cblk;
+               }
+
+               ++band;
+       }
+
+       if (bio_flush(bio)) {
+               bio_destroy(bio);
+               return OPJ_FALSE;               /* modified to eliminate longjmp !! */
+       }
+
+       l_nb_bytes = bio_numbytes(bio);
+       c += l_nb_bytes;
+       length -= l_nb_bytes;
+
+       bio_destroy(bio);
+
+       /* <EPH 0xff92> */
+       if (tcp->csty & J2K_CP_CSTY_EPH) {
+               c[0] = 255;
+               c[1] = 146;
+               c += 2;
+               length -= 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 = (OPJ_INT32)(c - dest);
+       }
+       /* INDEX >> */
+
+       /* Writing the packet body */
+       band = res->bands;
+       for (bandno = 0; bandno < res->numbands; bandno++) {
+               opj_tcd_precinct_v2_t *prc = &band->precincts[precno];
+
+               l_nb_blocks = prc->cw * prc->ch;
+               cblk = prc->cblks.enc;
+
+               for (cblkno = 0; cblkno < l_nb_blocks; ++cblkno) {
+                       opj_tcd_layer_t *layer = &cblk->layers[layno];
+
+                       if (!layer->numpasses) {
+                               ++cblk;
+                               continue;
+                       }
+
+                       if (layer->len > length) {
+                               return OPJ_FALSE;
+                       }
+
+                       memcpy(c, layer->data, layer->len);
+                       cblk->numpasses += layer->numpasses;
+                       c += layer->len;
+                       length -= layer->len;
+
+                       /* << 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 (cstr_info->D_max < info_PK->disto) {
+                                       cstr_info->D_max = info_PK->disto;
+                               }
+                       }
+
+                       ++cblk;
+                       /* INDEX >> */
+               }
+               ++band;
+       }
+
+       * p_data_written += (c - dest);
+
+       return OPJ_TRUE;
+}
+
 static opj_bool t2_skip_packet(
                                                         opj_t2_v2_t* p_t2,
                                                         opj_tcd_tile_v2_t *p_tile,
@@ -1129,7 +1520,7 @@ static opj_bool t2_read_packet_header(
 
        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");
+                       /* TODO opj_event_msg(t2->cinfo->event_mgr, EVT_WARNING, "Expected SOP marker\n"); */
                } else {
                        l_current_data += 6;
                }
@@ -1189,8 +1580,8 @@ static opj_bool t2_read_packet_header(
                *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
+               /* 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);
                }
@@ -1302,7 +1693,7 @@ static opj_bool t2_read_packet_header(
        /* 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");
+                       /* TODO opj_event_msg(t2->cinfo->event_mgr, EVT_ERROR, "Expected EPH marker\n"); */
                } else {
                        l_header_data += 2;
                }
@@ -1313,8 +1704,8 @@ static opj_bool t2_read_packet_header(
        *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
+       /* 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);
        }