use alloc::collections::BTreeMap; use core::{mem, slice, str}; use core::sync::atomic::{AtomicUsize, Ordering}; use spin::RwLock; use crate::syscall::data::ITimerSpec; use crate::syscall::error::*; use crate::syscall::flag::{CLOCK_REALTIME, CLOCK_MONOTONIC, EventFlags}; use crate::syscall::scheme::Scheme; pub struct ITimerScheme { next_id: AtomicUsize, handles: RwLock> } impl ITimerScheme { pub fn new() -> ITimerScheme { ITimerScheme { next_id: AtomicUsize::new(0), handles: RwLock::new(BTreeMap::new()) } } } impl Scheme for ITimerScheme { fn open(&self, path: &str, _flags: usize, _uid: u32, _gid: u32) -> Result { let clock = path.parse::().or(Err(Error::new(ENOENT)))?; match clock { CLOCK_REALTIME => (), CLOCK_MONOTONIC => (), _ => return Err(Error::new(ENOENT)) } let id = self.next_id.fetch_add(1, Ordering::SeqCst); self.handles.write().insert(id, clock); Ok(id) } fn read(&self, id: usize, buf: &mut [u8]) -> Result { let _clock = { let handles = self.handles.read(); *handles.get(&id).ok_or(Error::new(EBADF))? }; let time_buf = unsafe { slice::from_raw_parts_mut(buf.as_mut_ptr() as *mut ITimerSpec, buf.len()/mem::size_of::()) }; let mut i = 0; while i < time_buf.len() { time_buf[i] = ITimerSpec::default(); i += 1; } Ok(i * mem::size_of::()) } fn write(&self, id: usize, buf: &[u8]) -> Result { let _clock = { let handles = self.handles.read(); *handles.get(&id).ok_or(Error::new(EBADF))? }; let time_buf = unsafe { slice::from_raw_parts(buf.as_ptr() as *const ITimerSpec, buf.len()/mem::size_of::()) }; let mut i = 0; while i < time_buf.len() { let time = time_buf[i]; println!("{}: {:?}", i, time); i += 1; } Ok(i * mem::size_of::()) } fn fcntl(&self, _id: usize, _cmd: usize, _arg: usize) -> Result { Ok(0) } fn fevent(&self, id: usize, _flags: EventFlags) -> Result { let handles = self.handles.read(); handles.get(&id).ok_or(Error::new(EBADF)).and(Ok(EventFlags::empty())) } fn fpath(&self, id: usize, buf: &mut [u8]) -> Result { let clock = { let handles = self.handles.read(); *handles.get(&id).ok_or(Error::new(EBADF))? }; let mut i = 0; let scheme_path = format!("time:{}", clock).into_bytes(); while i < buf.len() && i < scheme_path.len() { buf[i] = scheme_path[i]; i += 1; } Ok(i) } fn fsync(&self, id: usize) -> Result { let handles = self.handles.read(); handles.get(&id).ok_or(Error::new(EBADF)).and(Ok(0)) } fn close(&self, id: usize) -> Result { self.handles.write().remove(&id).ok_or(Error::new(EBADF)).and(Ok(0)) } } impl crate::scheme::KernelScheme for ITimerScheme {}