1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60

#![allow(dead_code)]

#[cfg(not(target_arch = "aarch64"))]
pub use generic::*;

#[cfg(target_arch = "aarch64")]
pub use aarch64::*;

mod generic {
    pub fn now() -> std::time::Instant {
        std::time::Instant::now()
    }
}

#[cfg(target_arch = "aarch64")]
mod aarch64 {
    use std::arch::asm;
    use std::time::Duration;

    pub struct Timestamp(u64);

    impl Timestamp {
        pub fn elapsed(&self) -> Duration {
            let diff = timestamp().saturating_sub(self.0) as f64;
            let secs = diff / frequency() as f64;
            std::time::Duration::from_secs_f64(secs)
        }
    }

    pub fn now() -> Timestamp {
        Timestamp(timestamp())
    }

    #[inline]
    fn frequency() -> u64 {
        unsafe {
            let frequency: u64;
            asm!(
                "mrs {}, cntfrq_el0",
                out(reg) frequency,
                options(nomem, nostack, preserves_flags, pure),
            );
            frequency
        }
    }

    #[inline(always)]
    fn timestamp() -> u64 {
        unsafe {
            let timestamp: u64;
            asm!(
                "mrs {}, cntvct_el0",
                out(reg) timestamp,
                // Leave off `nomem` because this should be a compiler fence.
                options(nostack, preserves_flags),
            );
            timestamp
        }
    }
}