#include <stdbool.h>
#include <stdlib.h>
#include <string.h>
+#include <limits.h>
-#define BITS_PER_LONG (sizeof(unsigned long) * 8)
+#include <ccan/endian/endian.h>
-#define BYTE(_bm, _n) (((unsigned char *)(_bm))[(_n) / 8])
-#define LONG(_bm, _n) (((unsigned long *)(_bm))[(_n) / BITS_PER_LONG])
-#define BIT(_n) (0x80 >> ((_n) % 8))
+typedef unsigned long bitmap_word;
-#define BYTES(_nbits) ((_nbits) / 8)
-#define BITS(_nbits) ((~(0xff >> ((_nbits) % 8))) & 0xff)
+#define BITMAP_WORD_BITS (sizeof(bitmap_word) * CHAR_BIT)
+#define BITMAP_NWORDS(_n) \
+ (((_n) + BITMAP_WORD_BITS - 1) / BITMAP_WORD_BITS)
-static inline void bitmap_set_bit(void *bitmap, int n)
+/*
+ * We wrap each word in a structure for type checking.
+ */
+typedef struct {
+ bitmap_word w;
+} bitmap;
+
+#define BITMAP_DECLARE(_name, _nbits) \
+ bitmap (_name)[BITMAP_NWORDS(_nbits)]
+
+static inline size_t bitmap_sizeof(int nbits)
{
- BYTE(bitmap, n) |= BIT(n);
+ return BITMAP_NWORDS(nbits) * sizeof(bitmap_word);
}
-static inline void bitmap_clear_bit(void *bitmap, int n)
+static inline bitmap *bitmap_alloc(int nbits)
{
- BYTE(bitmap, n) &= ~BIT(n);
+ return malloc(bitmap_sizeof(nbits));
}
-static inline void bitmap_change_bit(void *bitmap, int n)
+static inline bitmap_word bitmap_bswap(bitmap_word w)
{
- BYTE(bitmap, n) ^= BIT(n);
+ if (BITMAP_WORD_BITS == 32)
+ return cpu_to_be32(w);
+ else if (BITMAP_WORD_BITS == 64)
+ return cpu_to_be64(w);
}
-static inline bool bitmap_test_bit(void *bitmap, int n)
+#define BITMAP_WORD(_bm, _n) ((_bm)[(_n) / BITMAP_WORD_BITS].w)
+#define BITMAP_WORDBIT(_n) \
+ (bitmap_bswap(1UL << (BITMAP_WORD_BITS - ((_n) % BITMAP_WORD_BITS) - 1)))
+
+#define BITMAP_HEADWORDS(_nbits) \
+ ((_nbits) / BITMAP_WORD_BITS)
+#define BITMAP_HEADBYTES(_nbits) \
+ (BITMAP_HEADWORDS(_nbits) * sizeof(bitmap_word))
+
+#define BITMAP_TAILWORD(_bm, _nbits) \
+ ((_bm)[BITMAP_HEADWORDS(_nbits)].w)
+#define BITMAP_HASTAIL(_nbits) (((_nbits) % BITMAP_WORD_BITS) != 0)
+#define BITMAP_TAILBITS(_nbits) \
+ (bitmap_bswap(~(-1UL >> ((_nbits) % BITMAP_WORD_BITS))))
+#define BITMAP_TAIL(_bm, _nbits) \
+ (BITMAP_TAILWORD(_bm, _nbits) & BITMAP_TAILBITS(_nbits))
+
+static inline void bitmap_set_bit(bitmap *bitmap, int n)
{
- return !!(BYTE(bitmap, n) & BIT(n));
+ BITMAP_WORD(bitmap, n) |= BITMAP_WORDBIT(n);
}
+static inline void bitmap_clear_bit(bitmap *bitmap, int n)
+{
+ BITMAP_WORD(bitmap, n) &= ~BITMAP_WORDBIT(n);
+}
-static inline void bitmap_zero(void *bitmap, int nbits)
+static inline void bitmap_change_bit(bitmap *bitmap, int n)
{
- memset(bitmap, 0, BYTES(nbits));
- if (BITS(nbits))
- BYTE(bitmap, nbits) &= ~BITS(nbits);
+ BITMAP_WORD(bitmap, n) ^= BITMAP_WORDBIT(n);
}
-static inline void bitmap_fill(void *bitmap, int nbits)
+static inline bool bitmap_test_bit(bitmap *bitmap, int n)
{
- memset(bitmap, 0xff, BYTES(nbits));
- if (BITS(nbits))
- BYTE(bitmap, nbits) |= BITS(nbits);
+ return !!(BITMAP_WORD(bitmap, n) & BITMAP_WORDBIT(n));
}
-static inline void bitmap_copy(void *dst, void *src, int nbits)
+
+static inline void bitmap_zero(bitmap *bitmap, int nbits)
{
- memcpy(dst, src, BYTES(nbits));
- if (BITS(nbits)) {
- BYTE(dst, nbits) &= ~BITS(nbits);
- BYTE(dst, nbits) |= BYTE(src, nbits) & BITS(nbits);
- }
+ memset(bitmap, 0, bitmap_sizeof(nbits));
}
-#define DEF_BINOP(_name, _op) \
- static inline void bitmap_##_name(void *dst, void *src1, void *src2, \
+static inline void bitmap_fill(bitmap *bitmap, int nbits)
+{
+ memset(bitmap, 0xff, bitmap_sizeof(nbits));
+}
+
+static inline void bitmap_copy(bitmap *dst, bitmap *src, int nbits)
+{
+ memcpy(dst, src, bitmap_sizeof(nbits));
+}
+
+#define BITMAP_DEF_BINOP(_name, _op) \
+ static inline void bitmap_##_name(bitmap *dst, bitmap *src1, bitmap *src2, \
int nbits) \
{ \
- int n = 0; \
- while ((nbits - n) >= BITS_PER_LONG) { \
- LONG(dst, n) = LONG(src1, n) _op LONG(src2, n); \
- n += BITS_PER_LONG; \
- } \
- while ((nbits - n) >= 8) { \
- BYTE(dst, n) = BYTE(src1, n) _op BYTE(src2, n); \
- n += 8; \
- } \
- if (BITS(nbits)) { \
- BYTE(dst, nbits) &= ~BITS(nbits); \
- BYTE(dst, nbits) |= (BYTE(src1, nbits) _op BYTE(src2, nbits)) \
- & BITS(nbits); \
+ int i = 0; \
+ for (i = 0; i < BITMAP_NWORDS(nbits); i++) { \
+ dst[i].w = src1[i].w _op src2[i].w; \
} \
}
-DEF_BINOP(and, &)
-DEF_BINOP(or, |)
-DEF_BINOP(xor, ^)
-DEF_BINOP(andnot, & ~)
+BITMAP_DEF_BINOP(and, &)
+BITMAP_DEF_BINOP(or, |)
+BITMAP_DEF_BINOP(xor, ^)
+BITMAP_DEF_BINOP(andnot, & ~)
-#undef DEF_BINOP
+#undef BITMAP_DEF_BINOP
-static inline void bitmap_complement(void *dst, void *src, int nbits)
+static inline void bitmap_complement(bitmap *dst, bitmap *src, int nbits)
{
- int n = 0;
+ int i;
- while ((nbits - n) >= BITS_PER_LONG) {
- LONG(dst, n) = ~LONG(src, n);
- n += BITS_PER_LONG;
- }
- while ((nbits - n) >= 8) {
- BYTE(dst, n) = ~BYTE(src, n);
- n += 8;
- }
- if (BITS(nbits)) {
- BYTE(dst, nbits) &= ~BITS(nbits);
- BYTE(dst, nbits) |= ~BYTE(src, nbits) & BITS(nbits);
- }
+ for (i = 0; i < BITMAP_NWORDS(nbits); i++)
+ dst[i].w = ~src[i].w;
}
-static inline bool bitmap_equal(void *src1, void *src2, int nbits)
+static inline bool bitmap_equal(bitmap *src1, bitmap *src2, int nbits)
{
- if (memcmp(src1, src2, BYTES(nbits)) != 0)
- return false;
- if ((BYTE(src1, nbits) & BITS(nbits))
- != (BYTE(src2, nbits) & BITS(nbits)))
- return false;
- return true;
+ return (memcmp(src1, src2, BITMAP_HEADBYTES(nbits)) == 0)
+ && (!BITMAP_HASTAIL(nbits)
+ || (BITMAP_TAIL(src1, nbits) == BITMAP_TAIL(src2, nbits)));
}
-static inline bool bitmap_intersects(void *src1, void *src2, int nbits)
+static inline bool bitmap_intersects(bitmap *src1, bitmap *src2, int nbits)
{
- int n = 0;
+ int i;
- while ((nbits - n) >= BITS_PER_LONG) {
- if (LONG(src1, n) & LONG(src2, n))
- return true;
- n += BITS_PER_LONG;
- }
- while ((nbits - n) >= 8) {
- if (BYTE(src1, n) & BYTE(src2, n))
+ for (i = 0; i < BITMAP_HEADWORDS(nbits); i++) {
+ if (src1[i].w & src2[i].w)
return true;
- n += 8;
}
- if (BITS(nbits) & BYTE(src1, nbits) & BYTE(src2, nbits)) {
+ if (BITMAP_HASTAIL(nbits) &&
+ (BITMAP_TAIL(src1, nbits) & BITMAP_TAIL(src2, nbits)))
return true;
- }
return false;
}
-static inline bool bitmap_subset(void *src1, void *src2, int nbits)
+static inline bool bitmap_subset(bitmap *src1, bitmap *src2, int nbits)
{
- int n = 0;
+ int i;
- while ((nbits - n) >= BITS_PER_LONG) {
- if (LONG(src1, n) & ~LONG(src2, n))
+ for (i = 0; i < BITMAP_HEADWORDS(nbits); i++) {
+ if (src1[i].w & ~src2[i].w)
return false;
- n += BITS_PER_LONG;
}
- while ((nbits - n) >= 8) {
- if (BYTE(src1, n) & ~BYTE(src2, n))
- return false;
- n += 8;
- }
- if (BITS(nbits) & (BYTE(src1, nbits) & ~BYTE(src2, nbits))) {
+ if (BITMAP_HASTAIL(nbits) &&
+ (BITMAP_TAIL(src1, nbits) & ~BITMAP_TAIL(src2, nbits)))
return false;
- }
return true;
}
-static inline bool bitmap_full(void *bitmap, int nbits)
+static inline bool bitmap_full(bitmap *bitmap, int nbits)
{
- int n = 0;
+ int i;
- while ((nbits - n) >= BITS_PER_LONG) {
- if (LONG(bitmap, n) != -1UL)
+ for (i = 0; i < BITMAP_HEADWORDS(nbits); i++) {
+ if (bitmap[i].w != -1UL)
return false;
- n += BITS_PER_LONG;
}
- while ((nbits - n) >= 8) {
- if (BYTE(bitmap, n) != 0xff)
- return false;
- n += 8;
- }
- if (BITS(nbits)
- && ((BITS(nbits) & BYTE(bitmap, nbits)) != BITS(nbits))) {
+ if (BITMAP_HASTAIL(nbits) &&
+ (BITMAP_TAIL(bitmap, nbits) != BITMAP_TAILBITS(nbits)))
return false;
- }
+
return true;
}
-static inline bool bitmap_empty(void *bitmap, int nbits)
+static inline bool bitmap_empty(bitmap *bitmap, int nbits)
{
- int n = 0;
+ int i;
- while ((nbits - n) >= BITS_PER_LONG) {
- if (LONG(bitmap, n))
- return false;
- n += BITS_PER_LONG;
- }
- while ((nbits - n) >= 8) {
- if (BYTE(bitmap, n))
+ for (i = 0; i < BITMAP_HEADWORDS(nbits); i++) {
+ if (bitmap[i].w != 0)
return false;
- n += 8;
}
- if (BITS(nbits) && ((BITS(nbits) & BYTE(bitmap, nbits)))) {
+ if (BITMAP_HASTAIL(nbits) && (BITMAP_TAIL(bitmap, nbits) != 0))
return false;
- }
- return true;
-}
-
-static inline void *bitmap_alloc(int nbits)
-{
- return malloc((nbits + 7) / 8);
+ return true;
}
-#undef BYTE
-#undef LONG
-#undef BIT
-#undef BYTES
-#undef BITS
-
#endif /* CCAN_BITMAP_H_ */