|
| 1 | +#![feature(const_fn)] |
| 2 | +#![no_std] |
| 3 | + |
| 4 | +use core::cmp; |
| 5 | +use core::cell::Cell; |
| 6 | + |
| 7 | +macro_rules! ring_buf { |
| 8 | + ($size:expr, $t:ident) => { |
| 9 | + RingBuf { reader: Cell::new(0), writer: Cell::new(0), length: $size, buffer: &mut [::core::$t::MIN; $size] as *mut Array<$t>} |
| 10 | + } |
| 11 | +} |
| 12 | + |
| 13 | +pub struct RingBuf<T> { |
| 14 | + reader: Cell<usize>, |
| 15 | + writer: Cell<usize>, |
| 16 | + length: usize, |
| 17 | + buffer: *mut Array<T>, |
| 18 | +} |
| 19 | + |
| 20 | +impl<T: Copy> RingBuf<T> { |
| 21 | + fn cap(&self) -> usize { |
| 22 | + self.length |
| 23 | + } |
| 24 | + |
| 25 | + fn len(&self) -> usize { |
| 26 | + self.writer.get().wrapping_sub(self.reader.get()) |
| 27 | + } |
| 28 | + |
| 29 | + fn rem(&self) -> usize { |
| 30 | + self.cap().wrapping_sub(self.len()) |
| 31 | + } |
| 32 | + |
| 33 | + fn is_empty(&self) -> bool { |
| 34 | + self.reader.get() == self.writer.get() |
| 35 | + } |
| 36 | + |
| 37 | + fn is_full(&self) -> bool { |
| 38 | + self.len() == self.cap() |
| 39 | + } |
| 40 | + |
| 41 | + fn phy(&self, index: usize) -> usize { |
| 42 | + index % self.cap() |
| 43 | + } |
| 44 | + |
| 45 | + fn incr_reader(&self) { |
| 46 | + assert!(!self.is_empty(), "Attempted to increment empty reader"); |
| 47 | + self.reader.set(self.reader.get().wrapping_add(1)); |
| 48 | + } |
| 49 | + |
| 50 | + fn incr_writer(&self) { |
| 51 | + assert!(!self.is_full(), "Attempted to increment full writer"); |
| 52 | + self.writer.set(self.writer.get().wrapping_add(1)); |
| 53 | + } |
| 54 | + |
| 55 | + pub fn enqueue(&self, value: T) -> bool { |
| 56 | + if self.is_full() { |
| 57 | + false |
| 58 | + } else { |
| 59 | + let writer = self.phy(self.writer.get()); |
| 60 | + unsafe { (&mut *self.buffer).set(writer, value); } |
| 61 | + self.incr_writer(); |
| 62 | + true |
| 63 | + } |
| 64 | + } |
| 65 | + |
| 66 | + pub fn dequeue(&self) -> Option<T> { |
| 67 | + if self.is_empty() { |
| 68 | + None |
| 69 | + } else { |
| 70 | + let reader = self.phy(self.reader.get()); |
| 71 | + let value = unsafe { (&mut *self.buffer).get(reader) }; |
| 72 | + self.incr_reader(); |
| 73 | + Some(value) |
| 74 | + } |
| 75 | + } |
| 76 | + |
| 77 | + pub fn write(&self, buf: &[T]) -> usize { |
| 78 | + let n = cmp::min(self.rem(), buf.len()); |
| 79 | + for i in 0..n { |
| 80 | + self.enqueue(buf[i]); |
| 81 | + } |
| 82 | + n |
| 83 | + } |
| 84 | + |
| 85 | + pub fn read(&self, buf: &mut [T]) -> usize { |
| 86 | + let n = cmp::min(self.len(), buf.len()); |
| 87 | + for i in 0..n { |
| 88 | + buf[i] = self.dequeue().expect("Ring buffer is empty"); |
| 89 | + } |
| 90 | + n |
| 91 | + } |
| 92 | +} |
| 93 | + |
| 94 | +pub trait Array<T> { |
| 95 | + fn get(&mut self, index: usize) -> T; |
| 96 | + fn set(&mut self, index: usize, value: T); |
| 97 | +} |
| 98 | + |
| 99 | +macro_rules! impl_array_recursive { |
| 100 | + ($($size:expr),*) => { |
| 101 | + $( |
| 102 | + impl_array!($size, u8); |
| 103 | + impl_array!($size, u16); |
| 104 | + impl_array!($size, u32); |
| 105 | + impl_array!($size, usize); |
| 106 | + impl_array!($size, i8); |
| 107 | + impl_array!($size, i16); |
| 108 | + impl_array!($size, i32); |
| 109 | + impl_array!($size, isize); |
| 110 | + )* |
| 111 | + |
| 112 | + } |
| 113 | +} |
| 114 | + |
| 115 | +macro_rules! impl_array { |
| 116 | + ($size:expr, $t:ty) => { |
| 117 | + impl Array<$t> for [$t; $size] { |
| 118 | + fn get(&mut self, index: usize) -> $t { |
| 119 | + self[index] |
| 120 | + } |
| 121 | + fn set(&mut self, index: usize, value: $t) { |
| 122 | + self[index] = value |
| 123 | + } |
| 124 | + } |
| 125 | + } |
| 126 | +} |
| 127 | + |
| 128 | +impl_array_recursive!(1, 2, 4, 8, 16, 24, 32, 48, 64, 96, 128, 192, 256, 384, 512, 768, 1024, 1536, 2048, 3072, 4096, 8192, 16384, 32768, 65536); |
| 129 | + |
| 130 | + |
| 131 | +#[cfg(test)] |
| 132 | +mod tests { |
| 133 | + use super::*; |
| 134 | + |
| 135 | + #[test] |
| 136 | + fn test_enqueue_dequeue() { |
| 137 | + let rbuf = ring_buf!(16, u8); |
| 138 | + |
| 139 | + for i in 0..16 { |
| 140 | + assert_eq!(rbuf.enqueue(i as u8), true); |
| 141 | + } |
| 142 | + assert_eq!(rbuf.enqueue(0), false); |
| 143 | + for i in 0..16 { |
| 144 | + assert_eq!(rbuf.dequeue(), Some(i as u8)); |
| 145 | + } |
| 146 | + assert_eq!(rbuf.dequeue(), None); |
| 147 | + } |
| 148 | + |
| 149 | + #[test] |
| 150 | + fn test_enqueue_dequeue_u32() { |
| 151 | + let rbuf = ring_buf!(16, u32); |
| 152 | + |
| 153 | + for i in 0..16 { |
| 154 | + assert_eq!(rbuf.enqueue(i as u32), true); |
| 155 | + } |
| 156 | + assert_eq!(rbuf.enqueue(0), false); |
| 157 | + for i in 0..16 { |
| 158 | + assert_eq!(rbuf.dequeue(), Some(i as u32)); |
| 159 | + } |
| 160 | + assert_eq!(rbuf.dequeue(), None); |
| 161 | + } |
| 162 | + |
| 163 | + #[test] |
| 164 | + fn test_write_read() { |
| 165 | + let rbuf = ring_buf!(16, u8); |
| 166 | + |
| 167 | + let src: [u8; 16] = [0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15]; |
| 168 | + let mut dst = [0u8; 16]; |
| 169 | + |
| 170 | + rbuf.write(&src); |
| 171 | + let n = rbuf.read(&mut dst); |
| 172 | + assert_eq!(n, 16); |
| 173 | + for i in 0..16 { |
| 174 | + assert_eq!(src[i], dst[i]); |
| 175 | + } |
| 176 | + } |
| 177 | + |
| 178 | + struct Driver<'a> { |
| 179 | + rbuf: &'a RingBuf<u8>, |
| 180 | + } |
| 181 | + |
| 182 | + impl<'a> Driver<'a> { |
| 183 | + pub fn run(&mut self) { |
| 184 | + self.rbuf.write(b"ABC"); |
| 185 | + } |
| 186 | + } |
| 187 | + |
| 188 | + #[test] |
| 189 | + fn test_driver() { |
| 190 | + let rbuf = ring_buf!(16, u8); |
| 191 | + { |
| 192 | + let mut d = Driver { rbuf: &rbuf }; |
| 193 | + d.run(); |
| 194 | + |
| 195 | + let mut dst = [0u8; 16]; |
| 196 | + let n = rbuf.read(&mut dst); |
| 197 | + assert_eq!(&dst[..n], b"ABC"); |
| 198 | + } |
| 199 | + } |
| 200 | + |
| 201 | + #[test] |
| 202 | + fn test_static_driver() { |
| 203 | + static mut RBUF: RingBuf<u8> = ring_buf!(16, u8); |
| 204 | + static mut DRV: Option<Driver> = None; |
| 205 | + { |
| 206 | + unsafe { |
| 207 | + DRV = Some(Driver { rbuf: &RBUF }); |
| 208 | + &DRV.as_mut().unwrap().run(); |
| 209 | + } |
| 210 | + |
| 211 | + } |
| 212 | + unsafe { |
| 213 | + let mut dst = [0u8; 16]; |
| 214 | + let n = RBUF.read(&mut dst); |
| 215 | + assert_eq!(&dst[..n], b"ABC"); |
| 216 | + } |
| 217 | + |
| 218 | + } |
| 219 | +} |
0 commit comments