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

#![cfg(not(test))]
#![cfg(feature = "panic-handler")]

use core::panic::PanicInfo;
use core::fmt::Write;
use heapless::String;
use super::proc::error;


#[panic_handler]
fn panic(#[allow(unused)] panic_info: &PanicInfo) -> ! {
	let mut output = String::<1024>::new();
	let payload = if let Some(payload) = panic_info.payload().downcast_ref::<&str>() {
		payload
	} else {
		""
	};

	let location = panic_info.location();
	let (module, line) = if let Some(location) = location {
		(location.file(), location.line())
	} else {
		("", 0)
	};

	let _ = if let Some(message) = panic_info.message() {
		write!(output, "PANIC: [{module}@{line}] \"{message}\" {payload}\0")
	} else {
		write!(output, "PANIC: [{module}@{line}] {payload}\0")
	};
	error(output.as_str());
}