Imagelibrary/rt-thread
1
0
Fork 0
mirror of https://github.com/RT-Thread/rt-thread.git synced 2026-02-05 05:23:46 +00:00
Code Issues Packages Projects Releases Wiki Activity

[libcpu][cortex-m33]Added HardFault_Handler to save floating point registers

Browse Source
This commit is contained in:
Rbb666
2025-08-20 18:13:15 +08:00
committed by R b b666
parent 60b3ccb8ad
commit 882d1958dd
3 changed files with 21 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
libcpu/arm/cortex-m33/context_gcc.S
View File

@@ -281,6 +281,12 @@ HardFault_Handler:
MRS r0, psp /* get fault context from thread. */
get_sp_done:
#if defined (__VFP_FP__) && !defined(__SOFTFP__)
TST lr, #0x10 /* if(!EXC_RETURN[4]) */
IT EQ
VSTMDBEQ r0!, {d8 - d15} /* push FPU register s16~s31 */
#endif
STMFD r0!, {r4 - r11} /* push r4 - r11 register */
LDR r2, =rt_trustzone_current_context /* r2 = &rt_secure_current_context */

7
libcpu/arm/cortex-m33/context_iar.S
View File

@@ -275,6 +275,13 @@ HardFault_Handler:
MRS r0, psp ; get fault context from thread.
get_sp_done
#if defined ( __ARMVFP__ )
TST lr, #0x10 ; if(!EXC_RETURN[4])
BNE skip_push_fpu
VSTMDB r0!, {d8 - d15} ; push FPU register s16~s31
skip_push_fpu
#endif
STMFD r0!, {r4 - r11} ; push r4 - r11 register
LDR r2, =rt_trustzone_current_context ; r2 = &rt_secure_current_context

11
libcpu/arm/cortex-m33/context_rvds.S
View File

@@ -272,12 +272,17 @@ rt_hw_interrupt_thread_switch PROC
HardFault_Handler PROC
; get current context
MRS r0, msp ;get fault context from handler
TST lr, #0x04 ;if(!EXC_RETURN[2])
MRS r0, msp ; get fault context from handler
TST lr, #0x04 ; if(!EXC_RETURN[2])
BEQ get_sp_done
MRS r0, psp ;get fault context from thread
MRS r0, psp ; get fault context from thread
get_sp_done
IF {FPU} != "SoftVFP"
TST lr, #0x10 ; if(!EXC_RETURN[4])
VSTMFDEQ r0!, {d8 - d15} ; push FPU register s16~s31
ENDIF
STMFD r0!, {r4 - r11} ; push r4 - r11 register
LDR r2, =rt_trustzone_current_context ; r2 = &rt_secure_current_context