You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
78 lines
2.1 KiB
Rust
78 lines
2.1 KiB
Rust
// SPDX-License-Identifier: MIT
|
|
//
|
|
// Copyright (c) 2018-2019 Andre Richter <andre.o.richter@gmail.com>
|
|
|
|
//! Timer primitives.
|
|
|
|
use crate::{interface, warn};
|
|
use core::time::Duration;
|
|
use cortex_a::regs::*;
|
|
|
|
const NS_PER_S: u64 = 1_000_000_000;
|
|
|
|
pub struct Timer;
|
|
|
|
impl interface::time::Timer for Timer {
|
|
fn resolution(&self) -> Duration {
|
|
Duration::from_nanos(NS_PER_S / (CNTFRQ_EL0.get() as u64))
|
|
}
|
|
|
|
fn uptime(&self) -> Duration {
|
|
let frq: u64 = CNTFRQ_EL0.get() as u64;
|
|
let current_count: u64 = CNTPCT_EL0.get() * NS_PER_S;
|
|
|
|
Duration::from_nanos(current_count / frq)
|
|
}
|
|
|
|
fn spin_for(&self, duration: Duration) {
|
|
// Instantly return on zero.
|
|
if duration.as_nanos() == 0 {
|
|
return;
|
|
}
|
|
|
|
// Calculate the register compare value.
|
|
let frq = CNTFRQ_EL0.get() as u64;
|
|
let x = match frq.checked_mul(duration.as_nanos() as u64) {
|
|
None => {
|
|
warn!("Spin duration too long, skipping");
|
|
return;
|
|
}
|
|
Some(val) => val,
|
|
};
|
|
let tval = x / NS_PER_S;
|
|
|
|
// Check if it is within supported bounds.
|
|
let warn: Option<&str> = if tval == 0 {
|
|
Some("smaller")
|
|
} else if tval > u32::max_value().into() {
|
|
Some("bigger")
|
|
} else {
|
|
None
|
|
};
|
|
|
|
if let Some(w) = warn {
|
|
warn!(
|
|
"Spin duration {} than architecturally supported, skipping",
|
|
w
|
|
);
|
|
return;
|
|
}
|
|
|
|
// Set the compare value register.
|
|
CNTP_TVAL_EL0.set(tval as u32);
|
|
|
|
// Kick off the counting. // Disable timer interrupt.
|
|
CNTP_CTL_EL0.modify(CNTP_CTL_EL0::ENABLE::SET + CNTP_CTL_EL0::IMASK::SET);
|
|
|
|
loop {
|
|
// ISTATUS will be '1' when cval ticks have passed. Busy-check it.
|
|
if CNTP_CTL_EL0.is_set(CNTP_CTL_EL0::ISTATUS) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
// Disable counting again.
|
|
CNTP_CTL_EL0.modify(CNTP_CTL_EL0::ENABLE::CLEAR);
|
|
}
|
|
}
|