#![allow(unsafe_code)]
use super::arch::asm::syscall2;
use super::conv::{pass_usize, ret, void_star};
use super::reg::nr;
#[cfg(target_arch = "x86")]
use super::reg::{ArgReg, RetReg, SyscallNumber, A0, A1, A2, A3, A4, A5, R0};
use super::time::{ClockId, DynamicClockId, Timespec};
use super::{c, vdso};
use crate::io;
#[cfg(all(asm, target_arch = "x86"))]
use core::arch::asm;
use core::mem::{transmute, MaybeUninit};
use core::sync::atomic::AtomicUsize;
use core::sync::atomic::Ordering::Relaxed;
use linux_raw_sys::general::{__NR_clock_gettime, __kernel_clockid_t, __kernel_timespec};
#[cfg(target_pointer_width = "32")]
use {
super::conv::out, linux_raw_sys::general::__NR_clock_gettime64,
linux_raw_sys::general::timespec as __kernel_old_timespec,
};
#[inline]
pub(crate) fn clock_gettime(which_clock: ClockId) -> __kernel_timespec {
unsafe {
let mut result = MaybeUninit::<__kernel_timespec>::uninit();
let callee = match transmute(CLOCK_GETTIME.load(Relaxed)) {
Some(callee) => callee,
None => init_clock_gettime(),
};
let r0 = callee(which_clock as _, result.as_mut_ptr());
assert_eq!(r0, 0);
result.assume_init()
}
}
#[inline]
pub(crate) fn clock_gettime_dynamic(which_clock: DynamicClockId<'_>) -> io::Result<Timespec> {
let id = match which_clock {
DynamicClockId::Known(id) => id as __kernel_clockid_t,
DynamicClockId::Dynamic(fd) => {
use crate::imp::fd::AsRawFd;
const CLOCKFD: i32 = 3;
((!fd.as_raw_fd() << 3) | CLOCKFD) as __kernel_clockid_t
}
DynamicClockId::RealtimeAlarm => {
linux_raw_sys::general::CLOCK_REALTIME_ALARM as __kernel_clockid_t
}
DynamicClockId::Tai => linux_raw_sys::general::CLOCK_TAI as __kernel_clockid_t,
DynamicClockId::Boottime => linux_raw_sys::general::CLOCK_BOOTTIME as __kernel_clockid_t,
DynamicClockId::BoottimeAlarm => {
linux_raw_sys::general::CLOCK_BOOTTIME_ALARM as __kernel_clockid_t
}
};
unsafe {
const EINVAL: c::c_int = -(linux_raw_sys::errno::EINVAL as c::c_int);
let mut timespec = MaybeUninit::<Timespec>::uninit();
let callee = match transmute(CLOCK_GETTIME.load(Relaxed)) {
Some(callee) => callee,
None => init_clock_gettime(),
};
match callee(id, timespec.as_mut_ptr()) {
0 => (),
EINVAL => return Err(io::Error::INVAL),
_ => _rustix_clock_gettime_via_syscall(id, timespec.as_mut_ptr())?,
}
Ok(timespec.assume_init())
}
}
#[cfg(target_arch = "x86")]
pub(super) mod x86_via_vdso {
use super::{transmute, ArgReg, Relaxed, RetReg, SyscallNumber, A0, A1, A2, A3, A4, A5, R0};
use crate::imp::arch::asm;
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall0(nr: SyscallNumber<'_>) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall0(callee, nr)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall1(nr: SyscallNumber<'_>, a0: ArgReg<'_, A0>) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall1(callee, nr, a0)
}
#[inline]
pub(in crate::imp) unsafe fn syscall1_noreturn(nr: SyscallNumber<'_>, a0: ArgReg<'_, A0>) -> ! {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall1_noreturn(callee, nr, a0)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall2(
nr: SyscallNumber<'_>,
a0: ArgReg<'_, A0>,
a1: ArgReg<'_, A1>,
) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall2(callee, nr, a0, a1)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall3(
nr: SyscallNumber<'_>,
a0: ArgReg<'_, A0>,
a1: ArgReg<'_, A1>,
a2: ArgReg<'_, A2>,
) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall3(callee, nr, a0, a1, a2)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall4(
nr: SyscallNumber<'_>,
a0: ArgReg<'_, A0>,
a1: ArgReg<'_, A1>,
a2: ArgReg<'_, A2>,
a3: ArgReg<'_, A3>,
) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall4(callee, nr, a0, a1, a2, a3)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall5(
nr: SyscallNumber<'_>,
a0: ArgReg<'_, A0>,
a1: ArgReg<'_, A1>,
a2: ArgReg<'_, A2>,
a3: ArgReg<'_, A3>,
a4: ArgReg<'_, A4>,
) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall5(callee, nr, a0, a1, a2, a3, a4)
}
#[inline]
#[must_use]
pub(in crate::imp) unsafe fn syscall6(
nr: SyscallNumber<'_>,
a0: ArgReg<'_, A0>,
a1: ArgReg<'_, A1>,
a2: ArgReg<'_, A2>,
a3: ArgReg<'_, A3>,
a4: ArgReg<'_, A4>,
a5: ArgReg<'_, A5>,
) -> RetReg<R0> {
let callee = match transmute(super::SYSCALL.load(Relaxed)) {
Some(callee) => callee,
None => super::init_syscall(),
};
asm::indirect_syscall6(callee, nr, a0, a1, a2, a3, a4, a5)
}
pub(in crate::imp) use {
syscall0 as syscall0_readonly, syscall1 as syscall1_readonly,
syscall2 as syscall2_readonly, syscall3 as syscall3_readonly,
syscall4 as syscall4_readonly, syscall5 as syscall5_readonly,
syscall6 as syscall6_readonly,
};
}
type ClockGettimeType = unsafe extern "C" fn(c::c_int, *mut Timespec) -> c::c_int;
#[cfg(target_arch = "x86")]
pub(super) type SyscallType = unsafe extern "C" fn();
fn init_clock_gettime() -> ClockGettimeType {
init();
unsafe { transmute(CLOCK_GETTIME.load(Relaxed)) }
}
#[cfg(target_arch = "x86")]
fn init_syscall() -> SyscallType {
init();
unsafe { transmute(SYSCALL.load(Relaxed)) }
}
static mut CLOCK_GETTIME: AtomicUsize = AtomicUsize::new(0);
#[cfg(target_arch = "x86")]
static mut SYSCALL: AtomicUsize = AtomicUsize::new(0);
unsafe extern "C" fn rustix_clock_gettime_via_syscall(
clockid: c::c_int,
res: *mut Timespec,
) -> c::c_int {
match _rustix_clock_gettime_via_syscall(clockid, res) {
Ok(()) => 0,
Err(e) => e.raw_os_error().wrapping_neg(),
}
}
#[cfg(target_pointer_width = "32")]
unsafe fn _rustix_clock_gettime_via_syscall(
clockid: c::c_int,
res: *mut Timespec,
) -> io::Result<()> {
let r0 = syscall2(
nr(__NR_clock_gettime64),
pass_usize(clockid as usize),
void_star(res.cast::<c::c_void>()),
);
match ret(r0) {
Err(io::Error::NOSYS) => _rustix_clock_gettime_via_syscall_old(clockid, res),
otherwise => otherwise,
}
}
#[cfg(target_pointer_width = "32")]
unsafe fn _rustix_clock_gettime_via_syscall_old(
clockid: c::c_int,
res: *mut Timespec,
) -> io::Result<()> {
let mut old_result = MaybeUninit::<__kernel_old_timespec>::uninit();
let r0 = syscall2(
nr(__NR_clock_gettime),
pass_usize(clockid as usize),
out(&mut old_result),
);
match ret(r0) {
Ok(()) => {
let old_result = old_result.assume_init();
*res = Timespec {
tv_sec: old_result.tv_sec.into(),
tv_nsec: old_result.tv_nsec.into(),
};
Ok(())
}
otherwise => otherwise,
}
}
#[cfg(target_pointer_width = "64")]
unsafe fn _rustix_clock_gettime_via_syscall(
clockid: c::c_int,
res: *mut Timespec,
) -> io::Result<()> {
ret(syscall2(
nr(__NR_clock_gettime),
pass_usize(clockid as usize),
void_star(res.cast::<c::c_void>()),
))
}
#[cfg(all(asm, target_arch = "x86"))]
#[naked]
unsafe extern "C" fn rustix_int_0x80() {
asm!("int $$0x80", "ret", options(noreturn))
}
#[cfg(all(not(asm), target_arch = "x86"))]
extern "C" {
fn rustix_int_0x80();
}
fn minimal_init() {
unsafe {
CLOCK_GETTIME
.compare_exchange(
0,
rustix_clock_gettime_via_syscall as ClockGettimeType as usize,
Relaxed,
Relaxed,
)
.ok();
#[cfg(target_arch = "x86")]
SYSCALL
.compare_exchange(0, rustix_int_0x80 as SyscallType as usize, Relaxed, Relaxed)
.ok();
}
}
fn init() {
minimal_init();
if let Some(vdso) = vdso::Vdso::new() {
#[cfg(target_arch = "x86_64")]
let ptr = vdso.sym(zstr!("LINUX_2.6"), zstr!("__vdso_clock_gettime"));
#[cfg(target_arch = "arm")]
let ptr = vdso.sym(zstr!("LINUX_2.6"), zstr!("__vdso_clock_gettime64"));
#[cfg(target_arch = "aarch64")]
let ptr = vdso.sym(zstr!("LINUX_2.6.39"), zstr!("__kernel_clock_gettime"));
#[cfg(target_arch = "x86")]
let ptr = vdso.sym(zstr!("LINUX_2.6"), zstr!("__vdso_clock_gettime64"));
#[cfg(target_arch = "riscv64")]
let ptr = vdso.sym(zstr!("LINUX_4.15"), zstr!("__vdso_clock_gettime"));
#[cfg(target_arch = "powerpc64")]
let ptr = vdso.sym(zstr!("LINUX_2.6.15"), zstr!("__kernel_clock_gettime"));
#[cfg(target_arch = "mips")]
let ptr = vdso.sym(zstr!("LINUX_2.6"), zstr!("__vdso_clock_gettime64"));
#[cfg(target_arch = "mips64")]
let ptr = vdso.sym(zstr!("LINUX_2.6"), zstr!("__vdso_clock_gettime"));
#[cfg(any(target_pointer_width = "64"))]
let ok = true;
#[cfg(any(target_arch = "arm", target_arch = "mips", target_arch = "x86"))]
let ok = !ptr.is_null();
if ok {
assert!(!ptr.is_null());
unsafe {
CLOCK_GETTIME.store(ptr as usize, Relaxed);
}
}
#[cfg(target_arch = "x86")]
{
let ptr = vdso.sym(zstr!("LINUX_2.5"), zstr!("__kernel_vsyscall"));
assert!(!ptr.is_null());
unsafe {
SYSCALL.store(ptr as usize, Relaxed);
}
}
}
}