Newer
Older
use alloc::sync::Arc;
use alloc::collections::BTreeMap;
use spin::{Once, RwLock, RwLockReadGuard, RwLockWriteGuard};
use crate::context;
use crate::scheme::{self, SchemeId};
use crate::sync::WaitQueue;
use crate::syscall::data::Event;
use crate::syscall::error::{Error, Result, EBADF, EINTR, ESRCH};
int_like!(EventQueueId, AtomicEventQueueId, usize, AtomicUsize);
pub struct EventQueue {
id: EventQueueId,
queue: WaitQueue<Event>,
}
impl EventQueue {
pub fn new(id: EventQueueId) -> EventQueue {
EventQueue {
queue: WaitQueue::new()
}
}
pub fn read(&self, events: &mut [Event]) -> Result<usize> {
self.queue.receive_into(events, true, "EventQueue::read").ok_or(Error::new(EINTR))
}
pub fn write(&self, events: &[Event]) -> Result<usize> {
for event in events {
let file = {
let contexts = context::contexts();
let context_lock = contexts.current().ok_or(Error::new(ESRCH))?;
let context = context_lock.read();
match files.get(event.id).ok_or(Error::new(EBADF))? {
Some(file) => file.clone(),
None => return Err(Error::new(EBADF))
}
};
let (scheme, number) = {
let description = file.description.read();
(description.scheme, description.number)
};
register(
RegKey { scheme, number },
QueueKey { queue: self.id, id: event.id, data: event.data },
event.flags
);
let flags = sync(RegKey { scheme, number })?;
trigger(scheme, number, flags);
}
}
Ok(events.len())
}
}
pub type EventQueueList = BTreeMap<EventQueueId, Arc<EventQueue>>;
// Next queue id
static NEXT_QUEUE_ID: AtomicUsize = AtomicUsize::new(0);
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
/// Get next queue id
pub fn next_queue_id() -> EventQueueId {
EventQueueId::from(NEXT_QUEUE_ID.fetch_add(1, Ordering::SeqCst))
}
// Current event queues
static QUEUES: Once<RwLock<EventQueueList>> = Once::new();
/// Initialize queues, called if needed
fn init_queues() -> RwLock<EventQueueList> {
RwLock::new(BTreeMap::new())
}
/// Get the event queues list, const
pub fn queues() -> RwLockReadGuard<'static, EventQueueList> {
QUEUES.call_once(init_queues).read()
}
/// Get the event queues list, mutable
pub fn queues_mut() -> RwLockWriteGuard<'static, EventQueueList> {
QUEUES.call_once(init_queues).write()
}
#[derive(Debug, PartialEq, Eq, PartialOrd, Ord)]
pub struct RegKey {
pub scheme: SchemeId,
pub number: usize,
}
#[derive(Debug, PartialEq, Eq, PartialOrd, Ord)]
pub struct QueueKey {
pub queue: EventQueueId,
pub id: usize,
type Registry = BTreeMap<RegKey, BTreeMap<QueueKey, EventFlags>>;
static REGISTRY: Once<RwLock<Registry>> = Once::new();
/// Initialize registry, called if needed
fn init_registry() -> RwLock<Registry> {
RwLock::new(Registry::new())
}
/// Get the global schemes list, const
fn registry() -> RwLockReadGuard<'static, Registry> {
REGISTRY.call_once(init_registry).read()
}
/// Get the global schemes list, mutable
pub fn registry_mut() -> RwLockWriteGuard<'static, Registry> {
REGISTRY.call_once(init_registry).write()
}
pub fn register(reg_key: RegKey, queue_key: QueueKey, flags: EventFlags) {
let mut registry = registry_mut();
let entry = registry.entry(reg_key).or_insert_with(|| {
BTreeMap::new()
});
entry.remove(&queue_key);
} else {
entry.insert(queue_key, flags);
}
}
pub fn sync(reg_key: RegKey) -> Result<EventFlags> {
let mut flags = EventFlags::empty();
{
let registry = registry();
if let Some(queue_list) = registry.get(®_key) {
for (_queue_key, &queue_flags) in queue_list.iter() {
let scheme = {
let schemes = scheme::schemes();
let scheme = schemes.get(reg_key.scheme).ok_or(Error::new(EBADF))?;
Arc::clone(&scheme)
scheme.fevent(reg_key.number, flags)
pub fn unregister_file(scheme: SchemeId, number: usize) {
let mut registry = registry_mut();
registry.remove(&RegKey { scheme, number });
}
//TODO: Implement unregister_queue
// pub fn unregister_queue(scheme: SchemeId, number: usize) {
//
// }
pub fn trigger(scheme: SchemeId, number: usize, flags: EventFlags) {
let registry = registry();
if let Some(queue_list) = registry.get(&RegKey { scheme, number }) {
for (queue_key, &queue_flags) in queue_list.iter() {