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::ptr::addr_of;
8use core::str;
9use kernel::debug;
10use kernel::debug::IoWrite;
11
12use crate::CHIP;
13use crate::PROCESSES;
14use crate::PROCESS_PRINTER;
15
16struct Writer {}
17
18static mut WRITER: Writer = Writer {};
19
20impl Write for Writer {
21    fn write_str(&mut self, s: &str) -> ::core::fmt::Result {
22        self.write(s.as_bytes());
23        Ok(())
24    }
25}
26
27impl IoWrite for Writer {
28    fn write(&mut self, buf: &[u8]) -> usize {
29        let uart = esp32::uart::Uart::new(esp32::uart::UART0_BASE);
30        uart.disable_tx_interrupt();
31        uart.disable_rx_interrupt();
32        uart.transmit_sync(buf);
33        buf.len()
34    }
35}
36
37/// Panic handler.
38#[cfg(not(test))]
39#[no_mangle]
40#[panic_handler]
41pub unsafe fn panic_fmt(pi: &PanicInfo) -> ! {
42    use core::ptr::addr_of_mut;
43
44    let writer = &mut *addr_of_mut!(WRITER);
45
46    debug::panic_banner(writer, pi);
47    debug::panic_cpu_state(&*addr_of!(CHIP), writer);
48    debug::panic_process_info(&*addr_of!(PROCESSES), &*addr_of!(PROCESS_PRINTER), writer);
49
50    loop {
51        rv32i::support::nop();
52    }
53}
54
55#[cfg(test)]
56#[no_mangle]
57#[panic_handler]
58pub unsafe fn panic_fmt(pi: &PanicInfo) -> ! {
59    use core::ptr::addr_of_mut;
60
61    let writer = &mut *addr_of_mut!(WRITER);
62
63    debug::panic_print(
64        writer,
65        pi,
66        &rv32i::support::nop,
67        &*addr_of!(PROCESSES),
68        &*addr_of!(CHIP),
69        &*addr_of!(PROCESS_PRINTER),
70    );
71
72    let _ = writeln!(writer, "{}", pi);
73    loop {}
74}