esp32_c3_board/
io.rs

1// Licensed under the Apache License, Version 2.0 or the MIT License.
2// SPDX-License-Identifier: Apache-2.0 OR MIT
3// Copyright Tock Contributors 2022.
4
5use core::fmt::Write;
6use core::panic::PanicInfo;
7use core::str;
8use kernel::debug;
9use kernel::debug::IoWrite;
10
11struct Writer {}
12
13static mut WRITER: Writer = Writer {};
14
15impl Write for Writer {
16    fn write_str(&mut self, s: &str) -> ::core::fmt::Result {
17        self.write(s.as_bytes());
18        Ok(())
19    }
20}
21
22impl IoWrite for Writer {
23    fn write(&mut self, buf: &[u8]) -> usize {
24        let uart = esp32::uart::Uart::new(esp32::uart::UART0_BASE);
25        uart.disable_tx_interrupt();
26        uart.disable_rx_interrupt();
27        uart.transmit_sync(buf);
28        buf.len()
29    }
30}
31
32/// Panic handler.
33#[cfg(not(test))]
34#[panic_handler]
35pub unsafe fn panic_fmt(pi: &PanicInfo) -> ! {
36    use core::ptr::addr_of_mut;
37
38    let writer = &mut *addr_of_mut!(WRITER);
39
40    debug::panic_print(
41        writer,
42        pi,
43        &rv32i::support::nop,
44        crate::PANIC_RESOURCES.get(),
45    );
46
47    loop {
48        rv32i::support::nop();
49    }
50}
51
52#[cfg(test)]
53#[panic_handler]
54pub unsafe fn panic_fmt(pi: &PanicInfo) -> ! {
55    use core::ptr::addr_of_mut;
56
57    let writer = &mut *addr_of_mut!(WRITER);
58
59    debug::panic_print(
60        writer,
61        pi,
62        &rv32i::support::nop,
63        crate::PANIC_RESOURCES.get(),
64    );
65
66    let _ = writeln!(writer, "{}", pi);
67    loop {}
68}