use core::hint::spin_loop; use alloc::{boxed::Box, sync::Arc}; use crate::{ arch::{sched::sched, CurrentIrqArch, CurrentTimeArch}, exception::InterruptArch, include::bindings::bindings::{useconds_t, Cpu_tsc_freq}, process::ProcessManager, syscall::SystemError, time::timekeeping::getnstimeofday, }; use super::{ timer::{next_n_us_timer_jiffies, Timer, WakeUpHelper}, TimeArch, TimeSpec, }; /// @brief 休眠指定时间(单位:纳秒) /// /// @param sleep_time 指定休眠的时间 /// /// @return Ok(TimeSpec) 剩余休眠时间 /// /// @return Err(SystemError) 错误码 pub fn nanosleep(sleep_time: TimeSpec) -> Result { if sleep_time.tv_nsec < 0 || sleep_time.tv_nsec >= 1000000000 { return Err(SystemError::EINVAL); } // 对于小于500us的时间,使用spin/rdtsc来进行定时 if sleep_time.tv_nsec < 500000 && sleep_time.tv_sec == 0 { let expired_tsc: u64 = unsafe { CurrentTimeArch::get_cycles() as u64 + (sleep_time.tv_nsec as u64 * Cpu_tsc_freq) / 1000000000 }; while (CurrentTimeArch::get_cycles() as u64) < expired_tsc { spin_loop() } return Ok(TimeSpec { tv_sec: 0, tv_nsec: 0, }); } let total_sleep_time_us: u64 = sleep_time.tv_sec as u64 * 1000000 + sleep_time.tv_nsec as u64 / 1000; // 创建定时器 let handler: Box = WakeUpHelper::new(ProcessManager::current_pcb()); let timer: Arc = Timer::new(handler, next_n_us_timer_jiffies(total_sleep_time_us)); let irq_guard: crate::exception::IrqFlagsGuard = unsafe { CurrentIrqArch::save_and_disable_irq() }; ProcessManager::mark_sleep(true).ok(); let start_time = getnstimeofday(); timer.activate(); drop(irq_guard); sched(); let end_time = getnstimeofday(); // 返回正确的剩余时间 let real_sleep_time = end_time - start_time; let rm_time: TimeSpec = (sleep_time - real_sleep_time.into()).into(); return Ok(rm_time); } /// @brief 休眠指定时间(单位:微秒) /// /// @param usec 微秒 /// /// @return Ok(TimeSpec) 剩余休眠时间 /// /// @return Err(SystemError) 错误码 pub fn usleep(sleep_time: TimeSpec) -> Result { match nanosleep(sleep_time) { Ok(value) => return Ok(value), Err(err) => return Err(err), }; } //===== 以下为提供给C的接口 ===== /// @brief 休眠指定时间(单位:微秒)(提供给C的接口) /// /// @param usec 微秒 /// /// @return Ok(i32) 0 /// /// @return Err(SystemError) 错误码 #[no_mangle] pub extern "C" fn rs_usleep(usec: useconds_t) -> i32 { let sleep_time = TimeSpec { tv_sec: (usec / 1000000) as i64, tv_nsec: ((usec % 1000000) * 1000) as i64, }; match usleep(sleep_time) { Ok(_) => { return 0; } Err(err) => { return err.to_posix_errno(); } }; }