libopenjpeg/bio.c

   1 /*
   2  * Copyright (c) 2001-2003, David Janssens
   3  * Copyright (c) 2002-2003, Yannick Verschueren
   4  * Copyright (c) 2003-2005, Francois Devaux and Antonin Descampe
   5  * Copyright (c) 2005, Herv� Drolon, FreeImage Team
   6  * Copyright (c) 2002-2005, Communications and remote sensing Laboratory, Universite catholique de Louvain, Belgium
   7  * All rights reserved.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS `AS IS'
  19  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  22  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  28  * POSSIBILITY OF SUCH DAMAGE.
  29  */
  30
  31
  32 #include "opj_includes.h"
  33
  34 /*
  35 ==========================================================
  36    local functions
  37 ==========================================================
  38 */
  39
  40 static int bio_byteout(opj_bio_t *bio) {
  41   bio->buf = (bio->buf << 8) & 0xffff;
  42   bio->ct = bio->buf == 0xff00 ? 7 : 8;
  43   if (bio->bp >= bio->end) {
  44     return 1;
  45   }
  46   *bio->bp++ = bio->buf >> 8;
  47   return 0;
  48 }
  49
  50 static int bio_bytein(opj_bio_t *bio) {
  51   bio->buf = (bio->buf << 8) & 0xffff;
  52   bio->ct = bio->buf == 0xff00 ? 7 : 8;
  53   if (bio->bp >= bio->end) {
  54     return 1;
  55   }
  56   bio->buf |= *bio->bp++;
  57   return 0;
  58 }
  59
  60 static void bio_putbit(opj_bio_t *bio, int b) {
  61   if (bio->ct == 0) {
  62     bio_byteout(bio);
  63   }
  64   bio->ct--;
  65   bio->buf |= b << bio->ct;
  66 }
  67
  68 static int bio_getbit(opj_bio_t *bio) {
  69   if (bio->ct == 0) {
  70     bio_bytein(bio);
  71   }
  72   bio->ct--;
  73   return (bio->buf >> bio->ct) & 1;
  74 }
  75
  76 /*
  77 ==========================================================
  78    Bit Input/Output interface
  79 ==========================================================
  80 */
  81
  82 opj_bio_t* bio_create() {
  83   opj_bio_t *bio = (opj_bio_t*)opj_malloc(sizeof(opj_bio_t));
  84   return bio;
  85 }
  86
  87 void bio_destroy(opj_bio_t *bio) {
  88   if(bio) {
  89     opj_free(bio);
  90   }
  91 }
  92
  93 int bio_numbytes(opj_bio_t *bio) {
  94   return (bio->bp - bio->start);
  95 }
  96
  97 void bio_init_enc(opj_bio_t *bio, unsigned char *bp, int len) {
  98   bio->start = bp;
  99   bio->end = bp + len;
 100   bio->bp = bp;
 101   bio->buf = 0;
 102   bio->ct = 8;
 103 }
 104
 105 void bio_init_dec(opj_bio_t *bio, unsigned char *bp, int len) {
 106   bio->start = bp;
 107   bio->end = bp + len;
 108   bio->bp = bp;
 109   bio->buf = 0;
 110   bio->ct = 0;
 111 }
 112
 113 void bio_write(opj_bio_t *bio, int v, int n) {
 114   int i;
 115   for (i = n - 1; i >= 0; i--) {
 116     bio_putbit(bio, (v >> i) & 1);
 117   }
 118 }
 119
 120 int bio_read(opj_bio_t *bio, int n) {
 121   int i, v;
 122   v = 0;
 123   for (i = n - 1; i >= 0; i--) {
 124     v += bio_getbit(bio) << i;
 125   }
 126   return v;
 127 }
 128
 129 int bio_flush(opj_bio_t *bio) {
 130   bio->ct = 0;
 131   if (bio_byteout(bio)) {
 132     return 1;
 133   }
 134   if (bio->ct == 7) {
 135     bio->ct = 0;
 136     if (bio_byteout(bio)) {
 137       return 1;
 138     }
 139   }
 140   return 0;
 141 }
 142
 143 int bio_inalign(opj_bio_t *bio) {
 144   bio->ct = 0;
 145   if ((bio->buf & 0xff) == 0xff) {
 146     if (bio_bytein(bio)) {
 147       return 1;
 148     }
 149     bio->ct = 0;
 150   }
 151   return 0;
 152 }