| 1 | /* | 
|---|
| 2 | * The copyright in this software is being made available under the 2-clauses | 
|---|
| 3 | * BSD License, included below. This software may be subject to other third | 
|---|
| 4 | * party and contributor rights, including patent rights, and no such rights | 
|---|
| 5 | * are granted under this license. | 
|---|
| 6 | * | 
|---|
| 7 | * Copyright (c) 2002-2014, Universite catholique de Louvain (UCL), Belgium | 
|---|
| 8 | * Copyright (c) 2002-2014, Professor Benoit Macq | 
|---|
| 9 | * Copyright (c) 2001-2003, David Janssens | 
|---|
| 10 | * Copyright (c) 2002-2003, Yannick Verschueren | 
|---|
| 11 | * Copyright (c) 2003-2007, Francois-Olivier Devaux | 
|---|
| 12 | * Copyright (c) 2003-2014, Antonin Descampe | 
|---|
| 13 | * Copyright (c) 2005, Herve Drolon, FreeImage Team | 
|---|
| 14 | * Copyright (c) 2008, 2011-2012, Centre National d'Etudes Spatiales (CNES), FR | 
|---|
| 15 | * Copyright (c) 2012, CS Systemes d'Information, France | 
|---|
| 16 | * All rights reserved. | 
|---|
| 17 | * | 
|---|
| 18 | * Redistribution and use in source and binary forms, with or without | 
|---|
| 19 | * modification, are permitted provided that the following conditions | 
|---|
| 20 | * are met: | 
|---|
| 21 | * 1. Redistributions of source code must retain the above copyright | 
|---|
| 22 | *    notice, this list of conditions and the following disclaimer. | 
|---|
| 23 | * 2. Redistributions in binary form must reproduce the above copyright | 
|---|
| 24 | *    notice, this list of conditions and the following disclaimer in the | 
|---|
| 25 | *    documentation and/or other materials provided with the distribution. | 
|---|
| 26 | * | 
|---|
| 27 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS' | 
|---|
| 28 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | 
|---|
| 29 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | 
|---|
| 30 | * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE | 
|---|
| 31 | * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | 
|---|
| 32 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | 
|---|
| 33 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | 
|---|
| 34 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | 
|---|
| 35 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | 
|---|
| 36 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | 
|---|
| 37 | * POSSIBILITY OF SUCH DAMAGE. | 
|---|
| 38 | */ | 
|---|
| 39 |  | 
|---|
| 40 | #include "opj_includes.h" | 
|---|
| 41 |  | 
|---|
| 42 | /* | 
|---|
| 43 | ========================================================== | 
|---|
| 44 | Tag-tree coder interface | 
|---|
| 45 | ========================================================== | 
|---|
| 46 | */ | 
|---|
| 47 |  | 
|---|
| 48 | opj_tgt_tree_t *opj_tgt_create(OPJ_UINT32 numleafsh, OPJ_UINT32 numleafsv, | 
|---|
| 49 | opj_event_mgr_t *p_manager) | 
|---|
| 50 | { | 
|---|
| 51 | OPJ_INT32 nplh[32]; | 
|---|
| 52 | OPJ_INT32 nplv[32]; | 
|---|
| 53 | opj_tgt_node_t *node = 00; | 
|---|
| 54 | opj_tgt_node_t *l_parent_node = 00; | 
|---|
| 55 | opj_tgt_node_t *l_parent_node0 = 00; | 
|---|
| 56 | opj_tgt_tree_t *tree = 00; | 
|---|
| 57 | OPJ_UINT32 i; | 
|---|
| 58 | OPJ_INT32  j, k; | 
|---|
| 59 | OPJ_UINT32 numlvls; | 
|---|
| 60 | OPJ_UINT32 n; | 
|---|
| 61 |  | 
|---|
| 62 | tree = (opj_tgt_tree_t *) opj_calloc(1, sizeof(opj_tgt_tree_t)); | 
|---|
| 63 | if (!tree) { | 
|---|
| 64 | opj_event_msg(p_manager, EVT_ERROR, "Not enough memory to create Tag-tree\n"); | 
|---|
| 65 | return 00; | 
|---|
| 66 | } | 
|---|
| 67 |  | 
|---|
| 68 | tree->numleafsh = numleafsh; | 
|---|
| 69 | tree->numleafsv = numleafsv; | 
|---|
| 70 |  | 
|---|
| 71 | numlvls = 0; | 
|---|
| 72 | nplh[0] = (OPJ_INT32)numleafsh; | 
|---|
| 73 | nplv[0] = (OPJ_INT32)numleafsv; | 
|---|
| 74 | tree->numnodes = 0; | 
|---|
| 75 | do { | 
|---|
| 76 | n = (OPJ_UINT32)(nplh[numlvls] * nplv[numlvls]); | 
|---|
| 77 | nplh[numlvls + 1] = (nplh[numlvls] + 1) / 2; | 
|---|
| 78 | nplv[numlvls + 1] = (nplv[numlvls] + 1) / 2; | 
|---|
| 79 | tree->numnodes += n; | 
|---|
| 80 | ++numlvls; | 
|---|
| 81 | } while (n > 1); | 
|---|
| 82 |  | 
|---|
| 83 | /* ADD */ | 
|---|
| 84 | if (tree->numnodes == 0) { | 
|---|
| 85 | opj_free(tree); | 
|---|
| 86 | return 00; | 
|---|
| 87 | } | 
|---|
| 88 |  | 
|---|
| 89 | tree->nodes = (opj_tgt_node_t*) opj_calloc(tree->numnodes, | 
|---|
| 90 | sizeof(opj_tgt_node_t)); | 
|---|
| 91 | if (!tree->nodes) { | 
|---|
| 92 | opj_event_msg(p_manager, EVT_ERROR, | 
|---|
| 93 | "Not enough memory to create Tag-tree nodes\n"); | 
|---|
| 94 | opj_free(tree); | 
|---|
| 95 | return 00; | 
|---|
| 96 | } | 
|---|
| 97 | tree->nodes_size = tree->numnodes * (OPJ_UINT32)sizeof(opj_tgt_node_t); | 
|---|
| 98 |  | 
|---|
| 99 | node = tree->nodes; | 
|---|
| 100 | l_parent_node = &tree->nodes[tree->numleafsh * tree->numleafsv]; | 
|---|
| 101 | l_parent_node0 = l_parent_node; | 
|---|
| 102 |  | 
|---|
| 103 | for (i = 0; i < numlvls - 1; ++i) { | 
|---|
| 104 | for (j = 0; j < nplv[i]; ++j) { | 
|---|
| 105 | k = nplh[i]; | 
|---|
| 106 | while (--k >= 0) { | 
|---|
| 107 | node->parent = l_parent_node; | 
|---|
| 108 | ++node; | 
|---|
| 109 | if (--k >= 0) { | 
|---|
| 110 | node->parent = l_parent_node; | 
|---|
| 111 | ++node; | 
|---|
| 112 | } | 
|---|
| 113 | ++l_parent_node; | 
|---|
| 114 | } | 
|---|
| 115 | if ((j & 1) || j == nplv[i] - 1) { | 
|---|
| 116 | l_parent_node0 = l_parent_node; | 
|---|
| 117 | } else { | 
|---|
| 118 | l_parent_node = l_parent_node0; | 
|---|
| 119 | l_parent_node0 += nplh[i]; | 
|---|
| 120 | } | 
|---|
| 121 | } | 
|---|
| 122 | } | 
|---|
| 123 | node->parent = 0; | 
|---|
| 124 | opj_tgt_reset(tree); | 
|---|
| 125 | return tree; | 
|---|
| 126 | } | 
|---|
| 127 |  | 
|---|
| 128 | /** | 
|---|
| 129 | * Reinitialises a tag-tree from an existing one. | 
|---|
| 130 | * | 
|---|
| 131 | * @param       p_tree                          the tree to reinitialize. | 
|---|
| 132 | * @param       p_num_leafs_h           the width of the array of leafs of the tree | 
|---|
| 133 | * @param       p_num_leafs_v           the height of the array of leafs of the tree | 
|---|
| 134 | * @return      a new tag-tree if successful, NULL otherwise | 
|---|
| 135 | */ | 
|---|
| 136 | opj_tgt_tree_t *opj_tgt_init(opj_tgt_tree_t * p_tree, OPJ_UINT32 p_num_leafs_h, | 
|---|
| 137 | OPJ_UINT32 p_num_leafs_v, opj_event_mgr_t *p_manager) | 
|---|
| 138 | { | 
|---|
| 139 | OPJ_INT32 l_nplh[32]; | 
|---|
| 140 | OPJ_INT32 l_nplv[32]; | 
|---|
| 141 | opj_tgt_node_t *l_node = 00; | 
|---|
| 142 | opj_tgt_node_t *l_parent_node = 00; | 
|---|
| 143 | opj_tgt_node_t *l_parent_node0 = 00; | 
|---|
| 144 | OPJ_UINT32 i; | 
|---|
| 145 | OPJ_INT32 j, k; | 
|---|
| 146 | OPJ_UINT32 l_num_levels; | 
|---|
| 147 | OPJ_UINT32 n; | 
|---|
| 148 | OPJ_UINT32 l_node_size; | 
|---|
| 149 |  | 
|---|
| 150 | if (! p_tree) { | 
|---|
| 151 | return 00; | 
|---|
| 152 | } | 
|---|
| 153 |  | 
|---|
| 154 | if ((p_tree->numleafsh != p_num_leafs_h) || | 
|---|
| 155 | (p_tree->numleafsv != p_num_leafs_v)) { | 
|---|
| 156 | p_tree->numleafsh = p_num_leafs_h; | 
|---|
| 157 | p_tree->numleafsv = p_num_leafs_v; | 
|---|
| 158 |  | 
|---|
| 159 | l_num_levels = 0; | 
|---|
| 160 | l_nplh[0] = (OPJ_INT32)p_num_leafs_h; | 
|---|
| 161 | l_nplv[0] = (OPJ_INT32)p_num_leafs_v; | 
|---|
| 162 | p_tree->numnodes = 0; | 
|---|
| 163 | do { | 
|---|
| 164 | n = (OPJ_UINT32)(l_nplh[l_num_levels] * l_nplv[l_num_levels]); | 
|---|
| 165 | l_nplh[l_num_levels + 1] = (l_nplh[l_num_levels] + 1) / 2; | 
|---|
| 166 | l_nplv[l_num_levels + 1] = (l_nplv[l_num_levels] + 1) / 2; | 
|---|
| 167 | p_tree->numnodes += n; | 
|---|
| 168 | ++l_num_levels; | 
|---|
| 169 | } while (n > 1); | 
|---|
| 170 |  | 
|---|
| 171 | /* ADD */ | 
|---|
| 172 | if (p_tree->numnodes == 0) { | 
|---|
| 173 | opj_tgt_destroy(p_tree); | 
|---|
| 174 | return 00; | 
|---|
| 175 | } | 
|---|
| 176 | l_node_size = p_tree->numnodes * (OPJ_UINT32)sizeof(opj_tgt_node_t); | 
|---|
| 177 |  | 
|---|
| 178 | if (l_node_size > p_tree->nodes_size) { | 
|---|
| 179 | opj_tgt_node_t* new_nodes = (opj_tgt_node_t*) opj_realloc(p_tree->nodes, | 
|---|
| 180 | l_node_size); | 
|---|
| 181 | if (! new_nodes) { | 
|---|
| 182 | opj_event_msg(p_manager, EVT_ERROR, | 
|---|
| 183 | "Not enough memory to reinitialize the tag tree\n"); | 
|---|
| 184 | opj_tgt_destroy(p_tree); | 
|---|
| 185 | return 00; | 
|---|
| 186 | } | 
|---|
| 187 | p_tree->nodes = new_nodes; | 
|---|
| 188 | memset(((char *) p_tree->nodes) + p_tree->nodes_size, 0, | 
|---|
| 189 | l_node_size - p_tree->nodes_size); | 
|---|
| 190 | p_tree->nodes_size = l_node_size; | 
|---|
| 191 | } | 
|---|
| 192 | l_node = p_tree->nodes; | 
|---|
| 193 | l_parent_node = &p_tree->nodes[p_tree->numleafsh * p_tree->numleafsv]; | 
|---|
| 194 | l_parent_node0 = l_parent_node; | 
|---|
| 195 |  | 
|---|
| 196 | for (i = 0; i < l_num_levels - 1; ++i) { | 
|---|
| 197 | for (j = 0; j < l_nplv[i]; ++j) { | 
|---|
| 198 | k = l_nplh[i]; | 
|---|
| 199 | while (--k >= 0) { | 
|---|
| 200 | l_node->parent = l_parent_node; | 
|---|
| 201 | ++l_node; | 
|---|
| 202 | if (--k >= 0) { | 
|---|
| 203 | l_node->parent = l_parent_node; | 
|---|
| 204 | ++l_node; | 
|---|
| 205 | } | 
|---|
| 206 | ++l_parent_node; | 
|---|
| 207 | } | 
|---|
| 208 | if ((j & 1) || j == l_nplv[i] - 1) { | 
|---|
| 209 | l_parent_node0 = l_parent_node; | 
|---|
| 210 | } else { | 
|---|
| 211 | l_parent_node = l_parent_node0; | 
|---|
| 212 | l_parent_node0 += l_nplh[i]; | 
|---|
| 213 | } | 
|---|
| 214 | } | 
|---|
| 215 | } | 
|---|
| 216 | l_node->parent = 0; | 
|---|
| 217 | } | 
|---|
| 218 | opj_tgt_reset(p_tree); | 
|---|
| 219 |  | 
|---|
| 220 | return p_tree; | 
|---|
| 221 | } | 
|---|
| 222 |  | 
|---|
| 223 | void opj_tgt_destroy(opj_tgt_tree_t *p_tree) | 
|---|
| 224 | { | 
|---|
| 225 | if (! p_tree) { | 
|---|
| 226 | return; | 
|---|
| 227 | } | 
|---|
| 228 |  | 
|---|
| 229 | if (p_tree->nodes) { | 
|---|
| 230 | opj_free(p_tree->nodes); | 
|---|
| 231 | p_tree->nodes = 00; | 
|---|
| 232 | } | 
|---|
| 233 | opj_free(p_tree); | 
|---|
| 234 | } | 
|---|
| 235 |  | 
|---|
| 236 | void opj_tgt_reset(opj_tgt_tree_t *p_tree) | 
|---|
| 237 | { | 
|---|
| 238 | OPJ_UINT32 i; | 
|---|
| 239 | opj_tgt_node_t * l_current_node = 00;; | 
|---|
| 240 |  | 
|---|
| 241 | if (! p_tree) { | 
|---|
| 242 | return; | 
|---|
| 243 | } | 
|---|
| 244 |  | 
|---|
| 245 | l_current_node = p_tree->nodes; | 
|---|
| 246 | for (i = 0; i < p_tree->numnodes; ++i) { | 
|---|
| 247 | l_current_node->value = 999; | 
|---|
| 248 | l_current_node->low = 0; | 
|---|
| 249 | l_current_node->known = 0; | 
|---|
| 250 | ++l_current_node; | 
|---|
| 251 | } | 
|---|
| 252 | } | 
|---|
| 253 |  | 
|---|
| 254 | void opj_tgt_setvalue(opj_tgt_tree_t *tree, OPJ_UINT32 leafno, OPJ_INT32 value) | 
|---|
| 255 | { | 
|---|
| 256 | opj_tgt_node_t *node; | 
|---|
| 257 | node = &tree->nodes[leafno]; | 
|---|
| 258 | while (node && node->value > value) { | 
|---|
| 259 | node->value = value; | 
|---|
| 260 | node = node->parent; | 
|---|
| 261 | } | 
|---|
| 262 | } | 
|---|
| 263 |  | 
|---|
| 264 | void opj_tgt_encode(opj_bio_t *bio, opj_tgt_tree_t *tree, OPJ_UINT32 leafno, | 
|---|
| 265 | OPJ_INT32 threshold) | 
|---|
| 266 | { | 
|---|
| 267 | opj_tgt_node_t *stk[31]; | 
|---|
| 268 | opj_tgt_node_t **stkptr; | 
|---|
| 269 | opj_tgt_node_t *node; | 
|---|
| 270 | OPJ_INT32 low; | 
|---|
| 271 |  | 
|---|
| 272 | stkptr = stk; | 
|---|
| 273 | node = &tree->nodes[leafno]; | 
|---|
| 274 | while (node->parent) { | 
|---|
| 275 | *stkptr++ = node; | 
|---|
| 276 | node = node->parent; | 
|---|
| 277 | } | 
|---|
| 278 |  | 
|---|
| 279 | low = 0; | 
|---|
| 280 | for (;;) { | 
|---|
| 281 | if (low > node->low) { | 
|---|
| 282 | node->low = low; | 
|---|
| 283 | } else { | 
|---|
| 284 | low = node->low; | 
|---|
| 285 | } | 
|---|
| 286 |  | 
|---|
| 287 | while (low < threshold) { | 
|---|
| 288 | if (low >= node->value) { | 
|---|
| 289 | if (!node->known) { | 
|---|
| 290 | opj_bio_write(bio, 1, 1); | 
|---|
| 291 | node->known = 1; | 
|---|
| 292 | } | 
|---|
| 293 | break; | 
|---|
| 294 | } | 
|---|
| 295 | opj_bio_write(bio, 0, 1); | 
|---|
| 296 | ++low; | 
|---|
| 297 | } | 
|---|
| 298 |  | 
|---|
| 299 | node->low = low; | 
|---|
| 300 | if (stkptr == stk) { | 
|---|
| 301 | break; | 
|---|
| 302 | } | 
|---|
| 303 | node = *--stkptr; | 
|---|
| 304 | } | 
|---|
| 305 | } | 
|---|
| 306 |  | 
|---|
| 307 | OPJ_UINT32 opj_tgt_decode(opj_bio_t *bio, opj_tgt_tree_t *tree, | 
|---|
| 308 | OPJ_UINT32 leafno, OPJ_INT32 threshold) | 
|---|
| 309 | { | 
|---|
| 310 | opj_tgt_node_t *stk[31]; | 
|---|
| 311 | opj_tgt_node_t **stkptr; | 
|---|
| 312 | opj_tgt_node_t *node; | 
|---|
| 313 | OPJ_INT32 low; | 
|---|
| 314 |  | 
|---|
| 315 | stkptr = stk; | 
|---|
| 316 | node = &tree->nodes[leafno]; | 
|---|
| 317 | while (node->parent) { | 
|---|
| 318 | *stkptr++ = node; | 
|---|
| 319 | node = node->parent; | 
|---|
| 320 | } | 
|---|
| 321 |  | 
|---|
| 322 | low = 0; | 
|---|
| 323 | for (;;) { | 
|---|
| 324 | if (low > node->low) { | 
|---|
| 325 | node->low = low; | 
|---|
| 326 | } else { | 
|---|
| 327 | low = node->low; | 
|---|
| 328 | } | 
|---|
| 329 | while (low < threshold && low < node->value) { | 
|---|
| 330 | if (opj_bio_read(bio, 1)) { | 
|---|
| 331 | node->value = low; | 
|---|
| 332 | } else { | 
|---|
| 333 | ++low; | 
|---|
| 334 | } | 
|---|
| 335 | } | 
|---|
| 336 | node->low = low; | 
|---|
| 337 | if (stkptr == stk) { | 
|---|
| 338 | break; | 
|---|
| 339 | } | 
|---|
| 340 | node = *--stkptr; | 
|---|
| 341 | } | 
|---|
| 342 |  | 
|---|
| 343 | return (node->value < threshold) ? 1 : 0; | 
|---|
| 344 | } | 
|---|
| 345 |  | 
|---|