diff --git a/libs/cramium-hal/src/debug.rs b/libs/cramium-hal/src/debug.rs new file mode 100644 index 000000000..1d68f956b --- /dev/null +++ b/libs/cramium-hal/src/debug.rs @@ -0,0 +1,49 @@ +use utralib::generated::*; +pub struct Uart {} + +impl Uart { + pub fn putc(&self, c: u8) { + let base = utra::duart::HW_DUART_BASE as *mut u32; + let mut uart = CSR::new(base); + while uart.r(utra::duart::SFR_SR) != 0 {} + uart.wo(utra::duart::SFR_TXD, c as u32); + } +} + +use core::fmt::{Error, Write}; +impl Write for Uart { + fn write_str(&mut self, s: &str) -> Result<(), Error> { + #[cfg(not(feature = "std"))] + for c in s.bytes() { + self.putc(c); + } + #[cfg(feature = "std")] + log::info!("{}", s); + Ok(()) + } +} + +pub mod debug_print_hardware { + #[macro_export] + macro_rules! print + { + ($($args:tt)+) => ({ + use core::fmt::Write; + let _ = write!(crate::debug::Uart {}, $($args)+); + }); + } +} + +#[macro_export] +macro_rules! println +{ + () => ({ + $crate::print!("\r\n") + }); + ($fmt:expr) => ({ + $crate::print!(concat!($fmt, "\r\n")) + }); + ($fmt:expr, $($args:tt)+) => ({ + $crate::print!(concat!($fmt, "\r\n"), $($args)+) + }); +} diff --git a/libs/cramium-hal/src/lib.rs b/libs/cramium-hal/src/lib.rs index f17311738..b8739653e 100644 --- a/libs/cramium-hal/src/lib.rs +++ b/libs/cramium-hal/src/lib.rs @@ -1,5 +1,7 @@ #![cfg_attr(not(feature = "std"), no_std)] +#[macro_use] +pub mod debug; pub mod ifram; pub mod iox; pub mod sce;