1use fuchsia_async::{self as fasync};
6use futures::task::AtomicWaker;
7use std::future::poll_fn;
8use std::ops::{Deref, Range};
9use std::sync::Arc;
10use std::sync::atomic::{AtomicBool, AtomicU64, Ordering};
11use std::task::Poll;
12use thiserror::Error;
13use zx::AsHandleRef;
14
15pub const RING_BUFFER_MESSAGE_HEADER_SIZE: usize = 16;
17
18pub const MAX_MESSAGE_SIZE: usize = 65536;
21
22const HEAD_OFFSET: usize = 0; const TAIL_OFFSET: usize = 8; pub struct RingBuffer {
37 shared_region: zx::vdso_next::IobSharedRegion,
38 _vmar: zx::Vmar,
39 base: usize,
40 capacity: usize,
41}
42
43#[derive(Eq, Error, Debug, PartialEq)]
44pub enum Error {
45 #[error("attempt to read a message at an unaligned index")]
46 BadAlignment,
47 #[error("there is not enough room to read the header")]
48 TooSmall,
49 #[error("bad message length (e.g. too big or beyond bounds)")]
50 BadLength,
51}
52
53impl RingBuffer {
54 pub fn create(capacity: usize) -> Reader {
58 let page_size = zx::system_get_page_size() as usize;
59
60 assert_eq!(capacity % page_size, 0);
61 assert!(capacity >= MAX_MESSAGE_SIZE);
62
63 let shared_region_size = capacity + page_size;
64 let shared_region =
65 zx::vdso_next::IobSharedRegion::create(Default::default(), shared_region_size as u64)
66 .unwrap();
67
68 let (iob, _) = zx::Iob::create(
70 Default::default(),
71 &[zx::IobRegion {
72 region_type: zx::IobRegionType::Shared {
73 options: Default::default(),
74 region: &shared_region,
75 },
76 access: zx::IobAccess::EP0_CAN_MAP_READ | zx::IobAccess::EP0_CAN_MAP_WRITE,
77 discipline: zx::IobDiscipline::MediatedWriteRingBuffer { tag: 0 },
78 }],
79 )
80 .unwrap();
81
82 let root_vmar = fuchsia_runtime::vmar_root_self();
83
84 let (vmar, base) = root_vmar
89 .allocate(
90 0,
91 shared_region_size + MAX_MESSAGE_SIZE,
92 zx::VmarFlags::CAN_MAP_READ
93 | zx::VmarFlags::CAN_MAP_WRITE
94 | zx::VmarFlags::CAN_MAP_SPECIFIC,
95 )
96 .unwrap();
97 vmar.map_iob(
98 zx::VmarFlags::PERM_READ | zx::VmarFlags::PERM_WRITE | zx::VmarFlags::SPECIFIC,
99 0,
100 &iob,
101 0,
102 0,
103 shared_region_size,
104 )
105 .unwrap();
106 vmar.map_iob(
107 zx::VmarFlags::PERM_READ | zx::VmarFlags::PERM_WRITE | zx::VmarFlags::SPECIFIC,
108 shared_region_size,
109 &iob,
110 0,
111 zx::system_get_page_size() as u64,
112 MAX_MESSAGE_SIZE,
113 )
114 .unwrap();
115
116 let this = Arc::new(Self { shared_region, _vmar: vmar, base, capacity });
117 Reader {
118 ring_buffer: this,
119 registration: fasync::EHandle::local().register_receiver(Receiver::default()),
120 }
121 }
122
123 pub fn new_iob_writer(&self, tag: u64) -> Result<(zx::Iob, zx::Iob), zx::Status> {
127 zx::Iob::create(
128 Default::default(),
129 &[zx::IobRegion {
130 region_type: zx::IobRegionType::Shared {
131 options: Default::default(),
132 region: &self.shared_region,
133 },
134 access: zx::IobAccess::EP0_CAN_MEDIATED_WRITE,
135 discipline: zx::IobDiscipline::MediatedWriteRingBuffer { tag },
136 }],
137 )
138 }
139
140 pub fn capacity(&self) -> usize {
142 self.capacity
143 }
144
145 pub fn head(&self) -> u64 {
148 unsafe { (*((self.base + HEAD_OFFSET) as *const AtomicU64)).load(Ordering::Acquire) }
151 }
152
153 pub fn tail(&self) -> u64 {
157 unsafe { (*((self.base + TAIL_OFFSET) as *const AtomicU64)).load(Ordering::Acquire) }
160 }
161
162 pub fn increment_tail(&self, amount: usize) {
166 assert_eq!(amount % 8, 0);
167 unsafe {
170 (*((self.base + TAIL_OFFSET) as *const AtomicU64))
171 .fetch_add(amount as u64, Ordering::Release);
172 }
173 }
174
175 fn index_to_offset(&self, index: u64) -> usize {
176 (index % self.capacity as u64) as usize
177 }
178
179 pub unsafe fn read<T>(&self, index: u64) -> T {
187 debug_assert_eq!(index % std::mem::align_of::<T>() as u64, 0);
188 debug_assert!(std::mem::size_of::<T>() <= MAX_MESSAGE_SIZE);
189 let offset = self.index_to_offset(index);
190 unsafe { ((self.base + zx::system_get_page_size() as usize + offset) as *const T).read() }
191 }
192
193 pub unsafe fn first_message_in(&self, range: Range<u64>) -> Result<(u64, &[u8]), Error> {
201 if !range.start.is_multiple_of(8) {
202 return Err(Error::BadAlignment);
203 }
204 if range.end - range.start < RING_BUFFER_MESSAGE_HEADER_SIZE as u64 {
205 return Err(Error::TooSmall);
206 }
207 let tag = unsafe { self.read(range.start) };
208 let message_len: u64 = unsafe { self.read(range.start + 8) };
209 if message_len
210 > std::cmp::min(range.end - range.start, MAX_MESSAGE_SIZE as u64)
211 - RING_BUFFER_MESSAGE_HEADER_SIZE as u64
212 {
213 return Err(Error::BadLength);
214 }
215 let index = self.index_to_offset(range.start + 16);
216 Ok((tag, unsafe {
217 std::slice::from_raw_parts(
218 (self.base + zx::system_get_page_size() as usize + index) as *const u8,
219 message_len as usize,
220 )
221 }))
222 }
223}
224
225pub struct Reader {
227 ring_buffer: Arc<RingBuffer>,
228 registration: fasync::ReceiverRegistration<Receiver>,
229}
230
231impl Deref for Reader {
232 type Target = Arc<RingBuffer>;
233 fn deref(&self) -> &Self::Target {
234 &self.ring_buffer
235 }
236}
237
238impl Reader {
239 pub async fn wait(&mut self, index: u64) -> u64 {
241 poll_fn(|cx| {
242 let head = self.head();
244 if head > index {
245 return Poll::Ready(head);
246 }
247 self.registration.waker.register(cx.waker());
248 if !self.registration.async_wait.swap(true, Ordering::Relaxed) {
249 self.shared_region
250 .wait_async_handle(
251 self.registration.port(),
252 self.registration.key(),
253 zx::Signals::IOB_SHARED_REGION_UPDATED,
254 zx::WaitAsyncOpts::empty(),
255 )
256 .unwrap();
257 }
258 let head = self.head();
260 if head > index { Poll::Ready(head) } else { Poll::Pending }
261 })
262 .await
263 }
264
265 pub async fn read_message(&mut self) -> Result<(u64, Vec<u8>), Error> {
268 let tail = self.tail();
269 let head = self.wait(tail).await;
270 let message = unsafe {
273 self.first_message_in(tail..head).map(|(tag, message)| (tag, message.to_vec()))?
274 };
275 self.increment_tail(ring_buffer_record_len(message.1.len()));
276 Ok(message)
277 }
278}
279
280#[derive(Default)]
281struct Receiver {
282 waker: AtomicWaker,
283 async_wait: AtomicBool,
284}
285
286impl fasync::PacketReceiver for Receiver {
287 fn receive_packet(&self, _packet: zx::Packet) {
288 self.async_wait.store(false, Ordering::Relaxed);
289 self.waker.wake();
290 }
291}
292
293pub fn ring_buffer_record_len(message_len: usize) -> usize {
296 RING_BUFFER_MESSAGE_HEADER_SIZE + message_len.next_multiple_of(8)
297}
298
299#[cfg(test)]
300mod tests {
301 use super::{Error, MAX_MESSAGE_SIZE, RING_BUFFER_MESSAGE_HEADER_SIZE, RingBuffer};
302 use futures::stream::FuturesUnordered;
303 use futures::{FutureExt, StreamExt};
304 use std::sync::atomic::{AtomicU64, Ordering};
305
306 #[fuchsia::test]
307 async fn read_message() {
308 const TAG: u64 = 56;
309 let mut reader = RingBuffer::create(128 * 1024);
310 let (iob, _) = reader.new_iob_writer(TAG).unwrap();
311 const DATA: &[u8] = b"test";
312 iob.write(Default::default(), 0, DATA).unwrap();
313 let (tag, data) = reader.read_message().await.expect("read_message failed");
314 assert_eq!(tag, TAG);
315 assert_eq!(&data, DATA);
316 }
317
318 #[fuchsia::test]
319 async fn writing_wakes_reader() {
320 const TAG: u64 = 56;
321 let mut reader = RingBuffer::create(128 * 1024);
322 let (iob, _) = reader.new_iob_writer(TAG).unwrap();
323
324 let mut read_message = FuturesUnordered::from_iter([reader.read_message()]);
326
327 assert!(read_message.next().now_or_never().is_none());
329
330 const DATA: &[u8] = b"test";
331 iob.write(Default::default(), 0, DATA).unwrap();
332
333 let (tag, data) = read_message.next().await.unwrap().expect("read_message failed");
335 assert_eq!(tag, TAG);
336 assert_eq!(&data, DATA);
337 }
338
339 #[fuchsia::test]
340 async fn corrupt() {
341 let mut reader = RingBuffer::create(128 * 1024);
342
343 const HEAD_OFFSET: usize = 0;
344 const TAIL_OFFSET: usize = 8;
345 let message_len_offset: usize = zx::system_get_page_size() as usize + 8;
346
347 let base = reader.base;
348 let write_u64 = |offset, value| unsafe {
349 (*((base + offset) as *const AtomicU64)).store(value, Ordering::Release);
350 };
351
352 write_u64(TAIL_OFFSET, 1);
354 write_u64(HEAD_OFFSET, 8);
355 assert_eq!(reader.read_message().await, Err(Error::BadAlignment));
356
357 write_u64(TAIL_OFFSET, 0);
359 assert_eq!(reader.read_message().await, Err(Error::TooSmall));
360
361 write_u64(HEAD_OFFSET, 32);
363 write_u64(
364 message_len_offset,
365 (MAX_MESSAGE_SIZE + RING_BUFFER_MESSAGE_HEADER_SIZE + 1) as u64,
366 );
367 assert_eq!(reader.read_message().await, Err(Error::BadLength));
368
369 write_u64(message_len_offset, 17);
371 assert_eq!(reader.read_message().await, Err(Error::BadLength));
372
373 write_u64(message_len_offset, 16);
375 assert!(reader.read_message().await.is_ok());
376 }
377}