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