531 lines
11 KiB
C
531 lines
11 KiB
C
/*
|
|
* This file Copyright (C) 2008-2014 Mnemosyne LLC
|
|
*
|
|
* It may be used under the GNU GPL versions 2 or 3
|
|
* or any future license endorsed by Mnemosyne LLC.
|
|
*
|
|
*/
|
|
|
|
#include <string.h> /* memset */
|
|
|
|
#include "transmission.h"
|
|
#include "bitfield.h"
|
|
#include "tr-assert.h"
|
|
#include "utils.h" /* tr_new0() */
|
|
|
|
tr_bitfield const TR_BITFIELD_INIT =
|
|
{
|
|
.bits = NULL,
|
|
.alloc_count = 0,
|
|
.bit_count = 0,
|
|
.true_count = 0,
|
|
.have_all_hint = false,
|
|
.have_none_hint = false
|
|
};
|
|
|
|
/****
|
|
*****
|
|
****/
|
|
|
|
static int8_t const trueBitCount[256] =
|
|
{
|
|
0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4,
|
|
1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5,
|
|
1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7,
|
|
1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7,
|
|
2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,
|
|
3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7,
|
|
3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7,
|
|
4, 5, 5, 6, 5, 6, 6, 7, 5, 6, 6, 7, 6, 7, 7, 8
|
|
};
|
|
|
|
static size_t countArray(tr_bitfield const* b)
|
|
{
|
|
size_t ret = 0;
|
|
size_t i = b->alloc_count;
|
|
|
|
while (i > 0)
|
|
{
|
|
ret += trueBitCount[b->bits[--i]];
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static size_t countRange(tr_bitfield const* b, size_t begin, size_t end)
|
|
{
|
|
size_t ret = 0;
|
|
size_t const first_byte = begin >> 3U;
|
|
size_t const last_byte = (end - 1) >> 3U;
|
|
|
|
if (b->bit_count == 0)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
if (first_byte >= b->alloc_count)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
TR_ASSERT(begin < end);
|
|
TR_ASSERT(b->bits != NULL);
|
|
|
|
if (first_byte == last_byte)
|
|
{
|
|
int i;
|
|
uint8_t val = b->bits[first_byte];
|
|
|
|
i = begin - (first_byte * 8);
|
|
val <<= i;
|
|
val >>= i;
|
|
i = (last_byte + 1) * 8 - end;
|
|
val >>= i;
|
|
val <<= i;
|
|
|
|
ret += trueBitCount[val];
|
|
}
|
|
else
|
|
{
|
|
uint8_t val;
|
|
size_t const walk_end = MIN(b->alloc_count, last_byte);
|
|
|
|
/* first byte */
|
|
size_t const first_shift = begin - (first_byte * 8);
|
|
val = b->bits[first_byte];
|
|
val <<= first_shift;
|
|
val >>= first_shift;
|
|
ret += trueBitCount[val];
|
|
|
|
/* middle bytes */
|
|
for (size_t i = first_byte + 1; i < walk_end; ++i)
|
|
{
|
|
ret += trueBitCount[b->bits[i]];
|
|
}
|
|
|
|
/* last byte */
|
|
if (last_byte < b->alloc_count)
|
|
{
|
|
size_t const last_shift = (last_byte + 1) * 8 - end;
|
|
val = b->bits[last_byte];
|
|
val >>= last_shift;
|
|
val <<= last_shift;
|
|
ret += trueBitCount[val];
|
|
}
|
|
}
|
|
|
|
TR_ASSERT(ret <= (begin - end));
|
|
return ret;
|
|
}
|
|
|
|
size_t tr_bitfieldCountRange(tr_bitfield const* b, size_t begin, size_t end)
|
|
{
|
|
if (tr_bitfieldHasAll(b))
|
|
{
|
|
return end - begin;
|
|
}
|
|
|
|
if (tr_bitfieldHasNone(b))
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
return countRange(b, begin, end);
|
|
}
|
|
|
|
bool tr_bitfieldHas(tr_bitfield const* b, size_t n)
|
|
{
|
|
if (tr_bitfieldHasAll(b))
|
|
{
|
|
return true;
|
|
}
|
|
|
|
if (tr_bitfieldHasNone(b))
|
|
{
|
|
return false;
|
|
}
|
|
|
|
if (n >> 3U >= b->alloc_count)
|
|
{
|
|
return false;
|
|
}
|
|
|
|
return (b->bits[n >> 3U] << (n & 7U) & 0x80) != 0;
|
|
}
|
|
|
|
/***
|
|
****
|
|
***/
|
|
|
|
#ifdef TR_ENABLE_ASSERTS
|
|
|
|
static bool tr_bitfieldIsValid(tr_bitfield const* b)
|
|
{
|
|
TR_ASSERT(b != NULL);
|
|
TR_ASSERT((b->alloc_count == 0) == (b->bits == NULL));
|
|
TR_ASSERT(b->bits == NULL || b->true_count == countArray(b));
|
|
|
|
return true;
|
|
}
|
|
|
|
#endif
|
|
|
|
size_t tr_bitfieldCountTrueBits(tr_bitfield const* b)
|
|
{
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
|
|
return b->true_count;
|
|
}
|
|
|
|
static size_t get_bytes_needed(size_t bit_count)
|
|
{
|
|
return (bit_count >> 3) + ((bit_count & 7) != 0 ? 1 : 0);
|
|
}
|
|
|
|
static void set_all_true(uint8_t* array, size_t bit_count)
|
|
{
|
|
uint8_t const val = 0xFF;
|
|
size_t const n = get_bytes_needed(bit_count);
|
|
|
|
if (n > 0)
|
|
{
|
|
memset(array, val, n - 1);
|
|
|
|
array[n - 1] = val << (n * 8 - bit_count);
|
|
}
|
|
}
|
|
|
|
void* tr_bitfieldGetRaw(tr_bitfield const* b, size_t* byte_count)
|
|
{
|
|
TR_ASSERT(b->bit_count > 0);
|
|
|
|
size_t const n = get_bytes_needed(b->bit_count);
|
|
uint8_t* bits = tr_new0(uint8_t, n);
|
|
|
|
if (b->alloc_count != 0)
|
|
{
|
|
TR_ASSERT(b->alloc_count <= n);
|
|
memcpy(bits, b->bits, b->alloc_count);
|
|
}
|
|
else if (tr_bitfieldHasAll(b))
|
|
{
|
|
set_all_true(bits, b->bit_count);
|
|
}
|
|
|
|
*byte_count = n;
|
|
return bits;
|
|
}
|
|
|
|
static void tr_bitfieldEnsureBitsAlloced(tr_bitfield* b, size_t n)
|
|
{
|
|
size_t bytes_needed;
|
|
bool const has_all = tr_bitfieldHasAll(b);
|
|
|
|
if (has_all)
|
|
{
|
|
bytes_needed = get_bytes_needed(MAX(n, b->true_count));
|
|
}
|
|
else
|
|
{
|
|
bytes_needed = get_bytes_needed(n);
|
|
}
|
|
|
|
if (b->alloc_count < bytes_needed)
|
|
{
|
|
b->bits = tr_renew(uint8_t, b->bits, bytes_needed);
|
|
memset(b->bits + b->alloc_count, 0, bytes_needed - b->alloc_count);
|
|
b->alloc_count = bytes_needed;
|
|
|
|
if (has_all)
|
|
{
|
|
set_all_true(b->bits, b->true_count);
|
|
}
|
|
}
|
|
}
|
|
|
|
static bool tr_bitfieldEnsureNthBitAlloced(tr_bitfield* b, size_t nth)
|
|
{
|
|
/* count is zero-based, so we need to allocate nth+1 bits before setting the nth */
|
|
if (nth == SIZE_MAX)
|
|
{
|
|
return false;
|
|
}
|
|
|
|
tr_bitfieldEnsureBitsAlloced(b, nth + 1);
|
|
return true;
|
|
}
|
|
|
|
static void tr_bitfieldFreeArray(tr_bitfield* b)
|
|
{
|
|
tr_free(b->bits);
|
|
b->bits = NULL;
|
|
b->alloc_count = 0;
|
|
}
|
|
|
|
static void tr_bitfieldSetTrueCount(tr_bitfield* b, size_t n)
|
|
{
|
|
TR_ASSERT(b->bit_count == 0 || n <= b->bit_count);
|
|
|
|
b->true_count = n;
|
|
|
|
if (tr_bitfieldHasAll(b) || tr_bitfieldHasNone(b))
|
|
{
|
|
tr_bitfieldFreeArray(b);
|
|
}
|
|
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
}
|
|
|
|
static void tr_bitfieldRebuildTrueCount(tr_bitfield* b)
|
|
{
|
|
tr_bitfieldSetTrueCount(b, countArray(b));
|
|
}
|
|
|
|
static void tr_bitfieldIncTrueCount(tr_bitfield* b, size_t i)
|
|
{
|
|
TR_ASSERT(b->bit_count == 0 || i <= b->bit_count);
|
|
TR_ASSERT(b->bit_count == 0 || b->true_count <= b->bit_count - i);
|
|
|
|
tr_bitfieldSetTrueCount(b, b->true_count + i);
|
|
}
|
|
|
|
static void tr_bitfieldDecTrueCount(tr_bitfield* b, size_t i)
|
|
{
|
|
TR_ASSERT(b->bit_count == 0 || i <= b->bit_count);
|
|
TR_ASSERT(b->bit_count == 0 || b->true_count >= i);
|
|
|
|
tr_bitfieldSetTrueCount(b, b->true_count - i);
|
|
}
|
|
|
|
/****
|
|
*****
|
|
****/
|
|
|
|
void tr_bitfieldConstruct(tr_bitfield* b, size_t bit_count)
|
|
{
|
|
b->bit_count = bit_count;
|
|
b->true_count = 0;
|
|
b->bits = NULL;
|
|
b->alloc_count = 0;
|
|
b->have_all_hint = false;
|
|
b->have_none_hint = false;
|
|
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
}
|
|
|
|
void tr_bitfieldSetHasNone(tr_bitfield* b)
|
|
{
|
|
tr_bitfieldFreeArray(b);
|
|
b->true_count = 0;
|
|
b->have_all_hint = false;
|
|
b->have_none_hint = true;
|
|
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
}
|
|
|
|
void tr_bitfieldSetHasAll(tr_bitfield* b)
|
|
{
|
|
tr_bitfieldFreeArray(b);
|
|
b->true_count = b->bit_count;
|
|
b->have_all_hint = true;
|
|
b->have_none_hint = false;
|
|
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
}
|
|
|
|
void tr_bitfieldSetFromBitfield(tr_bitfield* b, tr_bitfield const* src)
|
|
{
|
|
if (tr_bitfieldHasAll(src))
|
|
{
|
|
tr_bitfieldSetHasAll(b);
|
|
}
|
|
else if (tr_bitfieldHasNone(src))
|
|
{
|
|
tr_bitfieldSetHasNone(b);
|
|
}
|
|
else
|
|
{
|
|
tr_bitfieldSetRaw(b, src->bits, src->alloc_count, true);
|
|
}
|
|
}
|
|
|
|
void tr_bitfieldSetRaw(tr_bitfield* b, void const* bits, size_t byte_count, bool bounded)
|
|
{
|
|
tr_bitfieldFreeArray(b);
|
|
b->true_count = 0;
|
|
|
|
if (bounded)
|
|
{
|
|
byte_count = MIN(byte_count, get_bytes_needed(b->bit_count));
|
|
}
|
|
|
|
b->bits = tr_memdup(bits, byte_count);
|
|
b->alloc_count = byte_count;
|
|
|
|
if (bounded)
|
|
{
|
|
/* ensure the excess bits are set to '0' */
|
|
int const excess_bit_count = byte_count * 8 - b->bit_count;
|
|
|
|
TR_ASSERT(excess_bit_count >= 0);
|
|
TR_ASSERT(excess_bit_count <= 7);
|
|
|
|
if (excess_bit_count != 0)
|
|
{
|
|
b->bits[b->alloc_count - 1] &= 0xff << excess_bit_count;
|
|
}
|
|
}
|
|
|
|
tr_bitfieldRebuildTrueCount(b);
|
|
}
|
|
|
|
void tr_bitfieldSetFromFlags(tr_bitfield* b, bool const* flags, size_t n)
|
|
{
|
|
size_t trueCount = 0;
|
|
|
|
tr_bitfieldFreeArray(b);
|
|
tr_bitfieldEnsureBitsAlloced(b, n);
|
|
|
|
for (size_t i = 0; i < n; ++i)
|
|
{
|
|
if (flags[i])
|
|
{
|
|
++trueCount;
|
|
b->bits[i >> 3U] |= (0x80 >> (i & 7U));
|
|
}
|
|
}
|
|
|
|
tr_bitfieldSetTrueCount(b, trueCount);
|
|
}
|
|
|
|
void tr_bitfieldAdd(tr_bitfield* b, size_t nth)
|
|
{
|
|
if (!tr_bitfieldHas(b, nth) && tr_bitfieldEnsureNthBitAlloced(b, nth))
|
|
{
|
|
size_t const offset = nth >> 3U;
|
|
|
|
if ((b->bits != NULL) && (offset < b->alloc_count))
|
|
{
|
|
b->bits[offset] |= 0x80 >> (nth & 7U);
|
|
tr_bitfieldIncTrueCount(b, 1);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Sets bit range [begin, end) to 1 */
|
|
void tr_bitfieldAddRange(tr_bitfield* b, size_t begin, size_t end)
|
|
{
|
|
size_t sb;
|
|
size_t eb;
|
|
unsigned char sm;
|
|
unsigned char em;
|
|
size_t const diff = (end - begin) - tr_bitfieldCountRange(b, begin, end);
|
|
|
|
if (diff == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
end--;
|
|
|
|
if (end >= b->bit_count || begin > end)
|
|
{
|
|
return;
|
|
}
|
|
|
|
sb = begin >> 3;
|
|
sm = ~(0xff << (8 - (begin & 7)));
|
|
eb = end >> 3;
|
|
em = 0xff << (7 - (end & 7));
|
|
|
|
if (!tr_bitfieldEnsureNthBitAlloced(b, end))
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (sb == eb)
|
|
{
|
|
b->bits[sb] |= sm & em;
|
|
}
|
|
else
|
|
{
|
|
b->bits[sb] |= sm;
|
|
b->bits[eb] |= em;
|
|
|
|
if (++sb < eb)
|
|
{
|
|
memset(b->bits + sb, 0xff, eb - sb);
|
|
}
|
|
}
|
|
|
|
tr_bitfieldIncTrueCount(b, diff);
|
|
}
|
|
|
|
void tr_bitfieldRem(tr_bitfield* b, size_t nth)
|
|
{
|
|
TR_ASSERT(tr_bitfieldIsValid(b));
|
|
|
|
if (tr_bitfieldHas(b, nth) && tr_bitfieldEnsureNthBitAlloced(b, nth))
|
|
{
|
|
b->bits[nth >> 3U] &= 0xff7f >> (nth & 7U);
|
|
tr_bitfieldDecTrueCount(b, 1);
|
|
}
|
|
}
|
|
|
|
/* Clears bit range [begin, end) to 0 */
|
|
void tr_bitfieldRemRange(tr_bitfield* b, size_t begin, size_t end)
|
|
{
|
|
size_t sb;
|
|
size_t eb;
|
|
unsigned char sm;
|
|
unsigned char em;
|
|
size_t const diff = tr_bitfieldCountRange(b, begin, end);
|
|
|
|
if (diff == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
end--;
|
|
|
|
if (end >= b->bit_count || begin > end)
|
|
{
|
|
return;
|
|
}
|
|
|
|
sb = begin >> 3;
|
|
sm = 0xff << (8 - (begin & 7));
|
|
eb = end >> 3;
|
|
em = ~(0xff << (7 - (end & 7)));
|
|
|
|
if (!tr_bitfieldEnsureNthBitAlloced(b, end))
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (sb == eb)
|
|
{
|
|
b->bits[sb] &= sm | em;
|
|
}
|
|
else
|
|
{
|
|
b->bits[sb] &= sm;
|
|
b->bits[eb] &= em;
|
|
|
|
if (++sb < eb)
|
|
{
|
|
memset(b->bits + sb, 0, eb - sb);
|
|
}
|
|
}
|
|
|
|
tr_bitfieldDecTrueCount(b, diff);
|
|
}
|