1use std::io::{Cursor, Write};
2
3use azalea_buf::{AzBuf, AzaleaRead, AzaleaWrite, BufReadError};
4
5#[derive(Debug, Clone, PartialEq, Eq, Hash, Default, AzBuf)]
7pub struct BitSet {
8 data: Vec<u64>,
9}
10
11const ADDRESS_BITS_PER_WORD: usize = 6;
12
13impl BitSet {
15 pub fn new(num_bits: usize) -> Self {
16 BitSet {
17 data: vec![0; num_bits.div_ceil(64)],
18 }
19 }
20
21 pub fn index(&self, index: usize) -> bool {
22 (self.data[index / 64] & (1u64 << (index % 64))) != 0
23 }
24
25 fn check_range(&self, from_index: usize, to_index: usize) {
26 assert!(
27 from_index <= to_index,
28 "fromIndex: {from_index} > toIndex: {to_index}",
29 );
30 }
31
32 fn word_index(&self, bit_index: usize) -> usize {
33 bit_index >> ADDRESS_BITS_PER_WORD
34 }
35
36 pub fn clear(&mut self, from_index: usize, mut to_index: usize) {
37 self.check_range(from_index, to_index);
38
39 if from_index == to_index {
40 return;
41 }
42
43 let start_word_index = self.word_index(from_index);
44 if start_word_index >= self.data.len() {
45 return;
46 }
47
48 let mut end_word_index = self.word_index(to_index - 1);
49 if end_word_index >= self.data.len() {
50 to_index = self.len();
51 end_word_index = self.data.len() - 1;
52 }
53
54 let first_word_mask = u64::MAX.wrapping_shl(
55 from_index
56 .try_into()
57 .expect("from_index shouldn't be larger than u32"),
58 );
59 let last_word_mask = u64::MAX.wrapping_shr((64 - (to_index % 64)) as u32);
60 if start_word_index == end_word_index {
61 self.data[start_word_index] &= !(first_word_mask & last_word_mask);
63 } else {
64 self.data[start_word_index] &= !first_word_mask;
67
68 for i in start_word_index + 1..end_word_index {
70 self.data[i] = 0;
71 }
72
73 self.data[end_word_index] &= !last_word_mask;
75 }
76 }
77
78 fn len(&self) -> usize {
81 self.data.len() * 64
82 }
83
84 pub fn next_clear_bit(&self, from_index: usize) -> usize {
87 let mut u = self.word_index(from_index);
88 if u >= self.data.len() {
89 return from_index;
90 }
91
92 let mut word = !self.data[u] & (u64::MAX.wrapping_shl(from_index.try_into().unwrap()));
93
94 loop {
95 if word != 0 {
96 return (u * 64) + word.trailing_zeros() as usize;
97 }
98 u += 1;
99 if u == self.data.len() {
100 return self.data.len() * 64;
101 }
102 word = !self.data[u];
103 }
104 }
105
106 pub fn set(&mut self, bit_index: usize) {
107 self.data[bit_index / 64] |= 1u64 << (bit_index % 64);
108 }
109}
110
111impl From<Vec<u64>> for BitSet {
112 fn from(data: Vec<u64>) -> Self {
113 BitSet { data }
114 }
115}
116
117impl From<Vec<u8>> for BitSet {
118 fn from(data: Vec<u8>) -> Self {
119 let mut words = vec![0; data.len().div_ceil(8)];
120 for (i, byte) in data.iter().enumerate() {
121 words[i / 8] |= (*byte as u64) << ((i % 8) * 8);
122 }
123 BitSet { data: words }
124 }
125}
126
127#[derive(Debug, Clone, PartialEq, Eq, Hash)]
140pub struct FixedBitSet<const N: usize> {
141 data: [u8; N],
142}
143
144impl<const N: usize> FixedBitSet<N> {
145 pub fn new() -> Self {
146 FixedBitSet { data: [0; N] }
147 }
148
149 #[inline]
150 pub fn index(&self, index: usize) -> bool {
151 (self.data[index / 8] & (1u8 << (index % 8))) != 0
152 }
153
154 #[inline]
155 pub fn set(&mut self, bit_index: usize) {
156 self.data[bit_index / 8] |= 1u8 << (bit_index % 8);
157 }
158}
159
160impl<const N: usize> AzaleaRead for FixedBitSet<N> {
161 fn azalea_read(buf: &mut Cursor<&[u8]>) -> Result<Self, BufReadError> {
162 let mut data = [0; N];
163 for item in data.iter_mut().take(N) {
164 *item = u8::azalea_read(buf)?;
165 }
166 Ok(FixedBitSet { data })
167 }
168}
169impl<const N: usize> AzaleaWrite for FixedBitSet<N> {
170 fn azalea_write(&self, buf: &mut impl Write) -> Result<(), std::io::Error> {
171 for i in 0..N {
172 self.data[i].azalea_write(buf)?;
173 }
174 Ok(())
175 }
176}
177impl<const N: usize> Default for FixedBitSet<N> {
178 fn default() -> Self {
179 Self::new()
180 }
181}
182
183#[cfg(test)]
184mod tests {
185 use super::*;
186
187 #[test]
188 fn test_bitset() {
189 let mut bitset = BitSet::new(64);
190 assert!(!bitset.index(0));
191 assert!(!bitset.index(1));
192 assert!(!bitset.index(2));
193 bitset.set(1);
194 assert!(!bitset.index(0));
195 assert!(bitset.index(1));
196 assert!(!bitset.index(2));
197 }
198
199 #[test]
200 fn test_clear() {
201 let mut bitset = BitSet::new(128);
202 bitset.set(62);
203 bitset.set(63);
204 bitset.set(64);
205 bitset.set(65);
206 bitset.set(66);
207
208 bitset.clear(63, 65);
209
210 assert!(bitset.index(62));
211 assert!(!bitset.index(63));
212 assert!(!bitset.index(64));
213 assert!(bitset.index(65));
214 assert!(bitset.index(66));
215 }
216
217 #[test]
218 fn test_clear_2() {
219 let mut bitset = BitSet::new(128);
220 bitset.set(64);
221 bitset.set(65);
222 bitset.set(66);
223 bitset.set(67);
224 bitset.set(68);
225
226 bitset.clear(65, 67);
227
228 assert!(bitset.index(64));
229 assert!(!bitset.index(65));
230 assert!(!bitset.index(66));
231 assert!(bitset.index(67));
232 assert!(bitset.index(68));
233 }
234}