blob: af027be2d66d28ecf8a9b09211cda7c466b7f333 [file] [log] [blame]
/*
* Copyright (c) 2018-2020 Apple Inc. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY APPLE INC. ``AS IS'' AND ANY
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL APPLE INC. OR
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
* OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#ifndef PAS_BITVECTOR_H
#define PAS_BITVECTOR_H
#include "pas_found_bit_index.h"
#include "pas_utils.h"
PAS_BEGIN_EXTERN_C;
#define PAS_BITVECTOR_BITS_PER_WORD 32
#define PAS_BITVECTOR_BITS_PER_WORD64 64
#define PAS_BITVECTOR_WORD_SHIFT 5
#define PAS_BITVECTOR_NUM_WORDS(num_bits) (((num_bits) + 31) >> 5)
#define PAS_BITVECTOR_NUM_WORDS64(num_bits) (((num_bits) + 63) >> 6)
#define PAS_BITVECTOR_NUM_BYTES(num_bits) (PAS_BITVECTOR_NUM_WORDS(num_bits) * sizeof(unsigned))
#define PAS_BITVECTOR_NUM_BITS(num_words) ((num_words) << 5)
#define PAS_BITVECTOR_NUM_BITS64(num_words) ((num_words) << 6)
#define PAS_BITVECTOR_NUM_BYTES64(num_bits) (PAS_BITVECTOR_NUM_WORDS64(num_bits) * sizeof(uint64_t))
#define PAS_BITVECTOR_WORD_INDEX(bit_index) ((bit_index) >> 5)
#define PAS_BITVECTOR_WORD64_INDEX(bit_index) ((bit_index) >> 6)
#define PAS_BITVECTOR_BIT_INDEX(word_index) ((word_index) << 5)
#define PAS_BITVECTOR_BIT_INDEX64(word_index) ((word_index) << 6)
#define PAS_BITVECTOR_BIT_SHIFT(bit_index) ((bit_index) & 31)
#define PAS_BITVECTOR_BIT_SHIFT64(bit_index) ((bit_index) & 63)
#define PAS_BITVECTOR_BIT_MASK(bit_index) (1 << PAS_BITVECTOR_BIT_SHIFT(bit_index))
#define PAS_BITVECTOR_BIT_MASK64(bit_index) (((uint64_t)1) << PAS_BITVECTOR_BIT_SHIFT64(bit_index))
/* Backward bitvectors are negatively indexed and big endian. That means, for example, that bit
0 hugs the left side of where the unsigned* bits points. So, both bits[-1] and
((uint8_t*)bits)[-1] will see that bit. This preserves the property that the bitvector can be
reinterpreted using any word width. The compiler will use the heck out of this capability: it
will load 64-bit words. */
#define PAS_BACKWARD_BITVECTOR_WORD_INDEX(bit_index) (-1lu - PAS_BITVECTOR_WORD_INDEX(bit_index))
#define PAS_BACKWARD_BITVECTOR_BIT_MASK(bit_index) (0x80000000 >> ((bit_index) & 31))
/* This crazy functionality is for optimized accesses to the pxi_pre_header. */
#define PAS_BACKWARD_BITVECTOR_BYTE_INDEX(bit_index) (-1l - ((bit_index) >> 3))
#define PAS_BACKWARD_BITVECTOR_BYTE_BIT_MASK(bit_index) \
(0x80 >> ((bit_index) & 7))
#define PAS_BACKWARD_BITVECTOR_WORDPTR_PER_BYTE_BYTE_INDEX(bit_index) \
(-sizeof(uintptr_t) - ((bit_index) >> 3))
#define PAS_BACKWARD_BITVECTOR_WORDPTR_PER_BYTE_INDEX_IN_WORD(bit_index) \
((sizeof(uintptr_t) * 8 - 1) - (bit_index & 7))
static inline bool pas_bitvector_get_from_word(unsigned word, size_t index)
{
return word & PAS_BITVECTOR_BIT_MASK(index);
}
static inline bool pas_bitvector_get(const unsigned* bits, size_t index)
{
return pas_bitvector_get_from_word(bits[PAS_BITVECTOR_WORD_INDEX(index)], index);
}
static inline bool pas_bitvector_get_from_one_word(unsigned* bits, size_t index)
{
PAS_ASSERT(index < PAS_BITVECTOR_BITS_PER_WORD);
return pas_bitvector_get_from_word(*bits, index);
}
/* The bits pointer has to point to the right of the bitvector. So at the very end of it. */
static inline bool pas_backward_bitvector_get(const unsigned* backward_bits, size_t index)
{
return backward_bits[PAS_BACKWARD_BITVECTOR_WORD_INDEX(index)] &
PAS_BACKWARD_BITVECTOR_BIT_MASK(index);
}
static inline void pas_bitvector_set_in_word(unsigned* word_ptr, size_t index, bool value)
{
if (value)
(*word_ptr) |= PAS_BITVECTOR_BIT_MASK(index);
else
(*word_ptr) &= ~PAS_BITVECTOR_BIT_MASK(index);
}
static inline void pas_bitvector_set(unsigned* bits, size_t index, bool value)
{
pas_bitvector_set_in_word(bits + PAS_BITVECTOR_WORD_INDEX(index), index, value);
}
static inline void pas_bitvector_set_in_one_word(unsigned* bits, size_t index, bool value)
{
PAS_ASSERT(index < PAS_BITVECTOR_BITS_PER_WORD);
pas_bitvector_set_in_word(bits, index, value);
}
/* Returns whether we changed the value. */
static inline bool pas_bitvector_set_atomic_in_word(unsigned* word_ptr, size_t index, bool value)
{
for (;;) {
unsigned old_value;
unsigned new_value;
old_value = *word_ptr;
new_value = old_value;
pas_bitvector_set_in_word(&new_value, index, value);
if (old_value == new_value)
return false;
if (pas_compare_and_swap_uint32_weak(word_ptr, old_value, new_value))
return true;
}
}
static inline bool pas_bitvector_set_atomic(unsigned* bits, size_t index, bool value)
{
return pas_bitvector_set_atomic_in_word(
bits + PAS_BITVECTOR_WORD_INDEX(index), index, value);
}
static inline void pas_backward_bitvector_set(unsigned* backward_bits, size_t index, bool value)
{
if (value) {
backward_bits[PAS_BACKWARD_BITVECTOR_WORD_INDEX(index)] |=
PAS_BACKWARD_BITVECTOR_BIT_MASK(index);
} else {
backward_bits[PAS_BACKWARD_BITVECTOR_WORD_INDEX(index)] &=
~PAS_BACKWARD_BITVECTOR_BIT_MASK(index);
}
}
static inline pas_found_bit_index pas_bitvector_find_first_set(const unsigned* bits,
size_t word_index,
size_t num_words)
{
do {
unsigned word;
word = bits[word_index];
if (word) {
return pas_found_bit_index_create(
PAS_BITVECTOR_BIT_INDEX(word_index) + (size_t)__builtin_ctz(word),
word_index,
word);
}
word_index++;
} while (word_index < num_words);
return pas_found_bit_index_create_empty();
}
typedef unsigned (*pas_bitvector_bits_source)(size_t word_index, void* arg);
typedef bool (*pas_bitvector_for_each_set_bit_callback)(pas_found_bit_index index,
void* arg);
static PAS_ALWAYS_INLINE bool pas_bitvector_for_each_set_bit(
pas_bitvector_bits_source bits_source,
size_t start_word_index,
size_t end_word_index,
pas_bitvector_for_each_set_bit_callback callback,
void* arg)
{
size_t word_index;
for (word_index = start_word_index; word_index < end_word_index; ++word_index) {
unsigned word;
size_t base_index;
word = bits_source(word_index, arg);
base_index = PAS_BITVECTOR_BIT_INDEX(word_index);
while (word) {
unsigned index_offset;
index_offset = (unsigned)__builtin_ctz(word);
if (!callback(
pas_found_bit_index_create(base_index + index_offset, word_index, word),
arg))
return false;
pas_bitvector_set_in_word(&word, index_offset, false);
}
}
return true;
}
/* Remember: in little-endian, a 64-bit bitvector and a 32-bit bitvector are actually the same
thing *except* that the 32-bit bitvector may not have a whole number of 64-bit words. */
static PAS_ALWAYS_INLINE void pas_bitvector64_set_range(
uint64_t* bits64,
size_t begin, /* inclusive */
size_t end, /* exclusive */
bool value)
{
size_t begin_word_index;
size_t end_word_index;
size_t begin_bit_shift;
size_t end_bit_shift;
size_t index;
begin_word_index = PAS_BITVECTOR_WORD64_INDEX(begin);
begin_bit_shift = PAS_BITVECTOR_BIT_SHIFT64(begin);
end_word_index = PAS_BITVECTOR_WORD64_INDEX(end);
end_bit_shift = PAS_BITVECTOR_BIT_SHIFT64(end);
if (begin_bit_shift) {
uint64_t mask;
mask = UINT64_MAX << begin_bit_shift;
if (value)
bits64[begin_word_index] |= mask;
else
bits64[begin_word_index] &= ~mask;
begin_word_index++;
}
for (index = begin_word_index; index < end_word_index; ++index)
bits64[index] = value ? UINT64_MAX : 0;
if (end_bit_shift) {
uint64_t mask;
mask = pas_make_mask64(end_bit_shift);
if (value)
bits64[end_word_index] |= mask;
else
bits64[end_word_index] &= ~mask;
}
}
PAS_END_EXTERN_C;
#endif /* PAS_BITVECTOR_H */