lib-lib/bits.c

   1 /*
   2  *  This program is free software; you can redistribute it and/or modify
   3  *  it under the terms of the GNU General Public License as published by
   4  *  the Free Software Foundation; either version 2 of the License, or (at
   5  *  your option) any later version.
   6  *
   7  *  This program is distributed in the hope that it will be useful, but
   8  *  WITHOUT ANY WARRANTY; without even the implied warranty of
   9  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  10  *  General Public License for more details.
  11  *
  12  *  You should have received a copy of the GNU General Public License
  13  *  along with this program; if not, write to the Free Software
  14  *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
  15  *  MA 02110-1301, USA.
  16  */
  17 /*
  18  * Copyright © 2007 Pierre Habouzit
  19  */
  20
  21 #include "lib-lib.h"
  22
  23 #define UPPER_32(x)  (((x) + 31) & ~31)
  24 #define LOWER_32(x)  ((x) & ~31)
  25
  26 void bits_extend(bits_t *bits, int pos)
  27 {
  28     if (bits->size == 0) {
  29         bits->start = LOWER_32(pos >> 3);
  30     }
  31
  32     if (pos >> 3 > bits->start + bits->size) {
  33         int newsize = UPPER_32((pos >> 3) - bits->start + 1);
  34         p_realloc(&bits->bits, bits->size = newsize);
  35         return;
  36     }
  37
  38     if (pos >> 3 < bits->start) {
  39         unsigned char *tmp = bits->bits;
  40         int prepend = LOWER_32(bits->start - (pos >> 3));
  41
  42         bits->bits   = p_new(unsigned char, bits->size + prepend);
  43         memcpy(bits->bits + prepend, tmp, bits->size);
  44         bits->size  += prepend;
  45         bits->start -= prepend;
  46         p_delete(&tmp);
  47     }
  48 }