mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-16 08:38:26 +00:00
xous-ticktimer: add SAMA5D2 implementation
This commit is contained in:
parent
1bbf5621fd
commit
2a52359065
3 changed files with 182 additions and 0 deletions
175
services/xous-ticktimer/src/platform/atsama5d2/implementation.rs
Normal file
175
services/xous-ticktimer/src/platform/atsama5d2/implementation.rs
Normal file
|
|
@ -0,0 +1,175 @@
|
|||
use atsama5d27::tc::Tc;
|
||||
#[cfg(feature = "debug-print")]
|
||||
use log::{info, trace};
|
||||
use log::error;
|
||||
use utralib::*;
|
||||
use xous::arch::irq::IrqNumber;
|
||||
|
||||
use crate::platform::TimerRequest;
|
||||
|
||||
const MASTER_CLOCK_SPEED: u32 = 164000000 / 2;
|
||||
const TICKS_PER_MS: u32 = MASTER_CLOCK_SPEED / 128 / 1000;
|
||||
|
||||
pub struct XousTickTimer {
|
||||
timer: Tc,
|
||||
current_response: Option<TimerRequest>,
|
||||
last_response: Option<TimerRequest>,
|
||||
connection: xous::CID,
|
||||
}
|
||||
|
||||
/// *NOTE*: Avoid panics and prints inside an IRQ handler as they may result in forbidden syscalls
|
||||
fn handle_irq(_irq_no: usize, arg: *mut usize) {
|
||||
let xtt = unsafe { &mut *(arg as *mut XousTickTimer) };
|
||||
xtt.timer.status(); // Acknowledge the interrupt by reading status register
|
||||
xtt.timer.stop();
|
||||
|
||||
// Safe because we're in an interrupt, and this interrupt is only
|
||||
// enabled when this value is not None.
|
||||
let response = xtt.current_response.take();
|
||||
if let Some(response) = response {
|
||||
xous::return_scalar(response.sender, response.kind as usize).ok();
|
||||
|
||||
// This is dangerous and may return an error if the queue is full.
|
||||
// Which is fine, because the queue is always recalculated any time a message arrives.
|
||||
use num_traits::ToPrimitive;
|
||||
xous::try_send_message(
|
||||
xtt.connection,
|
||||
xous::Message::Scalar(xous::ScalarMessage {
|
||||
id: crate::api::Opcode::RecalculateSleep.to_usize().unwrap(),
|
||||
arg1: response.sender.to_usize(),
|
||||
arg2: response.kind as usize,
|
||||
arg3: response.data,
|
||||
arg4: 0,
|
||||
}),
|
||||
)
|
||||
.ok();
|
||||
|
||||
// Save the response so we can be sure we don't double-return messages.
|
||||
xtt.last_response = Some(response);
|
||||
} else {
|
||||
unsafe { core::arch::asm!("bkpt") };
|
||||
}
|
||||
}
|
||||
|
||||
impl XousTickTimer {
|
||||
pub fn new(connection: xous::CID) -> XousTickTimer {
|
||||
let csr = xous::syscall::map_memory(
|
||||
xous::MemoryAddress::new(HW_TC0_BASE),
|
||||
None,
|
||||
0x1000, // 16K
|
||||
xous::MemoryFlags::R | xous::MemoryFlags::W | xous::MemoryFlags::DEV,
|
||||
)
|
||||
.expect("couldn't map TC0 CSR range");
|
||||
|
||||
let mut timer = Tc::with_alt_base_addr(csr.as_ptr() as u32);
|
||||
timer.init();
|
||||
|
||||
let mut xtt = XousTickTimer {
|
||||
timer,
|
||||
current_response: None,
|
||||
last_response: None,
|
||||
connection,
|
||||
};
|
||||
|
||||
xous::claim_interrupt(
|
||||
IrqNumber::Tc0 as usize,
|
||||
handle_irq,
|
||||
(&mut xtt) as *mut XousTickTimer as *mut usize,
|
||||
)
|
||||
.expect("couldn't claim irq");
|
||||
|
||||
xtt
|
||||
}
|
||||
|
||||
pub fn reset(&mut self) {
|
||||
// no-op, the TC0 timer resets itself every time it's started
|
||||
}
|
||||
|
||||
pub fn last_response(&self) -> &Option<TimerRequest> {
|
||||
&self.last_response
|
||||
}
|
||||
|
||||
pub fn clear_last_response(&mut self) {
|
||||
self.last_response = None;
|
||||
}
|
||||
pub fn raw_ticktime(&self) -> u32 {
|
||||
let ticktime = self.timer.counter();
|
||||
#[cfg(feature = "debug-print")]
|
||||
trace!("Raw ticktime: {:08x}", ticktime);
|
||||
ticktime
|
||||
}
|
||||
|
||||
pub fn elapsed_ms(&self) -> u32 {
|
||||
let elapsed_ms = self.raw_ticktime() / TICKS_PER_MS;
|
||||
#[cfg(feature = "debug-print")]
|
||||
trace!("Elapsed ms: {}", elapsed_ms);
|
||||
elapsed_ms
|
||||
}
|
||||
|
||||
pub fn stop_interrupt(&mut self) -> Option<TimerRequest> {
|
||||
// Disable the timer
|
||||
self.timer.set_interrupt(false);
|
||||
|
||||
// Now that the interrupt is disabled, we can see if the interrupt handler has a current response.
|
||||
// If it exists, then that means that an interrupt did NOT fire, and an existing interrupt
|
||||
// is in place.
|
||||
if let Some(sr) = self.current_response.take() {
|
||||
#[cfg(feature = "debug-print")]
|
||||
{
|
||||
info!(
|
||||
"Stopping currently-running timer sr.msec: {} elapsed_ms: {}",
|
||||
sr.msec,
|
||||
self.elapsed_ms()
|
||||
);
|
||||
}
|
||||
Some(sr)
|
||||
} else {
|
||||
None
|
||||
}
|
||||
}
|
||||
|
||||
pub fn schedule_response(&mut self, request: TimerRequest) {
|
||||
let irq_target = request.msec;
|
||||
if irq_target > u32::MAX as i64 {
|
||||
error!(
|
||||
"Invalid sleep target: {} can't be more than {} ms",
|
||||
irq_target,
|
||||
u32::MAX
|
||||
);
|
||||
return;
|
||||
}
|
||||
|
||||
#[cfg(feature = "debug-print")]
|
||||
trace!(
|
||||
"setting a response at {} ms (current time: {} ms)",
|
||||
irq_target,
|
||||
self.elapsed_ms()
|
||||
);
|
||||
|
||||
self.timer.set_period(irq_target as u32 * TICKS_PER_MS);
|
||||
|
||||
// Save a copy of the current sleep request
|
||||
self.current_response = Some(request);
|
||||
|
||||
// Reset and enable interrupt
|
||||
self.timer.set_interrupt(true);
|
||||
self.timer.start();
|
||||
}
|
||||
|
||||
// the ticktimer suspend/resume routines are a bit trickier than normal, so this isn't a great
|
||||
// example of a generic suspend/resume template
|
||||
pub fn suspend(&mut self) {
|
||||
#[cfg(feature = "debug-print")]
|
||||
trace!("suspending");
|
||||
}
|
||||
|
||||
pub fn resume(&mut self) {
|
||||
#[cfg(feature = "debug-print")]
|
||||
trace!("resuming");
|
||||
}
|
||||
|
||||
#[allow(dead_code)]
|
||||
pub fn reset_wdt(&mut self) {
|
||||
// TODO: reset watchdog timer
|
||||
}
|
||||
}
|
||||
1
services/xous-ticktimer/src/platform/atsama5d2/mod.rs
Normal file
1
services/xous-ticktimer/src/platform/atsama5d2/mod.rs
Normal file
|
|
@ -0,0 +1 @@
|
|||
pub mod implementation;
|
||||
|
|
@ -13,6 +13,12 @@ pub mod hosted;
|
|||
))]
|
||||
pub use hosted::*;
|
||||
|
||||
#[cfg(any(feature="atsama5d27"))]
|
||||
#[macro_use]
|
||||
pub mod atsama5d2;
|
||||
#[cfg(any(feature="atsama5d27"))]
|
||||
pub use atsama5d2::*;
|
||||
|
||||
pub(crate) type TimeoutExpiry = i64;
|
||||
|
||||
#[derive(PartialEq, Eq, PartialOrd, Ord, Copy, Clone)]
|
||||
|
|
|
|||
Loading…
Reference in a new issue