use std::{ collections::VecDeque, fmt, iter::FusedIterator, sync::{Arc, atomic::AtomicUsize}, }; use rand::{Rng, SeedableRng, rngs::SmallRng}; use crate::Priority; struct PriorityQueues { high_priority: VecDeque, medium_priority: VecDeque, low_priority: VecDeque, } impl PriorityQueues { fn is_empty(&self) -> bool { self.high_priority.is_empty() && self.medium_priority.is_empty() && self.low_priority.is_empty() } } struct PriorityQueueState { queues: parking_lot::Mutex>, condvar: parking_lot::Condvar, receiver_count: AtomicUsize, sender_count: AtomicUsize, } impl PriorityQueueState { fn send(&self, priority: Priority, item: T) -> Result<(), SendError> { if self .receiver_count .load(std::sync::atomic::Ordering::Relaxed) == 0 { return Err(SendError(item)); } let mut queues = self.queues.lock(); Self::push(&mut queues, priority, item); self.condvar.notify_one(); Ok(()) } fn spin_send(&self, priority: Priority, item: T) -> Result<(), SendError> { if self .receiver_count .load(std::sync::atomic::Ordering::Relaxed) == 0 { return Err(SendError(item)); } let mut queues = loop { if let Some(guard) = self.queues.try_lock() { break guard; } std::hint::spin_loop(); }; Self::push(&mut queues, priority, item); self.condvar.notify_one(); Ok(()) } fn push(queues: &mut PriorityQueues, priority: Priority, item: T) { match priority { Priority::RealtimeAudio => unreachable!( "Realtime audio priority runs on a dedicated thread and is never queued" ), Priority::High => queues.high_priority.push_back(item), Priority::Medium => queues.medium_priority.push_back(item), Priority::Low => queues.low_priority.push_back(item), }; } fn recv<'a>(&'a self) -> Result>, RecvError> { let mut queues = self.queues.lock(); let sender_count = self.sender_count.load(std::sync::atomic::Ordering::Relaxed); if queues.is_empty() && sender_count == 0 { return Err(crate::queue::RecvError); } while queues.is_empty() { self.condvar.wait(&mut queues); } Ok(queues) } fn try_recv<'a>( &'a self, ) -> Result>>, RecvError> { let mut queues = self.queues.lock(); let sender_count = self.sender_count.load(std::sync::atomic::Ordering::Relaxed); if queues.is_empty() && sender_count == 0 { return Err(crate::queue::RecvError); } if queues.is_empty() { Ok(None) } else { Ok(Some(queues)) } } fn spin_try_recv<'a>( &'a self, ) -> Result>>, RecvError> { let queues = loop { if let Some(guard) = self.queues.try_lock() { break guard; } std::hint::spin_loop(); }; let sender_count = self.sender_count.load(std::sync::atomic::Ordering::Relaxed); if queues.is_empty() && sender_count == 0 { return Err(crate::queue::RecvError); } if queues.is_empty() { Ok(None) } else { Ok(Some(queues)) } } } #[doc(hidden)] pub struct PriorityQueueSender { state: Arc>, } impl PriorityQueueSender { fn new(state: Arc>) -> Self { Self { state } } pub fn send(&self, priority: Priority, item: T) -> Result<(), SendError> { self.state.send(priority, item)?; Ok(()) } pub fn spin_send(&self, priority: Priority, item: T) -> Result<(), SendError> { self.state.spin_send(priority, item)?; Ok(()) } } impl Drop for PriorityQueueSender { fn drop(&mut self) { self.state .sender_count .fetch_sub(1, std::sync::atomic::Ordering::AcqRel); } } #[doc(hidden)] pub struct PriorityQueueReceiver { state: Arc>, rand: SmallRng, disconnected: bool, } impl Clone for PriorityQueueReceiver { fn clone(&self) -> Self { self.state .receiver_count .fetch_add(1, std::sync::atomic::Ordering::AcqRel); Self { state: Arc::clone(&self.state), rand: SmallRng::seed_from_u64(0), disconnected: self.disconnected, } } } #[doc(hidden)] pub struct SendError(pub T); impl fmt::Debug for SendError { fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result { f.debug_tuple("SendError").field(&self.0).finish() } } #[derive(Debug)] #[doc(hidden)] pub struct RecvError; #[allow(dead_code)] impl PriorityQueueReceiver { pub fn new() -> (PriorityQueueSender, Self) { let state = PriorityQueueState { queues: parking_lot::Mutex::new(PriorityQueues { high_priority: VecDeque::new(), medium_priority: VecDeque::new(), low_priority: VecDeque::new(), }), condvar: parking_lot::Condvar::new(), receiver_count: AtomicUsize::new(1), sender_count: AtomicUsize::new(1), }; let state = Arc::new(state); let sender = PriorityQueueSender::new(Arc::clone(&state)); let receiver = PriorityQueueReceiver { state, rand: SmallRng::seed_from_u64(0), disconnected: false, }; (sender, receiver) } /// Tries to pop one element from the priority queue without blocking. /// /// This will early return if there are no elements in the queue. /// /// This method is best suited if you only intend to pop one element, for better performance /// on large queues see [`Self::try_iter`] /// /// # Errors /// /// If the sender was dropped pub fn try_pop(&mut self) -> Result, RecvError> { self.pop_inner(false) } pub fn spin_try_pop(&mut self) -> Result, RecvError> { use Priority as P; let Some(mut queues) = self.state.spin_try_recv()? else { return Ok(None); }; let high = P::High.weight() * !queues.high_priority.is_empty() as u32; let medium = P::Medium.weight() * !queues.medium_priority.is_empty() as u32; let low = P::Low.weight() * !queues.low_priority.is_empty() as u32; let mut mass = high + medium + low; if !queues.high_priority.is_empty() { let flip = self.rand.random_ratio(P::High.weight(), mass); if flip { return Ok(queues.high_priority.pop_front()); } mass -= P::High.weight(); } if !queues.medium_priority.is_empty() { let flip = self.rand.random_ratio(P::Medium.weight(), mass); if flip { return Ok(queues.medium_priority.pop_front()); } mass -= P::Medium.weight(); } if !queues.low_priority.is_empty() { let flip = self.rand.random_ratio(P::Low.weight(), mass); if flip { return Ok(queues.low_priority.pop_front()); } } Ok(None) } /// Pops an element from the priority queue blocking if necessary. /// /// This method is best suited if you only intend to pop one element, for better performance /// on large queues see [`Self::iter``] /// /// # Errors /// /// If the sender was dropped pub fn pop(&mut self) -> Result { self.pop_inner(true).map(|e| e.unwrap()) } /// Returns an iterator over the elements of the queue /// this iterator will end when all elements have been consumed and will not wait for new ones. pub fn try_iter(self) -> TryIter { TryIter { receiver: self, ended: false, } } /// Returns an iterator over the elements of the queue /// this iterator will wait for new elements if the queue is empty. pub fn iter(self) -> Iter { Iter(self) } #[inline(always)] // algorithm is the loaded die from biased coin from // https://www.keithschwarz.com/darts-dice-coins/ fn pop_inner(&mut self, block: bool) -> Result, RecvError> { use Priority as P; let mut queues = if !block { let Some(queues) = self.state.try_recv()? else { return Ok(None); }; queues } else { self.state.recv()? }; let high = P::High.weight() * !queues.high_priority.is_empty() as u32; let medium = P::Medium.weight() * !queues.medium_priority.is_empty() as u32; let low = P::Low.weight() * !queues.low_priority.is_empty() as u32; let mut mass = high + medium + low; //% if !queues.high_priority.is_empty() { let flip = self.rand.random_ratio(P::High.weight(), mass); if flip { return Ok(queues.high_priority.pop_front()); } mass -= P::High.weight(); } if !queues.medium_priority.is_empty() { let flip = self.rand.random_ratio(P::Medium.weight(), mass); if flip { return Ok(queues.medium_priority.pop_front()); } mass -= P::Medium.weight(); } if !queues.low_priority.is_empty() { let flip = self.rand.random_ratio(P::Low.weight(), mass); if flip { return Ok(queues.low_priority.pop_front()); } } Ok(None) } } impl Drop for PriorityQueueReceiver { fn drop(&mut self) { self.state .receiver_count .fetch_sub(1, std::sync::atomic::Ordering::AcqRel); } } #[doc(hidden)] pub struct Iter(PriorityQueueReceiver); impl Iterator for Iter { type Item = T; fn next(&mut self) -> Option { self.0.pop().ok() } } impl FusedIterator for Iter {} #[doc(hidden)] pub struct TryIter { receiver: PriorityQueueReceiver, ended: bool, } impl Iterator for TryIter { type Item = Result; fn next(&mut self) -> Option { if self.ended { return None; } let res = self.receiver.try_pop(); self.ended = res.is_err(); res.transpose() } } impl FusedIterator for TryIter {} #[cfg(test)] mod tests { use collections::HashSet; use super::*; #[test] fn all_tasks_get_yielded() { let (tx, mut rx) = PriorityQueueReceiver::new(); tx.send(Priority::Medium, 20).unwrap(); tx.send(Priority::High, 30).unwrap(); tx.send(Priority::Low, 10).unwrap(); tx.send(Priority::Medium, 21).unwrap(); tx.send(Priority::High, 31).unwrap(); drop(tx); assert_eq!( rx.iter().collect::>(), [30, 31, 20, 21, 10].into_iter().collect::>() ) } #[test] fn new_high_prio_task_get_scheduled_quickly() { let (tx, mut rx) = PriorityQueueReceiver::new(); for _ in 0..100 { tx.send(Priority::Low, 1).unwrap(); } assert_eq!(rx.pop().unwrap(), 1); tx.send(Priority::High, 3).unwrap(); assert_eq!(rx.pop().unwrap(), 3); assert_eq!(rx.pop().unwrap(), 1); } }