start using API style in openJPIP library
[openjpeg.git] / applications / jpip / libopenjpip / jp2k_encoder.c
1 /*
2  * $Id$
3  *
4  * Copyright (c) 2002-2011, Communications and Remote Sensing Laboratory, Universite catholique de Louvain (UCL), Belgium
5  * Copyright (c) 2002-2011, Professor Benoit Macq
6  * Copyright (c) 2010-2011, Kaori Hagihara
7  * Copyright (c) 2011,      Lucian Corlaciu, GSoC
8  * All rights reserved.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
20  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
23  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29  * POSSIBILITY OF SUCH DAMAGE.
30  */
31
32 #include <stdio.h>
33 #include <stdlib.h>
34 #include <string.h>
35 #include <math.h>
36 #include "jp2k_encoder.h"
37 #include "j2kheader_manager.h"
38 #include "imgreg_manager.h"
39
40
41 #ifdef SERVER
42 #include "fcgi_stdio.h"
43 #define logstream FCGI_stdout
44 #else
45 #define FCGI_stdout stdout
46 #define FCGI_stderr stderr
47 #define logstream stderr
48 #endif //SERVER
49
50
51 /**
52  * search a message by class_id
53  *
54  * @param[in] class_id    class identifiers 
55  * @param[in] in_class_id in-class identifiers, -1 means any
56  * @param[in] csn         codestream number
57  * @param[in] msg         first message pointer of the searching list
58  * @return                found message pointer
59  */
60 message_param_t * search_message( Byte8_t class_id, Byte8_t in_class_id, Byte8_t csn, message_param_t *msg);
61
62 /**
63  * reconstruct j2k codestream from JPT- (in future, JPP-) stream
64  *
65  * @param[in]  msgqueue   message queue pointer
66  * @param[in]  jpipstream original JPT- JPP- stream 
67  * @param[in]  csn        codestream number
68  * @param[in]  fw         reconstructing image frame width
69  * @param[in]  fh         reconstructing image frame height
70  * @param[out] codelen   codestream length
71  * @return               generated reconstructed j2k codestream
72  */
73 Byte_t * recons_codestream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *codelen);
74
75 Byte_t * recons_j2k( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen)
76 {
77   Byte_t *j2kstream = NULL;
78   
79   if( !msgqueue)
80     return NULL;
81   
82   j2kstream = recons_codestream( msgqueue, jpipstream, csn, fw, fh, j2klen);
83
84   return j2kstream;
85 }
86
87 Byte_t * add_emptyboxstream( placeholder_param_t *phld, Byte_t *jp2stream, Byte8_t *jp2len);
88 Byte_t * add_msgstream( message_param_t *message, Byte_t *origstream, Byte_t *j2kstream, Byte8_t *j2klen);
89
90 Byte_t * recons_jp2( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, Byte8_t *jp2len)
91 {
92   message_param_t *ptr;
93   Byte_t *jp2stream = NULL;
94   Byte_t *codestream = NULL;
95   Byte8_t codelen;
96   Byte8_t jp2cDBoxOffset = 0, jp2cDBoxlen = 0;
97   
98   *jp2len = 0;
99
100   if( !msgqueue)
101     return NULL;
102     
103   ptr = msgqueue->first;
104   while(( ptr = search_message( METADATA_MSG, -1, csn, ptr))!=NULL){
105     if( ptr->phld){
106       if( strncmp( (char *)ptr->phld->OrigBH+4, "jp2c", 4) == 0){
107         jp2cDBoxOffset = *jp2len + ptr->phld->OrigBHlen;
108         jp2stream = add_emptyboxstream( ptr->phld, jp2stream, jp2len); // header only
109         jp2cDBoxlen = *jp2len - jp2cDBoxOffset;
110       }
111       else
112         jp2stream = add_emptyboxstream( ptr->phld, jp2stream, jp2len); // header only
113     }
114     jp2stream = add_msgstream( ptr, jpipstream, jp2stream, jp2len);
115     ptr = ptr->next;
116   }
117   
118   codestream = recons_codestream( msgqueue, jpipstream, csn, 0, 0, &codelen);
119   
120   if( jp2cDBoxOffset != 0 && codelen <= jp2cDBoxlen)
121     memcpy( jp2stream+jp2cDBoxOffset, codestream, codelen);
122
123   free( codestream);
124   
125   return jp2stream;
126 }
127
128 bool isJPPstream( Byte8_t csn, msgqueue_param_t *msgqueue);
129
130 Byte_t * recons_codestream_from_JPTstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh,  Byte8_t *j2klen);
131 Byte_t * recons_codestream_from_JPPstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen);
132
133 Byte_t * add_EOC( Byte_t *j2kstream, Byte8_t *j2klen);
134
135 Byte_t * recons_codestream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *codelen)
136 {
137   if( isJPPstream( csn, msgqueue))
138     return recons_codestream_from_JPPstream( msgqueue, jpipstream, csn, fw, fh, codelen);
139   else
140     return recons_codestream_from_JPTstream( msgqueue, jpipstream, csn, fw, fh, codelen);   
141 }
142
143 bool isJPPstream( Byte8_t csn, msgqueue_param_t *msgqueue)
144 {
145   message_param_t *msg;
146   
147   msg = msgqueue->first;
148   while( msg){
149     if( msg->csn == csn){
150       if( msg->class_id <= 2)
151         return true;
152       else
153         if( msg->class_id == 4 || msg->class_id == 5)
154           return false;
155     }
156     msg = msg->next;
157   }
158   
159   fprintf( FCGI_stderr, "Error, message of csn %lld not found\n", csn);
160
161   return false;
162 }
163
164 Byte_t * add_mainhead_msgstream( msgqueue_param_t *msgqueue, Byte_t *origstream, Byte_t *j2kstream, Byte8_t csn, Byte8_t *j2klen);
165 Byte8_t get_last_tileID( msgqueue_param_t *msgqueue, Byte8_t csn, bool isJPPstream);
166 Byte_t * add_emptytilestream( const Byte8_t tileID, Byte_t *j2kstream, Byte8_t *j2klen);
167
168 Byte_t * recons_codestream_from_JPTstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh,  Byte8_t *j2klen)
169
170   Byte_t *j2kstream = NULL;
171   Byte8_t last_tileID, tileID;
172   bool found;
173   Byte8_t binOffset;
174   message_param_t *ptr;
175   SIZmarker_param_t SIZ;
176   int mindeclev;
177
178   *j2klen = 0;
179   j2kstream = add_mainhead_msgstream( msgqueue, jpipstream, j2kstream, csn, j2klen);
180
181   if( !get_mainheader_from_j2kstream( j2kstream, &SIZ, NULL))
182     return j2kstream;
183
184   if( fw <= 0 || fh <= 0)
185     mindeclev = 0;
186   else
187     mindeclev = comp_decomplev( fw, fh, SIZ.Xsiz, SIZ.Ysiz);
188  
189   last_tileID = get_last_tileID( msgqueue, csn, false);
190   
191   for( tileID=0; tileID <= last_tileID; tileID++){
192     found = false;
193     binOffset = 0;
194
195     ptr = msgqueue->first;
196     while(( ptr = search_message( TILE_MSG, tileID, csn, ptr))!=NULL){
197       if( ptr->bin_offset == binOffset){
198         found = true;
199         j2kstream = add_msgstream( ptr, jpipstream, j2kstream, j2klen);
200         binOffset += ptr->length;
201       }
202       ptr = ptr->next;
203     }
204     ptr = msgqueue->first;
205     while(( ptr = search_message( EXT_TILE_MSG, tileID, csn, ptr))!=NULL){
206       if( ptr->aux > mindeclev){
207         if( ptr->bin_offset == binOffset){
208           found = true;
209           j2kstream = add_msgstream( ptr, jpipstream, j2kstream, j2klen);
210           binOffset += ptr->length;
211         }
212       }
213       ptr = ptr->next;
214     }
215     if(!found)
216       j2kstream = add_emptytilestream( tileID, j2kstream, j2klen);
217   }
218   
219   j2kstream = add_EOC( j2kstream, j2klen);
220
221   return j2kstream;
222 }
223
224 Byte_t * add_SOTmkr( Byte_t *j2kstream, Byte8_t *j2klen);
225
226 Byte_t * recons_bitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
227                            Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
228                            int *max_reslev, Byte8_t *j2klen);
229
230 Byte_t * recons_codestream_from_JPPstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen)
231 {
232   Byte_t *j2kstream = NULL;
233   Byte8_t tileID, last_tileID;
234   Byte8_t SOToffset;
235   bool foundTH;
236   Byte8_t binOffset;
237   message_param_t *ptr;
238   SIZmarker_param_t SIZ;
239   CODmarker_param_t COD;
240   int max_reslev, mindeclev;
241   
242   *j2klen = 0;
243   j2kstream = add_mainhead_msgstream( msgqueue, jpipstream, j2kstream, csn, j2klen);
244   
245   if( !get_mainheader_from_j2kstream( j2kstream, &SIZ, &COD))
246     return j2kstream;
247
248   if( fw == 0 || fh == 0)
249     mindeclev = 0;
250   else
251     mindeclev = comp_decomplev( fw, fh, SIZ.Xsiz, SIZ.Ysiz);
252   
253   max_reslev = -1;
254   last_tileID = get_last_tileID( msgqueue, csn, true); 
255   
256   for( tileID=0; tileID <= last_tileID; tileID++){
257     
258     ptr = msgqueue->first;
259     binOffset = 0;
260     foundTH = false;
261     SOToffset = *j2klen;
262     while(( ptr = search_message( TILE_HEADER_MSG, tileID, csn, ptr))!=NULL){
263       if( ptr->bin_offset == binOffset){
264         j2kstream = add_SOTmkr( j2kstream, j2klen);
265         j2kstream = add_msgstream( ptr, jpipstream, j2kstream, j2klen);
266         foundTH = true;
267         binOffset += ptr->length;
268       }
269       ptr = ptr->next;
270     }
271
272     if( foundTH){
273       j2kstream = recons_bitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, &max_reslev, j2klen);     
274       modify_tileheader( j2kstream, SOToffset, (max_reslev<COD.numOfdecomp ? max_reslev : -1), SIZ.Csiz, j2klen);
275     }
276     else
277       j2kstream = add_emptytilestream( tileID, j2kstream, j2klen);
278   }
279
280   if( max_reslev < COD.numOfdecomp)
281     if( !modify_mainheader( j2kstream, max_reslev, SIZ, COD, j2klen))
282       return j2kstream;
283
284   j2kstream = add_EOC( j2kstream, j2klen);
285   return j2kstream;
286 }
287
288 Byte_t * add_mainhead_msgstream( msgqueue_param_t *msgqueue, Byte_t *origstream, Byte_t *j2kstream, Byte8_t csn, Byte8_t *j2klen)
289 {
290   message_param_t *ptr;
291   Byte8_t binOffset;
292
293   ptr = msgqueue->first;
294   binOffset = 0;
295   
296   while(( ptr = search_message( MAINHEADER_MSG, -1, csn, ptr))!=NULL){
297     if( ptr->bin_offset == binOffset){
298       j2kstream = add_msgstream( ptr, origstream, j2kstream, j2klen);
299       binOffset += ptr->length;
300     }
301     ptr = ptr->next;
302   }
303   return j2kstream;
304 }
305
306 Byte_t * add_SOTmkr( Byte_t *j2kstream, Byte8_t *j2klen)
307 {
308   Byte_t *buf;
309   const Byte2_t SOT = 0x90ff;
310
311   buf = (Byte_t *)malloc(( *j2klen)+2);
312
313   memcpy( buf, j2kstream, *j2klen);
314   memcpy( buf+(*j2klen), &SOT, 2);
315   
316   *j2klen += 2;
317
318   if(j2kstream) free(j2kstream);
319
320   return buf;
321 }
322
323 Byte_t * recons_LRCPbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
324                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
325                                int *max_reslev, Byte8_t *j2klen);
326
327 Byte_t * recons_RLCPbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
328                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
329                                int *max_reslev, Byte8_t *j2klen);
330
331 Byte_t * recons_RPCLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
332                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
333                                int *max_reslev, Byte8_t *j2klen);
334
335 Byte_t * recons_PCRLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
336                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
337                                int *max_reslev, Byte8_t *j2klen);
338
339 Byte_t * recons_CPRLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
340                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
341                                int *max_reslev, Byte8_t *j2klen);
342
343 Byte_t * recons_bitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
344                            Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
345                            int *max_reslev, Byte8_t *j2klen)
346 {
347   switch( COD.prog_order){
348   case LRCP:
349     return recons_LRCPbitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, max_reslev, j2klen);
350   case RLCP:
351     return recons_RLCPbitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, max_reslev, j2klen);
352   case RPCL:
353     return recons_RPCLbitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, max_reslev, j2klen);
354   case PCRL:
355     return recons_PCRLbitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, max_reslev, j2klen);
356   case CPRL:
357     return recons_CPRLbitstream( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, mindeclev, max_reslev, j2klen);
358   default:
359     fprintf( FCGI_stderr, "Error, progression order not supported\n");
360   }
361   return j2kstream;
362 }
363
364 int comp_numOfprcts( Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int r);
365 Byte8_t comp_seqID( Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int r, int p);
366
367 Byte_t * recons_packet( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
368                         Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, 
369                         int comp_idx, int res_idx, int prct_idx, int lay_idx, Byte8_t *j2klen);
370
371 Byte_t * recons_LRCPbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
372                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
373                                int *max_reslev, Byte8_t *j2klen)
374 {
375   int r, p, c, l, numOfprcts;
376
377   for( l=0; l<COD.numOflayers; l++)
378     for( r=0; r<=(COD.numOfdecomp-mindeclev); r++){
379       if( COD.Scod & 0x01)
380         numOfprcts = comp_numOfprcts( tileID, SIZ, COD, r);
381       else
382         numOfprcts = 1;
383       
384       for( c=0; c<SIZ.Csiz; c++)
385         for( p=0; p<numOfprcts; p++)
386           j2kstream = recons_packet( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, max_reslev, c, r, p, l, j2klen);
387     }
388   
389   return j2kstream;
390 }
391
392 Byte_t * recons_RLCPbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
393                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
394                                int *max_reslev, Byte8_t *j2klen)
395 {
396   int r, p, c, l, numOfprcts;
397   
398   for( r=0; r<=(COD.numOfdecomp-mindeclev); r++){
399     if( COD.Scod & 0x01)
400       numOfprcts = comp_numOfprcts( tileID, SIZ, COD, r);
401     else
402       numOfprcts = 1;
403
404     for( l=0; l<COD.numOflayers; l++)
405       for( c=0; c<SIZ.Csiz; c++)
406         for( p=0; p<numOfprcts; p++)
407           j2kstream = recons_packet( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, max_reslev, c, r, p, l, j2klen);
408   }
409       
410   return j2kstream;
411 }
412
413 Byte_t * recons_precinct( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
414                           Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, 
415                           int comp_idx, int res_idx, Byte8_t seqID, Byte8_t *j2klen);
416
417 Byte_t * recons_RPCLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
418                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
419                                int *max_reslev, Byte8_t *j2klen)
420 {
421   int r, p, c, numOfprcts;
422   Byte8_t seqID;
423   
424   for( r=0, seqID=0; r<=(COD.numOfdecomp-mindeclev); r++){
425     
426     if( COD.Scod & 0x01)
427       numOfprcts = comp_numOfprcts( tileID, SIZ, COD, r);
428     else
429       numOfprcts = 1;
430     
431     for( p=0; p<numOfprcts; p++, seqID++)
432       for( c=0; c<SIZ.Csiz; c++)
433         j2kstream = recons_precinct( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, max_reslev, c, r, seqID, j2klen);
434   }
435       
436   return j2kstream;
437 }
438
439 Byte_t * recons_PCRLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
440                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
441                                int *max_reslev, Byte8_t *j2klen)
442 {
443   int r, p, c, min_numOfprcts, numOfprcts, min_numOfres;
444   Byte8_t seqID;
445   
446   min_numOfres = COD.numOfdecomp-mindeclev + 1;
447
448   if( COD.Scod & 0x01){
449     min_numOfprcts = 0;
450     for( r=0; r<min_numOfres; r++){
451       numOfprcts = comp_numOfprcts( tileID, SIZ, COD, r);
452       
453       if( numOfprcts < min_numOfprcts || min_numOfprcts == 0)
454         min_numOfprcts = numOfprcts;
455     }
456   }
457   else
458     min_numOfprcts = 1;
459   
460   for( p=0; p<min_numOfprcts; p++)
461     for( c=0; c<SIZ.Csiz; c++)
462       for( r=0; r<min_numOfres; r++){
463         seqID = comp_seqID( tileID, SIZ, COD, r, p);
464         j2kstream = recons_precinct( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, max_reslev, c, r, seqID, j2klen);
465       }
466     
467   return j2kstream;
468 }
469
470
471 Byte_t * recons_CPRLbitstream( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
472                                Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, 
473                                int *max_reslev, Byte8_t *j2klen)
474 {
475   int r, p, c, min_numOfprcts, numOfprcts, min_numOfres;
476   Byte8_t seqID;
477   
478   min_numOfres = COD.numOfdecomp-mindeclev + 1;
479
480   if( COD.Scod & 0x01){
481     min_numOfprcts = 0;
482     for( r=0; r<min_numOfres; r++){
483       numOfprcts = comp_numOfprcts( tileID, SIZ, COD, r);
484       
485       if( numOfprcts < min_numOfprcts || min_numOfprcts == 0)
486         min_numOfprcts = numOfprcts;
487     }
488   }
489   else
490     min_numOfprcts = 1;
491   
492   for( c=0; c<SIZ.Csiz; c++)
493     for( p=0; p<min_numOfprcts; p++)
494       for( r=0; r<min_numOfres; r++){
495         seqID = comp_seqID( tileID, SIZ, COD, r, p);
496         j2kstream = recons_precinct( msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, COD, max_reslev, c, r, seqID, j2klen);
497       }
498   
499   return j2kstream;
500 }
501
502 int comp_numOfprcts( Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int r)
503 {  
504   Byte4_t XTsiz, YTsiz;
505   
506   XTsiz = get_tile_XSiz( SIZ, tileID, COD.numOfdecomp-r);
507   YTsiz = get_tile_YSiz( SIZ, tileID, COD.numOfdecomp-r);
508   
509   return ceil((double)XTsiz/(double)COD.XPsiz[r])*ceil((double)YTsiz/(double)COD.YPsiz[r]);    
510 }
511
512 Byte_t * add_padding( Byte8_t padding, Byte_t *j2kstream, Byte8_t *j2klen);
513
514 Byte_t * recons_packet( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
515                         Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, 
516                         int comp_idx, int res_idx, int prct_idx, int lay_idx, Byte8_t *j2klen)
517 {
518   Byte8_t seqID, precID, binOffset;
519   message_param_t *ptr;
520   bool foundPrec;
521   int l;
522
523   seqID = comp_seqID( tileID, SIZ, COD, res_idx, prct_idx);
524   precID = comp_precinct_id( tileID, comp_idx, seqID, SIZ.Csiz, SIZ.XTnum*SIZ.YTnum);
525                   
526   ptr = msgqueue->first;
527   binOffset = 0;
528   foundPrec = false;
529   l = 0;
530           
531   while(( ptr = search_message( PRECINCT_MSG, precID, csn, ptr))!=NULL){
532     if( ptr->bin_offset == binOffset){
533       if( lay_idx == l){
534         j2kstream = add_msgstream( ptr, jpipstream, j2kstream, j2klen);
535         foundPrec = true;
536         if( *max_reslev < res_idx)
537           *max_reslev = res_idx;
538                 
539         break;
540       }
541       binOffset += ptr->length;
542       l++;
543     }
544     ptr = ptr->next;
545   }
546   if( !foundPrec && COD.Scod & 0x01)
547     j2kstream = add_padding( 1, j2kstream, j2klen);
548   
549   return j2kstream;
550 }
551
552
553 Byte_t * recons_precinct( msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte_t *j2kstream, Byte8_t csn, 
554                           Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, 
555                           int comp_idx, int res_idx, Byte8_t seqID, Byte8_t *j2klen)
556 {
557   Byte8_t precID, binOffset;
558   message_param_t *ptr;
559   bool foundPrec;
560
561   precID = comp_precinct_id( tileID, comp_idx, seqID, SIZ.Csiz, SIZ.XTnum*SIZ.YTnum);
562   
563   ptr = msgqueue->first;
564   binOffset = 0;
565   foundPrec = false;
566
567   while(( ptr = search_message( PRECINCT_MSG, precID, csn, ptr))!=NULL){
568     if( ptr->bin_offset == binOffset){
569       j2kstream = add_msgstream( ptr, jpipstream, j2kstream, j2klen);
570       
571       foundPrec = true;
572       binOffset += ptr->length;
573       if( *max_reslev < res_idx)
574         *max_reslev = res_idx;
575
576       if( ptr->last_byte)
577         break;
578     }
579     ptr = ptr->next;
580   }
581   if(!foundPrec && COD.Scod & 0x01)
582     j2kstream = add_padding( COD.numOflayers, j2kstream, j2klen);
583
584   return j2kstream;
585 }
586
587 Byte8_t comp_seqID( Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int r, int p)
588 {
589   Byte8_t seqID = 0;
590   int rr;
591   
592   for( rr=0; rr<r; rr++)
593     seqID += comp_numOfprcts( tileID, SIZ, COD, rr);
594   
595   seqID += p;
596   
597   return seqID;
598 }
599
600 Byte8_t get_last_tileID( msgqueue_param_t *msgqueue, Byte8_t csn, bool isJPPstream)
601 {
602   Byte8_t last_tileID = 0;
603   message_param_t *msg;
604   
605   msg = msgqueue->first;
606   while( msg){
607     if( isJPPstream){
608       if((msg->class_id == TILE_HEADER_MSG) && msg->csn == csn && last_tileID < msg->in_class_id)
609         last_tileID = msg->in_class_id;
610     }
611     else{
612       if((msg->class_id == TILE_MSG || msg->class_id == EXT_TILE_MSG) && msg->csn == csn && last_tileID < msg->in_class_id)
613         last_tileID = msg->in_class_id;
614     }
615     msg = msg->next;
616   }
617   return last_tileID;
618 }
619
620
621 message_param_t * search_message( Byte8_t class_id, Byte8_t in_class_id, Byte8_t csn, message_param_t *msg)
622 {
623   while( msg != NULL){
624     if( in_class_id == -1){
625       if( msg->class_id == class_id && msg->csn == csn)
626         return msg;
627     }
628     else{
629       if( msg->class_id == class_id && msg->in_class_id == in_class_id && msg->csn == csn)
630         return msg;
631     }
632     msg = msg->next;
633   }
634   return NULL;
635 }
636
637
638 Byte_t * gene_msgstream( message_param_t *message, Byte_t *stream, Byte8_t *length);
639 Byte_t * gene_emptytilestream( const Byte8_t tileID, Byte8_t *length);
640
641 Byte_t * add_msgstream( message_param_t *message, Byte_t *origstream, Byte_t *j2kstream, Byte8_t *j2klen)
642 {
643   Byte_t *newstream;
644   Byte8_t newlen;
645   Byte_t *buf;
646
647   if( !message)
648     return NULL;
649
650   newstream = gene_msgstream( message, origstream, &newlen);
651
652   buf = (Byte_t *)malloc(( *j2klen)+newlen);
653
654   memcpy( buf, j2kstream, *j2klen);
655   memcpy( buf+(*j2klen), newstream, newlen);
656   
657   *j2klen += newlen;
658   
659   free( newstream);
660   if(j2kstream) free(j2kstream);
661
662   return buf;
663 }
664  
665
666 Byte_t * add_emptyboxstream( placeholder_param_t *phld, Byte_t *jp2stream, Byte8_t *jp2len)
667 {
668   Byte_t *newstream;
669   Byte8_t newlen;
670   Byte_t *buf;
671   
672   if( phld->OrigBHlen == 8)
673     newlen = big4(phld->OrigBH);
674   else
675     newlen = big8(phld->OrigBH+8);
676
677   newstream = (Byte_t *)malloc( newlen);
678   memset( newstream, 0, newlen);
679   memcpy( newstream, phld->OrigBH, phld->OrigBHlen);
680
681   buf = (Byte_t *)malloc(( *jp2len)+newlen);
682
683   memcpy( buf, jp2stream, *jp2len);
684   memcpy( buf+(*jp2len), newstream, newlen);
685   
686   *jp2len += newlen;
687   
688   free( newstream);
689   if(jp2stream) free(jp2stream);
690
691   return buf;
692 }
693
694 Byte_t * add_emptytilestream( const Byte8_t tileID, Byte_t *j2kstream, Byte8_t *j2klen)
695 {
696   Byte_t *newstream;
697   Byte8_t newlen;
698   Byte_t *buf;
699
700   newstream = gene_emptytilestream( tileID, &newlen);
701
702   buf = (Byte_t *)malloc(( *j2klen)+newlen);
703
704   memcpy( buf, j2kstream, *j2klen);
705   memcpy( buf+(*j2klen), newstream, newlen);
706   
707   *j2klen += newlen;
708
709   free( newstream);
710   if(j2kstream) free(j2kstream);
711
712   return buf;
713 }
714
715 Byte_t * add_padding( Byte8_t padding, Byte_t *j2kstream, Byte8_t *j2klen)
716 {
717   Byte_t *buf;
718
719   buf = (Byte_t *)malloc(( *j2klen)+padding);
720
721   memcpy( buf, j2kstream, *j2klen);
722   memset( buf+(*j2klen), 0, padding);
723   
724   *j2klen += padding;
725
726   if(j2kstream) free(j2kstream);
727
728   return buf;
729 }
730
731 Byte_t * add_EOC( Byte_t *j2kstream, Byte8_t *j2klen)
732 {
733   Byte2_t EOC = 0xd9ff;
734
735   Byte_t *buf;
736
737   buf = (Byte_t *)malloc(( *j2klen)+2);
738
739   memcpy( buf, j2kstream, *j2klen);
740   memcpy( buf+(*j2klen), &EOC, 2);
741
742   *j2klen += 2;
743
744   if(j2kstream) free(j2kstream);
745
746   return buf;
747 }
748
749 Byte_t * gene_msgstream( message_param_t *message, Byte_t *stream, Byte8_t *length)
750 {
751   Byte_t *buf;
752
753   if( !message)
754     return NULL;
755
756   *length = message->length;
757   buf = (Byte_t *)malloc( *length);
758   memcpy( buf, stream+message->res_offset,  *length);
759
760   return buf;
761 }
762
763 Byte_t * gene_emptytilestream( const Byte8_t tileID, Byte8_t *length)
764 {
765   Byte_t *buf;
766   const Byte2_t SOT = 0x90ff;
767   const Byte2_t Lsot = 0xa << 8;
768   Byte2_t Isot;
769   const Byte4_t Psot = 0xe << 24;
770   const Byte_t TPsot = 0, TNsot = 1;
771   const Byte2_t SOD = 0x93ff;
772
773   *length = 14;
774   buf = (Byte_t *)malloc(*length);
775
776   Isot = (((Byte2_t)tileID) << 8) | ((((Byte2_t)tileID) & 0xf0) >> 8);
777   
778   memcpy( buf, &SOT, 2);
779   memcpy( buf+2, &Lsot, 2);
780   memcpy( buf+4, &Isot, 2);
781   memcpy( buf+6, &Psot, 4);
782   memcpy( buf+10, &TPsot, 1);
783   memcpy( buf+11, &TNsot, 1);
784   memcpy( buf+12, &SOD, 2);
785
786   return buf;
787 }