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