andreika-git
/
ChibiOS
mirror of https://github.com/andreika-git/ChibiOS.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Enabled FIQ in _port_thread_start 

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@10422 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
isiora 2017-08-14 09:03:32 +00:00
parent 1320b9c2e2
commit c06ff694bd
1 changed files with 6 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
os/common/ports/ARMCAx-TZ/compilers/GCC/chcoreasm.S
View File

@ -151,7 +151,7 @@ Mon_Irq_Handler:
msr CPSR_c, #MODE_SYS | I_BIT | F_BIT msr CPSR_c, #MODE_SYS | I_BIT | F_BIT
stmfd sp!, {r0, r1} // Push R0=SPSR, R1=LR_IRQ. stmfd sp!, {r0, r1} // Push R0=SPSR, R1=LR_IRQ.
/* bl chSchDoNTReschedule */ /* Save the s_ctx e recover the ns_ctx */
// Re-establish the original conditions // Re-establish the original conditions
ldmfd sp!, {r0, r1} // Pop R0=SPSR, R1=LR_IRQ. ldmfd sp!, {r0, r1} // Pop R0=SPSR, R1=LR_IRQ.
@ -171,8 +171,9 @@ Mon_Irq_Handler:
* *
*/ */
Mon_Fiq_Handler: Mon_Fiq_Handler:
// Here the fiq is taken from non-secure state // Here the fiq is taken from non-secure state, via the FIQ vector
// current mode is monitor (so current state is secure). // that is in the mon vector table.
// Current mode is monitor (so current state is secure).
// Note also that we never leave secure state while sec FIQ was disabled, // Note also that we never leave secure state while sec FIQ was disabled,
// then it's always safe to process the FIQ here. // then it's always safe to process the FIQ here.
stmfd sp!, {lr} // save lr into monitor stack stmfd sp!, {lr} // save lr into monitor stack
@ -278,8 +279,7 @@ _fiq_ret_arm:
/* /*
* Threads trampoline code. * Threads trampoline code.
* NOTE: The threads always start in ARM mode and then switches to the * NOTE: The threads always start in ARM mode.
* thread-function mode.
*/ */
.balign 16 .balign 16
.code 32 .code 32
@ -288,6 +288,7 @@ _port_thread_start:
#if CH_DBG_SYSTEM_STATE_CHECK #if CH_DBG_SYSTEM_STATE_CHECK
bl _dbg_check_unlock bl _dbg_check_unlock
#endif #endif
msr CPSR_c, #MODE_SYS | I_BIT
mov r0, r5 mov r0, r5
mov lr, pc mov lr, pc
bx r4 bx r4