| /* |
| * $Id$ |
| * |
| * Copyright (c) 2002-2014, Universite catholique de Louvain (UCL), Belgium |
| * Copyright (c) 2002-2014, Professor Benoit Macq |
| * Copyright (c) 2010-2011, Kaori Hagihara |
| * Copyright (c) 2011, Lucian Corlaciu, GSoC |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * 1. Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * 2. Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS' |
| * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| * POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <math.h> |
| #include <assert.h> |
| #include <inttypes.h> |
| #include "jp2k_encoder.h" |
| #include "j2kheader_manager.h" |
| #include "imgreg_manager.h" |
| |
| |
| #ifdef SERVER |
| #include "fcgi_stdio.h" |
| #define logstream FCGI_stdout |
| #else |
| #define FCGI_stdout stdout |
| #define FCGI_stderr stderr |
| #define logstream stderr |
| #endif /*SERVER*/ |
| |
| |
| /** |
| * search a message by class_id |
| * |
| * @param[in] class_id class identifiers |
| * @param[in] in_class_id in-class identifiers, -1 means any |
| * @param[in] csn codestream number |
| * @param[in] msg first message pointer of the searching list |
| * @return found message pointer |
| */ |
| message_param_t * search_message(Byte8_t class_id, Byte8_t in_class_id, |
| Byte8_t csn, message_param_t *msg); |
| |
| /** |
| * reconstruct j2k codestream from JPT- (in future, JPP-) stream |
| * |
| * @param[in] msgqueue message queue pointer |
| * @param[in] jpipstream original JPT- JPP- stream |
| * @param[in] csn codestream number |
| * @param[in] fw reconstructing image frame width |
| * @param[in] fh reconstructing image frame height |
| * @param[out] codelen codestream length |
| * @return generated reconstructed j2k codestream |
| */ |
| Byte_t * recons_codestream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte8_t csn, int fw, int fh, Byte8_t *codelen); |
| |
| Byte_t * recons_j2k(msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, |
| int fw, int fh, Byte8_t *j2klen) |
| { |
| Byte_t *j2kstream = NULL; |
| |
| if (!msgqueue) { |
| return NULL; |
| } |
| |
| j2kstream = recons_codestream(msgqueue, jpipstream, csn, fw, fh, j2klen); |
| |
| return j2kstream; |
| } |
| |
| Byte_t * add_emptyboxstream(placeholder_param_t *phld, Byte_t *jp2stream, |
| Byte8_t *jp2len); |
| Byte_t * add_msgstream(message_param_t *message, Byte_t *origstream, |
| Byte_t *j2kstream, Byte8_t *j2klen); |
| |
| Byte_t * recons_jp2(msgqueue_param_t *msgqueue, Byte_t *jpipstream, Byte8_t csn, |
| Byte8_t *jp2len) |
| { |
| message_param_t *ptr; |
| Byte_t *jp2stream = NULL; |
| Byte_t *codestream = NULL; |
| Byte8_t codelen; |
| Byte8_t jp2cDBoxOffset = 0, jp2cDBoxlen = 0; |
| |
| *jp2len = 0; |
| |
| if (!msgqueue) { |
| return NULL; |
| } |
| |
| ptr = msgqueue->first; |
| while ((ptr = search_message(METADATA_MSG, (Byte8_t) - 1, csn, ptr)) != NULL) { |
| if (ptr->phld) { |
| if (strncmp((char *)ptr->phld->OrigBH + 4, "jp2c", 4) == 0) { |
| jp2cDBoxOffset = *jp2len + ptr->phld->OrigBHlen; |
| jp2stream = add_emptyboxstream(ptr->phld, jp2stream, jp2len); /* header only */ |
| jp2cDBoxlen = *jp2len - jp2cDBoxOffset; |
| } else { |
| jp2stream = add_emptyboxstream(ptr->phld, jp2stream, |
| jp2len); /* header only */ |
| } |
| } |
| jp2stream = add_msgstream(ptr, jpipstream, jp2stream, jp2len); |
| ptr = ptr->next; |
| } |
| |
| codestream = recons_codestream(msgqueue, jpipstream, csn, 0, 0, &codelen); |
| |
| if (jp2cDBoxOffset != 0 && codelen <= jp2cDBoxlen) { |
| memcpy(jp2stream + jp2cDBoxOffset, codestream, codelen); |
| } |
| |
| opj_free(codestream); |
| |
| return jp2stream; |
| } |
| |
| OPJ_BOOL isJPPstream(Byte8_t csn, msgqueue_param_t *msgqueue); |
| |
| Byte_t * recons_codestream_from_JPTstream(msgqueue_param_t *msgqueue, |
| Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen); |
| Byte_t * recons_codestream_from_JPPstream(msgqueue_param_t *msgqueue, |
| Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen); |
| |
| Byte_t * add_EOC(Byte_t *j2kstream, Byte8_t *j2klen); |
| |
| Byte_t * recons_codestream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte8_t csn, int fw, int fh, Byte8_t *codelen) |
| { |
| if (isJPPstream(csn, msgqueue)) { |
| return recons_codestream_from_JPPstream(msgqueue, jpipstream, csn, fw, fh, |
| codelen); |
| } else { |
| return recons_codestream_from_JPTstream(msgqueue, jpipstream, csn, fw, fh, |
| codelen); |
| } |
| } |
| |
| OPJ_BOOL isJPPstream(Byte8_t csn, msgqueue_param_t *msgqueue) |
| { |
| message_param_t *msg; |
| |
| msg = msgqueue->first; |
| while (msg) { |
| if (msg->csn == csn) { |
| if (msg->class_id <= 2) { |
| return OPJ_TRUE; |
| } else if (msg->class_id == 4 || msg->class_id == 5) { |
| return OPJ_FALSE; |
| } |
| } |
| msg = msg->next; |
| } |
| |
| fprintf(FCGI_stderr, "Error, message of csn %" PRId64 " not found\n", csn); |
| |
| return OPJ_FALSE; |
| } |
| |
| Byte_t * add_mainhead_msgstream(msgqueue_param_t *msgqueue, Byte_t *origstream, |
| Byte_t *j2kstream, Byte8_t csn, Byte8_t *j2klen); |
| Byte8_t get_last_tileID(msgqueue_param_t *msgqueue, Byte8_t csn, |
| OPJ_BOOL isJPPstream); |
| Byte_t * add_emptytilestream(const Byte8_t tileID, Byte_t *j2kstream, |
| Byte8_t *j2klen); |
| |
| Byte_t * recons_codestream_from_JPTstream(msgqueue_param_t *msgqueue, |
| Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen) |
| { |
| Byte_t *j2kstream = NULL; |
| Byte8_t last_tileID, tileID; |
| OPJ_BOOL found; |
| Byte8_t binOffset; |
| message_param_t *ptr; |
| SIZmarker_param_t SIZ; |
| OPJ_SIZE_T mindeclev; |
| |
| *j2klen = 0; |
| j2kstream = add_mainhead_msgstream(msgqueue, jpipstream, j2kstream, csn, |
| j2klen); |
| |
| if (!get_mainheader_from_j2kstream(j2kstream, &SIZ, NULL)) { |
| return j2kstream; |
| } |
| |
| if (fw <= 0 || fh <= 0) { |
| mindeclev = 0; |
| } else { |
| mindeclev = (OPJ_SIZE_T)comp_decomplev(fw, fh, (int)SIZ.Xsiz, (int)SIZ.Ysiz); |
| } |
| |
| last_tileID = get_last_tileID(msgqueue, csn, OPJ_FALSE); |
| |
| for (tileID = 0; tileID <= last_tileID; tileID++) { |
| found = OPJ_FALSE; |
| binOffset = 0; |
| |
| ptr = msgqueue->first; |
| while ((ptr = search_message(TILE_MSG, tileID, csn, ptr)) != NULL) { |
| if (ptr->bin_offset == binOffset) { |
| found = OPJ_TRUE; |
| j2kstream = add_msgstream(ptr, jpipstream, j2kstream, j2klen); |
| binOffset += ptr->length; |
| } |
| ptr = ptr->next; |
| } |
| ptr = msgqueue->first; |
| while ((ptr = search_message(EXT_TILE_MSG, tileID, csn, ptr)) != NULL) { |
| if (ptr->aux > mindeclev) { /* FIXME: pointer comparison ? */ |
| if (ptr->bin_offset == binOffset) { |
| found = OPJ_TRUE; |
| j2kstream = add_msgstream(ptr, jpipstream, j2kstream, j2klen); |
| binOffset += ptr->length; |
| } |
| } |
| ptr = ptr->next; |
| } |
| if (!found) { |
| j2kstream = add_emptytilestream(tileID, j2kstream, j2klen); |
| } |
| } |
| |
| j2kstream = add_EOC(j2kstream, j2klen); |
| |
| return j2kstream; |
| } |
| |
| Byte_t * add_SOTmkr(Byte_t *j2kstream, Byte8_t *j2klen); |
| |
| Byte_t * recons_bitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_codestream_from_JPPstream(msgqueue_param_t *msgqueue, |
| Byte_t *jpipstream, Byte8_t csn, int fw, int fh, Byte8_t *j2klen) |
| { |
| Byte_t *j2kstream = NULL; |
| Byte8_t tileID, last_tileID; |
| Byte8_t SOToffset; |
| OPJ_BOOL foundTH; |
| Byte8_t binOffset; |
| message_param_t *ptr; |
| SIZmarker_param_t SIZ; |
| CODmarker_param_t COD; |
| int max_reslev, mindeclev; |
| |
| *j2klen = 0; |
| j2kstream = add_mainhead_msgstream(msgqueue, jpipstream, j2kstream, csn, |
| j2klen); |
| |
| if (!get_mainheader_from_j2kstream(j2kstream, &SIZ, &COD)) { |
| return j2kstream; |
| } |
| |
| if (fw == 0 || fh == 0) { |
| mindeclev = 0; |
| } else { |
| mindeclev = comp_decomplev(fw, fh, (int)SIZ.Xsiz, (int)SIZ.Ysiz); |
| } |
| |
| max_reslev = -1; |
| last_tileID = get_last_tileID(msgqueue, csn, OPJ_TRUE); |
| |
| for (tileID = 0; tileID <= last_tileID; tileID++) { |
| |
| ptr = msgqueue->first; |
| binOffset = 0; |
| foundTH = OPJ_FALSE; |
| SOToffset = *j2klen; |
| while ((ptr = search_message(TILE_HEADER_MSG, tileID, csn, ptr)) != NULL) { |
| if (ptr->bin_offset == binOffset) { |
| j2kstream = add_SOTmkr(j2kstream, j2klen); |
| j2kstream = add_msgstream(ptr, jpipstream, j2kstream, j2klen); |
| foundTH = OPJ_TRUE; |
| binOffset += ptr->length; |
| } |
| ptr = ptr->next; |
| } |
| |
| if (foundTH) { |
| j2kstream = recons_bitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, &max_reslev, j2klen); |
| modify_tileheader(j2kstream, SOToffset, |
| (max_reslev < COD.numOfdecomp ? max_reslev : -1), SIZ.Csiz, j2klen); |
| } else { |
| j2kstream = add_emptytilestream(tileID, j2kstream, j2klen); |
| } |
| } |
| |
| if (max_reslev < COD.numOfdecomp) |
| if (!modify_mainheader(j2kstream, max_reslev, SIZ, COD, j2klen)) { |
| delete_COD(COD); |
| return j2kstream; |
| } |
| |
| j2kstream = add_EOC(j2kstream, j2klen); |
| delete_COD(COD); |
| |
| return j2kstream; |
| } |
| |
| Byte_t * add_mainhead_msgstream(msgqueue_param_t *msgqueue, Byte_t *origstream, |
| Byte_t *j2kstream, Byte8_t csn, Byte8_t *j2klen) |
| { |
| message_param_t *ptr; |
| Byte8_t binOffset; |
| |
| ptr = msgqueue->first; |
| binOffset = 0; |
| |
| while ((ptr = search_message(MAINHEADER_MSG, (Byte8_t) - 1, csn, |
| ptr)) != NULL) { |
| if (ptr->bin_offset == binOffset) { |
| j2kstream = add_msgstream(ptr, origstream, j2kstream, j2klen); |
| binOffset += ptr->length; |
| } |
| ptr = ptr->next; |
| } |
| return j2kstream; |
| } |
| |
| Byte_t * add_SOTmkr(Byte_t *j2kstream, Byte8_t *j2klen) |
| { |
| Byte_t *buf; |
| const Byte2_t SOT = 0x90ff; |
| |
| buf = (Byte_t *)opj_malloc((*j2klen) + 2); |
| |
| memcpy(buf, j2kstream, *j2klen); |
| memcpy(buf + (*j2klen), &SOT, 2); |
| |
| *j2klen += 2; |
| |
| if (j2kstream) { |
| opj_free(j2kstream); |
| } |
| |
| return buf; |
| } |
| |
| Byte_t * recons_LRCPbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_RLCPbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_RPCLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_PCRLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_CPRLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen); |
| |
| Byte_t * recons_bitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| switch (COD.prog_order) { |
| case OPJ_LRCP: |
| return recons_LRCPbitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, max_reslev, j2klen); |
| case OPJ_RLCP: |
| return recons_RLCPbitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, max_reslev, j2klen); |
| case OPJ_RPCL: |
| return recons_RPCLbitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, max_reslev, j2klen); |
| case OPJ_PCRL: |
| return recons_PCRLbitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, max_reslev, j2klen); |
| case OPJ_CPRL: |
| return recons_CPRLbitstream(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, mindeclev, max_reslev, j2klen); |
| default: |
| fprintf(FCGI_stderr, "Error, progression order not supported\n"); |
| } |
| return j2kstream; |
| } |
| |
| int comp_numOfprcts(Byte8_t tileID, SIZmarker_param_t SIZ, |
| CODmarker_param_t COD, int r); |
| Byte8_t comp_seqID(Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, |
| int r, int p); |
| |
| Byte_t * recons_packet(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, |
| int comp_idx, int res_idx, int prct_idx, int lay_idx, Byte8_t *j2klen); |
| |
| Byte_t * recons_LRCPbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| int r, p, c, l, numOfprcts; |
| |
| for (l = 0; l < COD.numOflayers; l++) |
| for (r = 0; r <= (COD.numOfdecomp - mindeclev); r++) { |
| if (COD.Scod & 0x01) { |
| numOfprcts = comp_numOfprcts(tileID, SIZ, COD, r); |
| } else { |
| numOfprcts = 1; |
| } |
| |
| for (c = 0; c < SIZ.Csiz; c++) |
| for (p = 0; p < numOfprcts; p++) { |
| j2kstream = recons_packet(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, max_reslev, c, r, p, l, j2klen); |
| } |
| } |
| |
| return j2kstream; |
| } |
| |
| Byte_t * recons_RLCPbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| int r, p, c, l, numOfprcts; |
| |
| for (r = 0; r <= (COD.numOfdecomp - mindeclev); r++) { |
| if (COD.Scod & 0x01) { |
| numOfprcts = comp_numOfprcts(tileID, SIZ, COD, r); |
| } else { |
| numOfprcts = 1; |
| } |
| |
| for (l = 0; l < COD.numOflayers; l++) |
| for (c = 0; c < SIZ.Csiz; c++) |
| for (p = 0; p < numOfprcts; p++) { |
| j2kstream = recons_packet(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, max_reslev, c, r, p, l, j2klen); |
| } |
| } |
| |
| return j2kstream; |
| } |
| |
| Byte_t * recons_precinct(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, |
| int comp_idx, int res_idx, Byte8_t seqID, Byte8_t *j2klen); |
| |
| Byte_t * recons_RPCLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| int r, p, c, numOfprcts; |
| Byte8_t seqID; |
| |
| for (r = 0, seqID = 0; r <= (COD.numOfdecomp - mindeclev); r++) { |
| |
| if (COD.Scod & 0x01) { |
| numOfprcts = comp_numOfprcts(tileID, SIZ, COD, r); |
| } else { |
| numOfprcts = 1; |
| } |
| |
| for (p = 0; p < numOfprcts; p++, seqID++) |
| for (c = 0; c < SIZ.Csiz; c++) { |
| j2kstream = recons_precinct(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, max_reslev, c, r, seqID, j2klen); |
| } |
| } |
| |
| return j2kstream; |
| } |
| |
| Byte_t * recons_PCRLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| int r, p, c, min_numOfprcts, numOfprcts, min_numOfres; |
| Byte8_t seqID; |
| |
| min_numOfres = COD.numOfdecomp - mindeclev + 1; |
| |
| if (COD.Scod & 0x01) { |
| min_numOfprcts = 0; |
| for (r = 0; r < min_numOfres; r++) { |
| numOfprcts = comp_numOfprcts(tileID, SIZ, COD, r); |
| |
| if (numOfprcts < min_numOfprcts || min_numOfprcts == 0) { |
| min_numOfprcts = numOfprcts; |
| } |
| } |
| } else { |
| min_numOfprcts = 1; |
| } |
| |
| for (p = 0; p < min_numOfprcts; p++) |
| for (c = 0; c < SIZ.Csiz; c++) |
| for (r = 0; r < min_numOfres; r++) { |
| seqID = comp_seqID(tileID, SIZ, COD, r, p); |
| j2kstream = recons_precinct(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, max_reslev, c, r, seqID, j2klen); |
| } |
| |
| return j2kstream; |
| } |
| |
| |
| Byte_t * recons_CPRLbitstream(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int mindeclev, |
| int *max_reslev, Byte8_t *j2klen) |
| { |
| int r, p, c, min_numOfprcts, numOfprcts, min_numOfres; |
| Byte8_t seqID; |
| |
| min_numOfres = COD.numOfdecomp - mindeclev + 1; |
| |
| if (COD.Scod & 0x01) { |
| min_numOfprcts = 0; |
| for (r = 0; r < min_numOfres; r++) { |
| numOfprcts = comp_numOfprcts(tileID, SIZ, COD, r); |
| |
| if (numOfprcts < min_numOfprcts || min_numOfprcts == 0) { |
| min_numOfprcts = numOfprcts; |
| } |
| } |
| } else { |
| min_numOfprcts = 1; |
| } |
| |
| for (c = 0; c < SIZ.Csiz; c++) |
| for (p = 0; p < min_numOfprcts; p++) |
| for (r = 0; r < min_numOfres; r++) { |
| seqID = comp_seqID(tileID, SIZ, COD, r, p); |
| j2kstream = recons_precinct(msgqueue, jpipstream, j2kstream, csn, tileID, SIZ, |
| COD, max_reslev, c, r, seqID, j2klen); |
| } |
| |
| return j2kstream; |
| } |
| |
| int comp_numOfprcts(Byte8_t tileID, SIZmarker_param_t SIZ, |
| CODmarker_param_t COD, int r) |
| { |
| int ret; |
| Byte4_t XTsiz, YTsiz; |
| |
| XTsiz = get_tile_XSiz(SIZ, (Byte4_t)tileID, COD.numOfdecomp - r); |
| YTsiz = get_tile_YSiz(SIZ, (Byte4_t)tileID, COD.numOfdecomp - r); |
| |
| ret = (int)(ceil((double)XTsiz / (double)COD.XPsiz[r]) * ceil((double)YTsiz / |
| (double)COD.YPsiz[r])); |
| assert(ret >= 0); |
| return ret; |
| } |
| |
| Byte_t * add_padding(Byte8_t padding, Byte_t *j2kstream, Byte8_t *j2klen); |
| |
| Byte_t * recons_packet(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, |
| int comp_idx, int res_idx, int prct_idx, int lay_idx, Byte8_t *j2klen) |
| { |
| Byte8_t seqID, precID, binOffset; |
| message_param_t *ptr; |
| OPJ_BOOL foundPrec; |
| int l; |
| |
| seqID = comp_seqID(tileID, SIZ, COD, res_idx, prct_idx); |
| precID = comp_precinct_id((int)tileID, comp_idx, (int)seqID, (int)SIZ.Csiz, |
| (int)SIZ.XTnum * (int)SIZ.YTnum); |
| |
| ptr = msgqueue->first; |
| binOffset = 0; |
| foundPrec = OPJ_FALSE; |
| l = 0; |
| |
| while ((ptr = search_message(PRECINCT_MSG, precID, csn, ptr)) != NULL) { |
| if (ptr->bin_offset == binOffset) { |
| if (lay_idx == l) { |
| j2kstream = add_msgstream(ptr, jpipstream, j2kstream, j2klen); |
| foundPrec = OPJ_TRUE; |
| if (*max_reslev < res_idx) { |
| *max_reslev = res_idx; |
| } |
| |
| break; |
| } |
| binOffset += ptr->length; |
| l++; |
| } |
| ptr = ptr->next; |
| } |
| if (!foundPrec && COD.Scod & 0x01) { |
| j2kstream = add_padding(1, j2kstream, j2klen); |
| } |
| |
| return j2kstream; |
| } |
| |
| |
| Byte_t * recons_precinct(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte_t *j2kstream, Byte8_t csn, |
| Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, int *max_reslev, |
| int comp_idx, int res_idx, Byte8_t seqID, Byte8_t *j2klen) |
| { |
| Byte8_t precID, binOffset; |
| message_param_t *ptr; |
| OPJ_BOOL foundPrec; |
| |
| precID = comp_precinct_id((int)tileID, comp_idx, (int)seqID, (int)SIZ.Csiz, |
| (int)SIZ.XTnum * (int)SIZ.YTnum); |
| |
| ptr = msgqueue->first; |
| binOffset = 0; |
| foundPrec = OPJ_FALSE; |
| |
| while ((ptr = search_message(PRECINCT_MSG, precID, csn, ptr)) != NULL) { |
| if (ptr->bin_offset == binOffset) { |
| j2kstream = add_msgstream(ptr, jpipstream, j2kstream, j2klen); |
| |
| foundPrec = OPJ_TRUE; |
| binOffset += ptr->length; |
| if (*max_reslev < res_idx) { |
| *max_reslev = res_idx; |
| } |
| |
| if (ptr->last_byte) { |
| break; |
| } |
| } |
| ptr = ptr->next; |
| } |
| if (!foundPrec && COD.Scod & 0x01) { |
| j2kstream = add_padding(COD.numOflayers, j2kstream, j2klen); |
| } |
| |
| return j2kstream; |
| } |
| |
| Byte8_t comp_seqID(Byte8_t tileID, SIZmarker_param_t SIZ, CODmarker_param_t COD, |
| int r, int p) |
| { |
| Byte8_t seqID = 0; |
| int rr; |
| assert(p >= 0); |
| assert(r >= 0); |
| |
| for (rr = 0; rr < r; rr++) { |
| seqID += (Byte8_t)comp_numOfprcts(tileID, SIZ, COD, rr); |
| } |
| |
| seqID += (Byte8_t)p; |
| |
| return seqID; |
| } |
| |
| Byte8_t get_last_tileID(msgqueue_param_t *msgqueue, Byte8_t csn, |
| OPJ_BOOL isjppstream) |
| { |
| Byte8_t last_tileID = 0; |
| message_param_t *msg; |
| |
| msg = msgqueue->first; |
| while (msg) { |
| if (isjppstream) { |
| if ((msg->class_id == TILE_HEADER_MSG) && msg->csn == csn && |
| last_tileID < msg->in_class_id) { |
| last_tileID = msg->in_class_id; |
| } |
| } else { |
| if ((msg->class_id == TILE_MSG || msg->class_id == EXT_TILE_MSG) && |
| msg->csn == csn && last_tileID < msg->in_class_id) { |
| last_tileID = msg->in_class_id; |
| } |
| } |
| msg = msg->next; |
| } |
| return last_tileID; |
| } |
| |
| |
| message_param_t * search_message(Byte8_t class_id, Byte8_t in_class_id, |
| Byte8_t csn, message_param_t *msg) |
| { |
| while (msg != NULL) { |
| if (in_class_id == (Byte8_t) - 1) { |
| if (msg->class_id == class_id && msg->csn == csn) { |
| return msg; |
| } |
| } else { |
| if (msg->class_id == class_id && msg->in_class_id == in_class_id && |
| msg->csn == csn) { |
| return msg; |
| } |
| } |
| msg = msg->next; |
| } |
| return NULL; |
| } |
| |
| |
| Byte_t * gene_msgstream(message_param_t *message, Byte_t *stream, |
| Byte8_t *length); |
| Byte_t * gene_emptytilestream(const Byte8_t tileID, Byte8_t *length); |
| |
| Byte_t * add_msgstream(message_param_t *message, Byte_t *origstream, |
| Byte_t *j2kstream, Byte8_t *j2klen) |
| { |
| Byte_t *newstream; |
| Byte8_t newlen; |
| Byte_t *buf; |
| |
| if (!message) { |
| return NULL; |
| } |
| |
| newstream = gene_msgstream(message, origstream, &newlen); |
| |
| buf = (Byte_t *)opj_malloc((*j2klen) + newlen); |
| |
| memcpy(buf, j2kstream, *j2klen); |
| memcpy(buf + (*j2klen), newstream, newlen); |
| |
| *j2klen += newlen; |
| |
| opj_free(newstream); |
| if (j2kstream) { |
| opj_free(j2kstream); |
| } |
| |
| return buf; |
| } |
| |
| |
| Byte_t * add_emptyboxstream(placeholder_param_t *phld, Byte_t *jp2stream, |
| Byte8_t *jp2len) |
| { |
| Byte_t *newstream; |
| Byte8_t newlen; |
| Byte_t *buf; |
| |
| if (phld->OrigBHlen == 8) { |
| newlen = big4(phld->OrigBH); |
| } else { |
| newlen = big8(phld->OrigBH + 8); |
| } |
| |
| newstream = (Byte_t *)opj_malloc(newlen); |
| memset(newstream, 0, newlen); |
| memcpy(newstream, phld->OrigBH, phld->OrigBHlen); |
| |
| buf = (Byte_t *)opj_malloc((*jp2len) + newlen); |
| |
| memcpy(buf, jp2stream, *jp2len); |
| memcpy(buf + (*jp2len), newstream, newlen); |
| |
| *jp2len += newlen; |
| |
| opj_free(newstream); |
| if (jp2stream) { |
| opj_free(jp2stream); |
| } |
| |
| return buf; |
| } |
| |
| Byte_t * add_emptytilestream(const Byte8_t tileID, Byte_t *j2kstream, |
| Byte8_t *j2klen) |
| { |
| Byte_t *newstream; |
| Byte8_t newlen; |
| Byte_t *buf; |
| |
| newstream = gene_emptytilestream(tileID, &newlen); |
| |
| buf = (Byte_t *)opj_malloc((*j2klen) + newlen); |
| |
| memcpy(buf, j2kstream, *j2klen); |
| memcpy(buf + (*j2klen), newstream, newlen); |
| |
| *j2klen += newlen; |
| |
| opj_free(newstream); |
| if (j2kstream) { |
| opj_free(j2kstream); |
| } |
| |
| return buf; |
| } |
| |
| Byte_t * add_padding(Byte8_t padding, Byte_t *j2kstream, Byte8_t *j2klen) |
| { |
| Byte_t *buf; |
| |
| buf = (Byte_t *)opj_malloc((*j2klen) + padding); |
| |
| memcpy(buf, j2kstream, *j2klen); |
| memset(buf + (*j2klen), 0, padding); |
| |
| *j2klen += padding; |
| |
| if (j2kstream) { |
| opj_free(j2kstream); |
| } |
| |
| return buf; |
| } |
| |
| Byte_t * add_EOC(Byte_t *j2kstream, Byte8_t *j2klen) |
| { |
| Byte2_t EOC = 0xd9ff; |
| |
| Byte_t *buf; |
| |
| buf = (Byte_t *)opj_malloc((*j2klen) + 2); |
| |
| memcpy(buf, j2kstream, *j2klen); |
| memcpy(buf + (*j2klen), &EOC, 2); |
| |
| *j2klen += 2; |
| |
| if (j2kstream) { |
| opj_free(j2kstream); |
| } |
| |
| return buf; |
| } |
| |
| Byte_t * gene_msgstream(message_param_t *message, Byte_t *stream, |
| Byte8_t *length) |
| { |
| Byte_t *buf; |
| |
| if (!message) { |
| return NULL; |
| } |
| |
| *length = message->length; |
| buf = (Byte_t *)opj_malloc(*length); |
| memcpy(buf, stream + message->res_offset, *length); |
| |
| return buf; |
| } |
| |
| Byte_t * gene_emptytilestream(const Byte8_t tileID, Byte8_t *length) |
| { |
| Byte_t *buf; |
| const Byte2_t SOT = 0x90ff; |
| const Byte2_t Lsot = 0xa << 8; |
| Byte2_t Isot; |
| const Byte4_t Psot = 0xe << 24; |
| const Byte_t TPsot = 0, TNsot = 1; |
| const Byte2_t SOD = 0x93ff; |
| |
| *length = 14; |
| buf = (Byte_t *)opj_malloc(*length); |
| |
| Isot = (Byte2_t)((((Byte2_t)tileID) << 8) | ((((Byte2_t)tileID) & 0xf0) >> 8)); |
| |
| memcpy(buf, &SOT, 2); |
| memcpy(buf + 2, &Lsot, 2); |
| memcpy(buf + 4, &Isot, 2); |
| memcpy(buf + 6, &Psot, 4); |
| memcpy(buf + 10, &TPsot, 1); |
| memcpy(buf + 11, &TNsot, 1); |
| memcpy(buf + 12, &SOD, 2); |
| |
| return buf; |
| } |
| |
| Byte_t * recons_j2kmainhead(msgqueue_param_t *msgqueue, Byte_t *jpipstream, |
| Byte8_t csn, Byte8_t *j2klen) |
| { |
| *j2klen = 0; |
| return add_mainhead_msgstream(msgqueue, jpipstream, NULL, csn, j2klen); |
| } |