Furi: raise bkpt only if debug session initiated, add debug support for release builds (#1957)
* Fix hard crash on some custom firmwares in RELEASE mode * Furi: anya wa erai, anya wa eleganto, raise bkpt only if debug session initiated, add debug support for release builds Co-authored-by: DerSkythe <skif@skif.ws>
This commit is contained in:
		
							parent
							
								
									85d341104f
								
							
						
					
					
						commit
						104a1998a5
					
				| @ -1,6 +1,7 @@ | |||||||
| #include "check.h" | #include "check.h" | ||||||
| #include "common_defines.h" | #include "common_defines.h" | ||||||
| 
 | 
 | ||||||
|  | #include <stm32wbxx.h> | ||||||
| #include <furi_hal_console.h> | #include <furi_hal_console.h> | ||||||
| #include <furi_hal_power.h> | #include <furi_hal_power.h> | ||||||
| #include <furi_hal_rtc.h> | #include <furi_hal_rtc.h> | ||||||
| @ -24,16 +25,30 @@ PLACE_IN_SECTION("MB_MEM2") uint32_t __furi_check_registers[12] = {0}; | |||||||
|                  :                                      \ |                  :                                      \ | ||||||
|                  : "memory"); |                  : "memory"); | ||||||
| 
 | 
 | ||||||
| // Restore registers and halt MCU
 | /** Restore registers and halt MCU
 | ||||||
| #define RESTORE_REGISTERS_AND_HALT_MCU()                \ |  *  | ||||||
|     asm volatile("ldr r12, =__furi_check_registers  \n" \ |  * - 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 const bool r0 asm("r0") = debug;           \ | ||||||
|  |     asm volatile("cbnz  r0, with_debugger%=         \n" \ | ||||||
|  |                  "ldr   r12, =__furi_check_registers\n" \ | ||||||
|                  "ldm   r12, {r0-r11}               \n" \ |                  "ldm   r12, {r0-r11}               \n" \ | ||||||
|                  "loop%=:                           \n" \ |                  "loop%=:                           \n" \ | ||||||
|                  "bkpt 0x00                         \n" \ |  | ||||||
|                  "wfi                               \n" \ |                  "wfi                               \n" \ | ||||||
|                  "b     loop%=                      \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"); |                  : "memory"); | ||||||
| 
 | 
 | ||||||
| extern size_t xPortGetTotalHeapSize(void); | extern size_t xPortGetTotalHeapSize(void); | ||||||
| @ -96,16 +111,19 @@ FURI_NORETURN void __furi_crash() { | |||||||
|     } |     } | ||||||
|     __furi_print_heap_info(); |     __furi_print_heap_info(); | ||||||
| 
 | 
 | ||||||
| #ifdef 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) { | ||||||
|         furi_hal_console_puts("\r\nSystem halted. Connect debugger for more info\r\n"); |         furi_hal_console_puts("\r\nSystem halted. Connect debugger for more info\r\n"); | ||||||
|         furi_hal_console_puts("\033[0m\r\n"); |         furi_hal_console_puts("\033[0m\r\n"); | ||||||
|     RESTORE_REGISTERS_AND_HALT_MCU(); |         RESTORE_REGISTERS_AND_HALT_MCU(debug); | ||||||
| #else |     } else { | ||||||
|         furi_hal_rtc_set_fault_data((uint32_t)__furi_check_message); |         furi_hal_rtc_set_fault_data((uint32_t)__furi_check_message); | ||||||
|         furi_hal_console_puts("\r\nRebooting system.\r\n"); |         furi_hal_console_puts("\r\nRebooting system.\r\n"); | ||||||
|         furi_hal_console_puts("\033[0m\r\n"); |         furi_hal_console_puts("\033[0m\r\n"); | ||||||
|         furi_hal_power_reset(); |         furi_hal_power_reset(); | ||||||
| #endif |     } | ||||||
|     __builtin_unreachable(); |     __builtin_unreachable(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| @ -124,6 +142,11 @@ FURI_NORETURN void __furi_halt() { | |||||||
|     furi_hal_console_puts(__furi_check_message); |     furi_hal_console_puts(__furi_check_message); | ||||||
|     furi_hal_console_puts("\r\nSystem halted. Bye-bye!\r\n"); |     furi_hal_console_puts("\r\nSystem halted. Bye-bye!\r\n"); | ||||||
|     furi_hal_console_puts("\033[0m\r\n"); |     furi_hal_console_puts("\033[0m\r\n"); | ||||||
|     RESTORE_REGISTERS_AND_HALT_MCU(); | 
 | ||||||
|  |     // 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(); |     __builtin_unreachable(); | ||||||
| } | } | ||||||
|  | |||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user
	 あく
						あく