mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-11-14 00:37:21 +00:00
f3ae09cc16
* FuriHal: allow nulling null isr * FuriHal: include interrupt priority 15 as allowed * Furi: prevent compiler from optimizing arg in r0 of RESTORE_REGISTERS_AND_HALT_MCU
204 lines
7.1 KiB
C
204 lines
7.1 KiB
C
#include "check.h"
|
|
#include "common_defines.h"
|
|
|
|
#include <stm32wbxx.h>
|
|
#include <furi_hal_console.h>
|
|
#include <furi_hal_power.h>
|
|
#include <furi_hal_rtc.h>
|
|
#include <furi_hal_debug.h>
|
|
#include <furi_hal_bt.h>
|
|
#include <stdio.h>
|
|
|
|
#include <FreeRTOS.h>
|
|
#include <task.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
|
|
PLACE_IN_SECTION("MB_MEM2") const char* __furi_check_message = NULL;
|
|
PLACE_IN_SECTION("MB_MEM2") uint32_t __furi_check_registers[13] = {0};
|
|
|
|
/** Load r12 value to __furi_check_message and store registers to __furi_check_registers */
|
|
#define GET_MESSAGE_AND_STORE_REGISTERS() \
|
|
asm volatile("ldr r11, =__furi_check_message \n" \
|
|
"str r12, [r11] \n" \
|
|
"ldr r12, =__furi_check_registers \n" \
|
|
"stm r12, {r0-r11} \n" \
|
|
"str lr, [r12, #48] \n" \
|
|
: \
|
|
: \
|
|
: "memory");
|
|
|
|
/** Restore registers and halt MCU
|
|
*
|
|
* - Always use it with GET_MESSAGE_AND_STORE_REGISTERS
|
|
* - If debugger is(was) connected this routine will raise bkpt
|
|
* - If debugger is not connected then endless loop
|
|
*
|
|
*/
|
|
#define RESTORE_REGISTERS_AND_HALT_MCU(debug) \
|
|
register bool r0 asm("r0") = debug; \
|
|
asm volatile("cbnz r0, with_debugger%= \n" \
|
|
"ldr r12, =__furi_check_registers\n" \
|
|
"ldm r12, {r0-r11} \n" \
|
|
"loop%=: \n" \
|
|
"wfi \n" \
|
|
"b loop%= \n" \
|
|
"with_debugger%=: \n" \
|
|
"ldr r12, =__furi_check_registers\n" \
|
|
"ldm r12, {r0-r11} \n" \
|
|
"debug_loop%=: \n" \
|
|
"bkpt 0x00 \n" \
|
|
"wfi \n" \
|
|
"b debug_loop%= \n" \
|
|
: \
|
|
: "r"(r0) \
|
|
: "memory");
|
|
|
|
extern size_t xPortGetTotalHeapSize(void);
|
|
extern size_t xPortGetFreeHeapSize(void);
|
|
extern size_t xPortGetMinimumEverFreeHeapSize(void);
|
|
|
|
static void __furi_put_uint32_as_text(uint32_t data) {
|
|
char tmp_str[] = "-2147483648";
|
|
itoa(data, tmp_str, 10);
|
|
furi_hal_console_puts(tmp_str);
|
|
}
|
|
|
|
static void __furi_put_uint32_as_hex(uint32_t data) {
|
|
char tmp_str[] = "0xFFFFFFFF";
|
|
itoa(data, tmp_str, 16);
|
|
furi_hal_console_puts(tmp_str);
|
|
}
|
|
|
|
static void __furi_print_register_info() {
|
|
// Print registers
|
|
for(uint8_t i = 0; i < 12; i++) {
|
|
furi_hal_console_puts("\r\n\tr");
|
|
__furi_put_uint32_as_text(i);
|
|
furi_hal_console_puts(" : ");
|
|
__furi_put_uint32_as_hex(__furi_check_registers[i]);
|
|
}
|
|
|
|
furi_hal_console_puts("\r\n\tlr : ");
|
|
__furi_put_uint32_as_hex(__furi_check_registers[12]);
|
|
}
|
|
|
|
static void __furi_print_stack_info() {
|
|
furi_hal_console_puts("\r\n\tstack watermark: ");
|
|
__furi_put_uint32_as_text(uxTaskGetStackHighWaterMark(NULL) * 4);
|
|
}
|
|
|
|
static void __furi_print_bt_stack_info() {
|
|
const FuriHalBtHardfaultInfo* fault_info = furi_hal_bt_get_hardfault_info();
|
|
if(fault_info == NULL) {
|
|
furi_hal_console_puts("\r\n\tcore2: not faulted");
|
|
} else {
|
|
furi_hal_console_puts("\r\n\tcore2: hardfaulted.\r\n\tPC: ");
|
|
__furi_put_uint32_as_hex(fault_info->source_pc);
|
|
furi_hal_console_puts("\r\n\tLR: ");
|
|
__furi_put_uint32_as_hex(fault_info->source_lr);
|
|
furi_hal_console_puts("\r\n\tSP: ");
|
|
__furi_put_uint32_as_hex(fault_info->source_sp);
|
|
}
|
|
}
|
|
|
|
static void __furi_print_heap_info() {
|
|
furi_hal_console_puts("\r\n\t heap total: ");
|
|
__furi_put_uint32_as_text(xPortGetTotalHeapSize());
|
|
furi_hal_console_puts("\r\n\t heap free: ");
|
|
__furi_put_uint32_as_text(xPortGetFreeHeapSize());
|
|
furi_hal_console_puts("\r\n\t heap watermark: ");
|
|
__furi_put_uint32_as_text(xPortGetMinimumEverFreeHeapSize());
|
|
}
|
|
|
|
static void __furi_print_name(bool isr) {
|
|
if(isr) {
|
|
furi_hal_console_puts("[ISR ");
|
|
__furi_put_uint32_as_text(__get_IPSR());
|
|
furi_hal_console_puts("] ");
|
|
} else {
|
|
const char* name = pcTaskGetName(NULL);
|
|
if(name == NULL) {
|
|
furi_hal_console_puts("[main] ");
|
|
} else {
|
|
furi_hal_console_puts("[");
|
|
furi_hal_console_puts(name);
|
|
furi_hal_console_puts("] ");
|
|
}
|
|
}
|
|
}
|
|
|
|
FURI_NORETURN void __furi_crash() {
|
|
__disable_irq();
|
|
GET_MESSAGE_AND_STORE_REGISTERS();
|
|
|
|
bool isr = FURI_IS_IRQ_MODE();
|
|
|
|
if(__furi_check_message == NULL) {
|
|
__furi_check_message = "Fatal Error";
|
|
} else if(__furi_check_message == (void*)__FURI_ASSERT_MESSAGE_FLAG) {
|
|
__furi_check_message = "furi_assert failed";
|
|
} else if(__furi_check_message == (void*)__FURI_CHECK_MESSAGE_FLAG) {
|
|
__furi_check_message = "furi_check failed";
|
|
}
|
|
|
|
furi_hal_console_puts("\r\n\033[0;31m[CRASH]");
|
|
__furi_print_name(isr);
|
|
furi_hal_console_puts(__furi_check_message);
|
|
|
|
__furi_print_register_info();
|
|
if(!isr) {
|
|
__furi_print_stack_info();
|
|
}
|
|
__furi_print_heap_info();
|
|
__furi_print_bt_stack_info();
|
|
|
|
#ifndef FURI_DEBUG
|
|
// Check if debug enabled by DAP
|
|
// https://developer.arm.com/documentation/ddi0403/d/Debug-Architecture/ARMv7-M-Debug/Debug-register-support-in-the-SCS/Debug-Halting-Control-and-Status-Register--DHCSR?lang=en
|
|
bool debug = CoreDebug->DHCSR & CoreDebug_DHCSR_C_DEBUGEN_Msk;
|
|
if(debug) {
|
|
#endif
|
|
furi_hal_console_puts("\r\nSystem halted. Connect debugger for more info\r\n");
|
|
furi_hal_console_puts("\033[0m\r\n");
|
|
furi_hal_debug_enable();
|
|
|
|
RESTORE_REGISTERS_AND_HALT_MCU(true);
|
|
#ifndef FURI_DEBUG
|
|
} else {
|
|
uint32_t ptr = (uint32_t)__furi_check_message;
|
|
if(ptr < FLASH_BASE || ptr > (FLASH_BASE + FLASH_SIZE)) {
|
|
ptr = (uint32_t) "Check serial logs";
|
|
}
|
|
furi_hal_rtc_set_fault_data(ptr);
|
|
furi_hal_console_puts("\r\nRebooting system.\r\n");
|
|
furi_hal_console_puts("\033[0m\r\n");
|
|
furi_hal_power_reset();
|
|
}
|
|
#endif
|
|
__builtin_unreachable();
|
|
}
|
|
|
|
FURI_NORETURN void __furi_halt() {
|
|
__disable_irq();
|
|
GET_MESSAGE_AND_STORE_REGISTERS();
|
|
|
|
bool isr = FURI_IS_IRQ_MODE();
|
|
|
|
if(__furi_check_message == NULL) {
|
|
__furi_check_message = "System halt requested.";
|
|
}
|
|
|
|
furi_hal_console_puts("\r\n\033[0;31m[HALT]");
|
|
__furi_print_name(isr);
|
|
furi_hal_console_puts(__furi_check_message);
|
|
furi_hal_console_puts("\r\nSystem halted. Bye-bye!\r\n");
|
|
furi_hal_console_puts("\033[0m\r\n");
|
|
|
|
// Check if debug enabled by DAP
|
|
// https://developer.arm.com/documentation/ddi0403/d/Debug-Architecture/ARMv7-M-Debug/Debug-register-support-in-the-SCS/Debug-Halting-Control-and-Status-Register--DHCSR?lang=en
|
|
bool debug = CoreDebug->DHCSR & CoreDebug_DHCSR_C_DEBUGEN_Msk;
|
|
RESTORE_REGISTERS_AND_HALT_MCU(debug);
|
|
|
|
__builtin_unreachable();
|
|
}
|