use core::sync::atomic::{AtomicUsize, Ordering}; use spin::{Once, RwLock, RwLockReadGuard, RwLockWriteGuard}; use crate::arch::debug::Writer; use crate::event; use crate::scheme::*; use crate::sync::WaitQueue; use crate::syscall::flag::{EventFlags, EVENT_READ, F_GETFL, F_SETFL, O_ACCMODE, O_NONBLOCK}; use crate::syscall::scheme::Scheme; static SCHEME_ID: AtomicSchemeId = AtomicSchemeId::default(); static NEXT_ID: AtomicUsize = AtomicUsize::new(0); /// Input queue static INPUT: Once> = Once::new(); /// Initialize input queue, called if needed fn init_input() -> WaitQueue { WaitQueue::new() } #[derive(Clone, Copy)] struct Handle { flags: usize, } static HANDLES: Once>> = Once::new(); fn init_handles() -> RwLock> { RwLock::new(BTreeMap::new()) } fn handles() -> RwLockReadGuard<'static, BTreeMap> { HANDLES.call_once(init_handles).read() } fn handles_mut() -> RwLockWriteGuard<'static, BTreeMap> { HANDLES.call_once(init_handles).write() } /// Add to the input queue pub fn debug_input(data: u8) { INPUT.call_once(init_input).send(data); for (id, _handle) in handles().iter() { event::trigger(SCHEME_ID.load(Ordering::SeqCst), *id, EVENT_READ); } } pub struct DebugScheme; impl DebugScheme { pub fn new(scheme_id: SchemeId) -> Self { SCHEME_ID.store(scheme_id, Ordering::SeqCst); Self } } impl Scheme for DebugScheme { fn open(&self, path: &[u8], flags: usize, uid: u32, _gid: u32) -> Result { if uid != 0 { return Err(Error::new(EPERM)); } if ! path.is_empty() { return Err(Error::new(ENOENT)); } let id = NEXT_ID.fetch_add(1, Ordering::SeqCst); handles_mut().insert(id, Handle { flags: flags & ! O_ACCMODE }); Ok(id) } /// Read the file `number` into the `buffer` /// /// Returns the number of bytes read fn read(&self, id: usize, buf: &mut [u8]) -> Result { let handle = { let handles = handles(); *handles.get(&id).ok_or(Error::new(EBADF))? }; INPUT.call_once(init_input) .receive_into(buf, handle.flags & O_NONBLOCK != O_NONBLOCK, "DebugScheme::read") .ok_or(Error::new(EINTR)) } /// Write the `buffer` to the `file` /// /// Returns the number of bytes written fn write(&self, id: usize, buf: &[u8]) -> Result { let _handle = { let handles = handles(); *handles.get(&id).ok_or(Error::new(EBADF))? }; Writer::new().write(buf); Ok(buf.len()) } fn fcntl(&self, id: usize, cmd: usize, arg: usize) -> Result { let mut handles = handles_mut(); if let Some(handle) = handles.get_mut(&id) { match cmd { F_GETFL => Ok(handle.flags), F_SETFL => { handle.flags = arg & ! O_ACCMODE; Ok(0) }, _ => Err(Error::new(EINVAL)) } } else { Err(Error::new(EBADF)) } } fn fevent(&self, id: usize, _flags: EventFlags) -> Result { let _handle = { let handles = handles(); *handles.get(&id).ok_or(Error::new(EBADF))? }; Ok(EventFlags::empty()) } fn fpath(&self, id: usize, buf: &mut [u8]) -> Result { let _handle = { let handles = handles(); *handles.get(&id).ok_or(Error::new(EBADF))? }; let mut i = 0; let scheme_path = b"debug:"; while i < buf.len() && i < scheme_path.len() { buf[i] = scheme_path[i]; i += 1; } Ok(i) } fn fsync(&self, id: usize) -> Result { let _handle = { let handles = handles(); *handles.get(&id).ok_or(Error::new(EBADF))? }; Ok(0) } /// Close the file `number` fn close(&self, id: usize) -> Result { let _handle = { let mut handles = handles_mut(); handles.remove(&id).ok_or(Error::new(EBADF))? }; Ok(0) } }