sma_q3/
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 kernel::debug;
8use kernel::debug::IoWrite;
9use kernel::hil::led;
10use nrf52840::gpio::Pin;
11
12use crate::CHIP;
13use crate::PROCESSES;
14use crate::PROCESS_PRINTER;
15
16enum Writer {
17    Uninitialized,
18    WriterRtt(&'static segger::rtt::SeggerRttMemory<'static>),
19}
20
21static mut WRITER: Writer = Writer::Uninitialized;
22
23/// Set the RTT memory buffer used to output panic messages.
24pub unsafe fn set_rtt_memory(rtt_memory: &'static segger::rtt::SeggerRttMemory<'static>) {
25    WRITER = Writer::WriterRtt(rtt_memory);
26}
27
28impl Write for Writer {
29    fn write_str(&mut self, s: &str) -> ::core::fmt::Result {
30        self.write(s.as_bytes());
31        Ok(())
32    }
33}
34
35impl IoWrite for Writer {
36    fn write(&mut self, buf: &[u8]) -> usize {
37        match self {
38            Writer::Uninitialized => {}
39            Writer::WriterRtt(rtt_memory) => rtt_memory.write_sync(buf),
40        }
41        buf.len()
42    }
43}
44
45#[cfg(not(test))]
46#[no_mangle]
47#[panic_handler]
48/// Panic handler
49pub unsafe fn panic_fmt(pi: &PanicInfo) -> ! {
50    // The display LEDs (see back of board)
51
52    use core::ptr::{addr_of, addr_of_mut};
53    let led_kernel_pin = &nrf52840::gpio::GPIOPin::new(Pin::P0_13);
54    let led = &mut led::LedLow::new(led_kernel_pin);
55    let writer = &mut *addr_of_mut!(WRITER);
56    debug::panic(
57        &mut [led],
58        writer,
59        pi,
60        &cortexm4::support::nop,
61        &*addr_of!(PROCESSES),
62        &*addr_of!(CHIP),
63        &*addr_of!(PROCESS_PRINTER),
64    )
65}