1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51

//! Panic handler for Furi applications.
//! This will print the panic info to stdout and then trigger a crash.

use core::ffi::{CStr, c_char};
use core::fmt::Write;
use core::panic::PanicInfo;
use core::str;

use flipperzero_sys as sys;

/// Minimal [`Stdout`] implementation.
struct Stdout;

impl Write for Stdout {
    fn write_str(&mut self, s: &str) -> core::fmt::Result {
        let len = s.len();
        unsafe {
            if sys::furi_thread_stdout_write(s.as_ptr() as *mut c_char, len) != len {
                return Err(core::fmt::Error);
            }
        }

        Ok(())
    }
}

#[panic_handler]
pub fn panic(panic_info: &PanicInfo<'_>) -> ! {
    let thread_name = unsafe {
        let thread_id = sys::furi_thread_get_current_id();
        let thread_name = sys::furi_thread_get_name(thread_id);

        if thread_name.is_null() {
            "<unknown>"
        } else {
            str::from_utf8_unchecked(CStr::from_ptr(thread_name).to_bytes())
        }
    };

    // Format: "thread: 'App Name' paniced at 'panic!', panic.rs:5"
    let _ = write!(
        &mut Stdout,
        "\x1b[0;31mthread '{thread_name}' {panic_info}\x1b[0m\r\n"
    );

    unsafe {
        sys::furi_thread_stdout_flush();
        sys::furi_thread_yield(); // Allow console to flush
        sys::crash!("Rust panic")
    }
}