arch/arm: align arm vector related code with armv7-a
commit 3c30c8b90b
Author: Xiang Xiao <xiaoxiang@xiaomi.com>
Date: Tue Apr 6 15:47:27 2021 +0800
arch/arm: Remove g_irqtmp, g_undeftmp and g_aborttmp
to avoid multiple CPU access them concurrently in SMP case
Signed-off-by: Xiang Xiao <xiaoxiang@xiaomi.com>
This commit is contained in:
parent
0779f34390
commit
eeb8931c04
@ -89,9 +89,7 @@ arm_fullcontextrestore:
|
|||||||
ldr r1, [r0, #(4*REG_CPSR)] /* Fetch the stored CPSR value */
|
ldr r1, [r0, #(4*REG_CPSR)] /* Fetch the stored CPSR value */
|
||||||
msr cpsr, r1 /* Set the CPSR */
|
msr cpsr, r1 /* Set the CPSR */
|
||||||
|
|
||||||
/* Now recover r0 and r1. Then return to the address at the stop of
|
/* Now recover r0-r1 and pc, destroying the stack frame */
|
||||||
* the stack, destroying the stack frame
|
|
||||||
*/
|
|
||||||
|
|
||||||
ldmia sp!, {r0-r1, r15}
|
ldmia sp!, {r0-r1, r15}
|
||||||
|
|
||||||
|
@ -92,9 +92,9 @@ arm_saveusercontext:
|
|||||||
add r1, r0, #(4*REG_PC)
|
add r1, r0, #(4*REG_PC)
|
||||||
str lr, [r1]
|
str lr, [r1]
|
||||||
|
|
||||||
/* Return 0 */
|
/* Return 0 now indicating that this return is not a context switch */
|
||||||
|
|
||||||
mov r0, #0 /* Return value == 0 */
|
mov r0, #0 /* Return value == 0 */
|
||||||
mov pc, lr /* Return */
|
bx lr /* Return */
|
||||||
.size arm_saveusercontext, .-arm_saveusercontext
|
.size arm_saveusercontext, .-arm_saveusercontext
|
||||||
.end
|
.end
|
||||||
|
@ -37,19 +37,6 @@
|
|||||||
* Private Data
|
* Private Data
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
.data
|
|
||||||
g_irqtmp:
|
|
||||||
.word 0 /* Saved lr */
|
|
||||||
.word 0 /* Saved spsr */
|
|
||||||
|
|
||||||
g_undeftmp:
|
|
||||||
.word 0 /* Saved lr */
|
|
||||||
.word 0 /* Saved spsr */
|
|
||||||
|
|
||||||
g_aborttmp:
|
|
||||||
.word 0 /* Saved lr */
|
|
||||||
.word 0 /* Saved spsr */
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Assembly Macros
|
* Assembly Macros
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
@ -81,17 +68,8 @@ arm_vectorirq:
|
|||||||
* and r14.
|
* and r14.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
ldr r13, .Lirqtmp
|
mov r13, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
sub lr, lr, #4
|
msr cpsr_c, r13 /* Switch to SVC mode */
|
||||||
str lr, [r13] /* Save lr_IRQ */
|
|
||||||
mrs lr, spsr
|
|
||||||
str lr, [r13, #4] /* Save spsr_IRQ */
|
|
||||||
|
|
||||||
/* Then switch back to SVC mode */
|
|
||||||
|
|
||||||
bic lr, lr, #PSR_MODE_MASK /* Keep F and T bits */
|
|
||||||
orr lr, lr, #(PSR_MODE_SVC | PSR_I_BIT)
|
|
||||||
msr cpsr_c, lr /* Switch to SVC mode */
|
|
||||||
|
|
||||||
/* Create a context structure. First set aside a stack frame
|
/* Create a context structure. First set aside a stack frame
|
||||||
* and store r0-r12 into the frame.
|
* and store r0-r12 into the frame.
|
||||||
@ -100,15 +78,25 @@ arm_vectorirq:
|
|||||||
sub sp, sp, #XCPTCONTEXT_SIZE
|
sub sp, sp, #XCPTCONTEXT_SIZE
|
||||||
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
||||||
|
|
||||||
/* Get the correct values of r13(sp) and r14(lr) in r1 and r2 */
|
mov r0, #(PSR_MODE_IRQ | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0 /* Switch back IRQ mode */
|
||||||
|
|
||||||
|
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
||||||
|
|
||||||
|
sub r3, lr, #4
|
||||||
|
mrs r4, spsr
|
||||||
|
|
||||||
|
/* Then switch back to SVC mode */
|
||||||
|
|
||||||
|
orr r0, r0, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0
|
||||||
|
|
||||||
|
/* Get the correct values of SVC r13(sp) and r14(lr) in r1 and r2 */
|
||||||
|
|
||||||
add r1, sp, #XCPTCONTEXT_SIZE
|
add r1, sp, #XCPTCONTEXT_SIZE
|
||||||
mov r2, r14
|
mov r2, r14
|
||||||
|
|
||||||
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
/* Save r13(sp), r14(lr), r15(pc), and the CPSR */
|
||||||
|
|
||||||
ldr r0, .Lirqtmp /* Points to temp storage */
|
|
||||||
ldmia r0, {r3, r4} /* Recover r3=lr_IRQ, r4=spsr_IRQ */
|
|
||||||
|
|
||||||
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
||||||
stmia r0, {r1-r4}
|
stmia r0, {r1-r4}
|
||||||
@ -119,44 +107,45 @@ arm_vectorirq:
|
|||||||
mov r0, sp /* Get r0=xcp */
|
mov r0, sp /* Get r0=xcp */
|
||||||
|
|
||||||
#if CONFIG_ARCH_INTERRUPTSTACK > 3
|
#if CONFIG_ARCH_INTERRUPTSTACK > 3
|
||||||
|
/* Call arm_decodeirq() on the interrupt stack */
|
||||||
|
|
||||||
ldr sp, .Lirqstackbase /* SP = interrupt stack base */
|
ldr sp, .Lirqstackbase /* SP = interrupt stack base */
|
||||||
str r0, [sp, #-4]! /* Save the xcp address at SP-4 then update SP */
|
str r0, [sp, #-4]! /* Save the xcp address at SP-4 then update SP */
|
||||||
bl arm_decodeirq /* Call the handler */
|
bl arm_decodeirq /* Call the handler */
|
||||||
ldr sp, [sp] /* Restore the user stack pointer */
|
ldr sp, [sp] /* Restore the user stack pointer */
|
||||||
#else
|
#else
|
||||||
|
/* Call arm_decodeirq() on the user stack */
|
||||||
|
|
||||||
bl arm_decodeirq /* Call the handler */
|
bl arm_decodeirq /* Call the handler */
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* Restore the CPSR, SVC mode registers and return */
|
/* Restore the CPSR, SVC mode registers and return */
|
||||||
.Lnoirqset:
|
|
||||||
ldr r0, [sp, #(4*REG_CPSR)] /* Setup the SVC mode SPSR */
|
|
||||||
msr spsr, r0
|
|
||||||
ldmia sp, {r0-r15}^ /* Return */
|
|
||||||
|
|
||||||
.Lirqtmp:
|
ldr r0, [sp, #(4*REG_CPSR)] /* Fetch the return SPSR */
|
||||||
.word g_irqtmp
|
msr spsr, r0 /* Set the return mode SPSR */
|
||||||
|
ldmia sp, {r0-r15}^ /* Return */
|
||||||
|
|
||||||
#if CONFIG_ARCH_INTERRUPTSTACK > 3
|
#if CONFIG_ARCH_INTERRUPTSTACK > 3
|
||||||
.Lirqstackbase:
|
.Lirqstackbase:
|
||||||
.word g_intstackbase
|
.word g_intstackbase
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
.size arm_vectorirq, . - arm_vectorirq
|
.size arm_vectorirq, . - arm_vectorirq
|
||||||
|
|
||||||
.align 5
|
.align 5
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Function: arm_vectorswi
|
* Function: arm_vectorsvc
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
* SWI interrupt. We enter the SWI in SVC mode.
|
* SVC interrupt. We enter the SVC in SVC mode.
|
||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
.globl arm_syscall
|
.globl arm_syscall
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.type arm_vectorswi, %function
|
.type arm_vectorsvc, %function
|
||||||
|
|
||||||
arm_vectorswi:
|
arm_vectorsvc:
|
||||||
|
|
||||||
/* Create a context structure. First set aside a stack frame
|
/* Create a context structure. First set aside a stack frame
|
||||||
* and store r0-r12 into the frame.
|
* and store r0-r12 into the frame.
|
||||||
@ -165,18 +154,22 @@ arm_vectorswi:
|
|||||||
sub sp, sp, #XCPTCONTEXT_SIZE
|
sub sp, sp, #XCPTCONTEXT_SIZE
|
||||||
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
||||||
|
|
||||||
/* Get the correct values of r13(sp), r14(lr), r15(pc)
|
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
||||||
* and CPSR in r1-r4 */
|
|
||||||
|
|
||||||
add r1, sp, #XCPTCONTEXT_SIZE
|
|
||||||
mov r2, r14 /* R14 is altered on return from SWI */
|
|
||||||
mov r3, r14 /* Save r14 as the PC as well */
|
mov r3, r14 /* Save r14 as the PC as well */
|
||||||
mrs r4, spsr /* Get the saved CPSR */
|
mrs r4, spsr /* Get the saved CPSR */
|
||||||
|
|
||||||
|
/* Get the correct values of SVC r13(sp) and r14(lr) in r1 and r2 */
|
||||||
|
|
||||||
|
add r1, sp, #XCPTCONTEXT_SIZE
|
||||||
|
mov r2, r14
|
||||||
|
|
||||||
|
/* Save r13(sp), r14(lr), r15(pc), and the CPSR */
|
||||||
|
|
||||||
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
||||||
stmia r0, {r1-r4}
|
stmia r0, {r1-r4}
|
||||||
|
|
||||||
/* Then call the SWI handler with interrupts disabled.
|
/* Then call the SVC handler with interrupts disabled.
|
||||||
* void arm_syscall(struct xcptcontext *xcp)
|
* void arm_syscall(struct xcptcontext *xcp)
|
||||||
*/
|
*/
|
||||||
|
|
||||||
@ -186,10 +179,10 @@ arm_vectorswi:
|
|||||||
|
|
||||||
/* Restore the CPSR, SVC mode registers and return */
|
/* Restore the CPSR, SVC mode registers and return */
|
||||||
|
|
||||||
ldr r0, [sp, #(4*REG_CPSR)] /* Setup the SVC mode SPSR */
|
ldr r0, [sp, #(4*REG_CPSR)] /* Fetch the return SPSR */
|
||||||
msr spsr, r0
|
msr spsr, r0 /* Set the return mode SPSR */
|
||||||
ldmia sp, {r0-r15}^ /* Return */
|
ldmia sp, {r0-r15}^ /* Return */
|
||||||
.size arm_vectorswi, . - arm_vectorswi
|
.size arm_vectorsvc, . - arm_vectorsvc
|
||||||
|
|
||||||
.align 5
|
.align 5
|
||||||
|
|
||||||
@ -213,17 +206,8 @@ arm_vectordata:
|
|||||||
* r13 and r14
|
* r13 and r14
|
||||||
*/
|
*/
|
||||||
|
|
||||||
ldr r13, .Ldaborttmp /* Points to temp storage */
|
mov r13, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
sub lr, lr, #8 /* Fixup return */
|
msr cpsr_c, r13 /* Switch to SVC mode */
|
||||||
str lr, [r13] /* Save in temp storage */
|
|
||||||
mrs lr, spsr /* Get SPSR */
|
|
||||||
str lr, [r13, #4] /* Save in temp storage */
|
|
||||||
|
|
||||||
/* Then switch back to SVC mode */
|
|
||||||
|
|
||||||
bic lr, lr, #PSR_MODE_MASK /* Keep F and T bits */
|
|
||||||
orr lr, lr, #(PSR_MODE_SVC | PSR_I_BIT)
|
|
||||||
msr cpsr_c, lr /* Switch to SVC mode */
|
|
||||||
|
|
||||||
/* Create a context structure. First set aside a stack frame
|
/* Create a context structure. First set aside a stack frame
|
||||||
* and store r0-r12 into the frame.
|
* and store r0-r12 into the frame.
|
||||||
@ -232,15 +216,25 @@ arm_vectordata:
|
|||||||
sub sp, sp, #XCPTCONTEXT_SIZE
|
sub sp, sp, #XCPTCONTEXT_SIZE
|
||||||
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
||||||
|
|
||||||
/* Get the correct values of r13(sp) and r14(lr) in r1 and r2 */
|
mov r0, #(PSR_MODE_ABT | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0 /* Switch back ABT mode */
|
||||||
|
|
||||||
|
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
||||||
|
|
||||||
|
sub r3, lr, #8
|
||||||
|
mrs r4, spsr
|
||||||
|
|
||||||
|
/* Then switch back to SVC mode */
|
||||||
|
|
||||||
|
mov r0, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0
|
||||||
|
|
||||||
|
/* Get the correct values of SVC r13(sp) and r14(lr) in r1 and r2 */
|
||||||
|
|
||||||
add r1, sp, #XCPTCONTEXT_SIZE
|
add r1, sp, #XCPTCONTEXT_SIZE
|
||||||
mov r2, r14
|
mov r2, r14
|
||||||
|
|
||||||
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
/* Save r13(sp), r14(lr), r15(pc), and the CPSR */
|
||||||
|
|
||||||
ldr r0, .Ldaborttmp /* Points to temp storage */
|
|
||||||
ldmia r0, {r3, r4} /* Recover r3=lr_IRQ, r4=spsr_IRQ */
|
|
||||||
|
|
||||||
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
||||||
stmia r0, {r1-r4}
|
stmia r0, {r1-r4}
|
||||||
@ -252,19 +246,16 @@ arm_vectordata:
|
|||||||
mov fp, #0 /* Init frame pointer */
|
mov fp, #0 /* Init frame pointer */
|
||||||
mov r0, sp /* Get r0=xcp */
|
mov r0, sp /* Get r0=xcp */
|
||||||
#ifdef CONFIG_PAGING
|
#ifdef CONFIG_PAGING
|
||||||
mrc p15, 0, r2, c5, c0, 0 /* Get r2=FSR */
|
|
||||||
mrc p15, 0, r1, c6, c0, 0 /* Get R1=FAR */
|
mrc p15, 0, r1, c6, c0, 0 /* Get R1=FAR */
|
||||||
|
mrc p15, 0, r2, c5, c0, 0 /* Get r2=FSR */
|
||||||
#endif
|
#endif
|
||||||
bl arm_dataabort /* Call the handler */
|
bl arm_dataabort /* Call the handler */
|
||||||
|
|
||||||
/* Restore the CPSR, SVC mode registers and return */
|
/* Restore the CPSR, SVC mode registers and return */
|
||||||
|
|
||||||
ldr r0, [sp, #(4*REG_CPSR)] /* Setup the SVC mode SPSR */
|
ldr r0, [sp, #(4*REG_CPSR)] /* Fetch the return SPSR */
|
||||||
msr spsr, r0
|
msr spsr, r0 /* Set the return mode SPSR */
|
||||||
ldmia sp, {r0-r15}^ /* Return */
|
ldmia sp, {r0-r15}^ /* Return */
|
||||||
|
|
||||||
.Ldaborttmp:
|
|
||||||
.word g_aborttmp
|
|
||||||
.size arm_vectordata, . - arm_vectordata
|
.size arm_vectordata, . - arm_vectordata
|
||||||
|
|
||||||
.align 5
|
.align 5
|
||||||
@ -289,17 +280,8 @@ arm_vectorprefetch:
|
|||||||
* r13 and r14
|
* r13 and r14
|
||||||
*/
|
*/
|
||||||
|
|
||||||
ldr r13, .Lpaborttmp /* Points to temp storage */
|
mov r13, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
sub lr, lr, #4 /* Fixup return */
|
msr cpsr_c, r13 /* Switch to SVC mode */
|
||||||
str lr, [r13] /* Save in temp storage */
|
|
||||||
mrs lr, spsr /* Get SPSR */
|
|
||||||
str lr, [r13, #4] /* Save in temp storage */
|
|
||||||
|
|
||||||
/* Then switch back to SVC mode */
|
|
||||||
|
|
||||||
bic lr, lr, #PSR_MODE_MASK /* Keep F and T bits */
|
|
||||||
orr lr, lr, #(PSR_MODE_SVC | PSR_I_BIT)
|
|
||||||
msr cpsr_c, lr /* Switch to SVC mode */
|
|
||||||
|
|
||||||
/* Create a context structure. First set aside a stack frame
|
/* Create a context structure. First set aside a stack frame
|
||||||
* and store r0-r12 into the frame.
|
* and store r0-r12 into the frame.
|
||||||
@ -308,15 +290,25 @@ arm_vectorprefetch:
|
|||||||
sub sp, sp, #XCPTCONTEXT_SIZE
|
sub sp, sp, #XCPTCONTEXT_SIZE
|
||||||
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
||||||
|
|
||||||
/* Get the correct values of r13(sp) and r14(lr) in r1 and r2 */
|
mov r0, #(PSR_MODE_ABT | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0 /* Switch back ABT mode */
|
||||||
|
|
||||||
|
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
||||||
|
|
||||||
|
sub r3, lr, #4
|
||||||
|
mrs r4, spsr
|
||||||
|
|
||||||
|
/* Then switch back to SVC mode */
|
||||||
|
|
||||||
|
mov r0, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0
|
||||||
|
|
||||||
|
/* Get the correct values of SVC r13(sp) and r14(lr) in r1 and r2 */
|
||||||
|
|
||||||
add r1, sp, #XCPTCONTEXT_SIZE
|
add r1, sp, #XCPTCONTEXT_SIZE
|
||||||
mov r2, r14
|
mov r2, r14
|
||||||
|
|
||||||
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
/* Save r13(sp), r14(lr), r15(pc), and the CPSR */
|
||||||
|
|
||||||
ldr r0, .Lpaborttmp /* Points to temp storage */
|
|
||||||
ldmia r0, {r3, r4} /* Recover r3=lr_IRQ, r4=spsr_IRQ */
|
|
||||||
|
|
||||||
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
||||||
stmia r0, {r1-r4}
|
stmia r0, {r1-r4}
|
||||||
@ -331,12 +323,9 @@ arm_vectorprefetch:
|
|||||||
|
|
||||||
/* Restore the CPSR, SVC mode registers and return */
|
/* Restore the CPSR, SVC mode registers and return */
|
||||||
|
|
||||||
ldr r0, [sp, #(4*REG_CPSR)] /* Setup the SVC mode SPSR */
|
ldr r0, [sp, #(4*REG_CPSR)] /* Fetch the return SPSR */
|
||||||
msr spsr, r0
|
msr spsr, r0 /* Set the return mode SPSR */
|
||||||
ldmia sp, {r0-r15}^ /* Return */
|
ldmia sp, {r0-r15}^ /* Return */
|
||||||
|
|
||||||
.Lpaborttmp:
|
|
||||||
.word g_aborttmp
|
|
||||||
.size arm_vectorprefetch, . - arm_vectorprefetch
|
.size arm_vectorprefetch, . - arm_vectorprefetch
|
||||||
|
|
||||||
.align 5
|
.align 5
|
||||||
@ -359,16 +348,8 @@ arm_vectorundefinsn:
|
|||||||
* r13 and r14
|
* r13 and r14
|
||||||
*/
|
*/
|
||||||
|
|
||||||
ldr r13, .Lundeftmp /* Points to temp storage */
|
mov r13, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
str lr, [r13] /* Save in temp storage */
|
msr cpsr_c, r13 /* Switch to SVC mode */
|
||||||
mrs lr, spsr /* Get SPSR */
|
|
||||||
str lr, [r13, #4] /* Save in temp storage */
|
|
||||||
|
|
||||||
/* Then switch back to SVC mode */
|
|
||||||
|
|
||||||
bic lr, lr, #PSR_MODE_MASK /* Keep F and T bits */
|
|
||||||
orr lr, lr, #(PSR_MODE_SVC | PSR_I_BIT)
|
|
||||||
msr cpsr_c, lr /* Switch to SVC mode */
|
|
||||||
|
|
||||||
/* Create a context structure. First set aside a stack frame
|
/* Create a context structure. First set aside a stack frame
|
||||||
* and store r0-r12 into the frame.
|
* and store r0-r12 into the frame.
|
||||||
@ -377,15 +358,25 @@ arm_vectorundefinsn:
|
|||||||
sub sp, sp, #XCPTCONTEXT_SIZE
|
sub sp, sp, #XCPTCONTEXT_SIZE
|
||||||
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
stmia sp, {r0-r12} /* Save the SVC mode regs */
|
||||||
|
|
||||||
/* Get the correct values of r13(sp) and r14(lr) in r1 and r2 */
|
mov r0, #(PSR_MODE_UND | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0 /* Switch back UND mode */
|
||||||
|
|
||||||
|
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
||||||
|
|
||||||
|
mov r3, lr
|
||||||
|
mrs r4, spsr
|
||||||
|
|
||||||
|
/* Then switch back to SVC mode */
|
||||||
|
|
||||||
|
mov r0, #(PSR_MODE_SVC | PSR_I_BIT)
|
||||||
|
msr cpsr_c, r0
|
||||||
|
|
||||||
|
/* Get the correct values of SVC r13(sp) and r14(lr) in r1 and r2 */
|
||||||
|
|
||||||
add r1, sp, #XCPTCONTEXT_SIZE
|
add r1, sp, #XCPTCONTEXT_SIZE
|
||||||
mov r2, r14
|
mov r2, r14
|
||||||
|
|
||||||
/* Get the values for r15(pc) and CPSR in r3 and r4 */
|
/* Save r13(sp), r14(lr), r15(pc), and the CPSR */
|
||||||
|
|
||||||
ldr r0, .Lundeftmp /* Points to temp storage */
|
|
||||||
ldmia r0, {r3, r4} /* Recover r3=lr_IRQ, r4=spsr_IRQ */
|
|
||||||
|
|
||||||
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
add r0, sp, #(4*REG_SP) /* Offset to pc, cpsr storage */
|
||||||
stmia r0, {r1-r4}
|
stmia r0, {r1-r4}
|
||||||
@ -400,12 +391,9 @@ arm_vectorundefinsn:
|
|||||||
|
|
||||||
/* Restore the CPSR, SVC mode registers and return */
|
/* Restore the CPSR, SVC mode registers and return */
|
||||||
|
|
||||||
ldr r0, [sp, #(4*REG_CPSR)] /* Setup the SVC mode SPSR */
|
ldr r0, [sp, #(4*REG_CPSR)] /* Fetch the return SPSR */
|
||||||
msr spsr, r0
|
msr spsr, r0 /* Set the return mode SPSR */
|
||||||
ldmia sp, {r0-r15}^ /* Return */
|
ldmia sp, {r0-r15}^ /* Return */
|
||||||
|
|
||||||
.Lundeftmp:
|
|
||||||
.word g_undeftmp
|
|
||||||
.size arm_vectorundefinsn, . - arm_vectorundefinsn
|
.size arm_vectorundefinsn, . - arm_vectorundefinsn
|
||||||
|
|
||||||
.align 5
|
.align 5
|
||||||
@ -444,5 +432,6 @@ g_intstackbase:
|
|||||||
.skip 4
|
.skip 4
|
||||||
.size g_intstackbase, 4
|
.size g_intstackbase, 4
|
||||||
.size g_intstackalloc, (CONFIG_ARCH_INTERRUPTSTACK & ~3)
|
.size g_intstackalloc, (CONFIG_ARCH_INTERRUPTSTACK & ~3)
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
.end
|
.end
|
||||||
|
@ -55,7 +55,7 @@
|
|||||||
_vector_start:
|
_vector_start:
|
||||||
ldr pc, .Lresethandler /* 0x00: Reset */
|
ldr pc, .Lresethandler /* 0x00: Reset */
|
||||||
ldr pc, .Lundefinedhandler /* 0x04: Undefined instruction */
|
ldr pc, .Lundefinedhandler /* 0x04: Undefined instruction */
|
||||||
ldr pc, .Lswihandler /* 0x08: Software interrupt */
|
ldr pc, .Lsvchandler /* 0x08: Software interrupt */
|
||||||
ldr pc, .Lprefetchaborthandler /* 0x0c: Prefetch abort */
|
ldr pc, .Lprefetchaborthandler /* 0x0c: Prefetch abort */
|
||||||
ldr pc, .Ldataaborthandler /* 0x10: Data abort */
|
ldr pc, .Ldataaborthandler /* 0x10: Data abort */
|
||||||
ldr pc, .Laddrexcptnhandler /* 0x14: Address exception (reserved) */
|
ldr pc, .Laddrexcptnhandler /* 0x14: Address exception (reserved) */
|
||||||
@ -64,7 +64,7 @@ _vector_start:
|
|||||||
|
|
||||||
.globl __start
|
.globl __start
|
||||||
.globl arm_vectorundefinsn
|
.globl arm_vectorundefinsn
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.globl arm_vectorprefetch
|
.globl arm_vectorprefetch
|
||||||
.globl arm_vectordata
|
.globl arm_vectordata
|
||||||
.globl arm_vectoraddrexcptn
|
.globl arm_vectoraddrexcptn
|
||||||
@ -75,8 +75,8 @@ _vector_start:
|
|||||||
.long __start
|
.long __start
|
||||||
.Lundefinedhandler:
|
.Lundefinedhandler:
|
||||||
.long arm_vectorundefinsn
|
.long arm_vectorundefinsn
|
||||||
.Lswihandler:
|
.Lsvchandler:
|
||||||
.long arm_vectorswi
|
.long arm_vectorsvc
|
||||||
.Lprefetchaborthandler:
|
.Lprefetchaborthandler:
|
||||||
.long arm_vectorprefetch
|
.long arm_vectorprefetch
|
||||||
.Ldataaborthandler:
|
.Ldataaborthandler:
|
||||||
|
@ -70,7 +70,7 @@ static up_vector_t g_vectorinittab[] =
|
|||||||
{
|
{
|
||||||
(up_vector_t)NULL,
|
(up_vector_t)NULL,
|
||||||
arm_vectorundefinsn,
|
arm_vectorundefinsn,
|
||||||
arm_vectorswi,
|
arm_vectorsvc,
|
||||||
arm_vectorprefetch,
|
arm_vectorprefetch,
|
||||||
arm_vectordata,
|
arm_vectordata,
|
||||||
arm_vectoraddrexcptn,
|
arm_vectoraddrexcptn,
|
||||||
|
@ -168,15 +168,15 @@ arm_vectorirq:
|
|||||||
.align 5
|
.align 5
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Function: arm_vectorswi
|
* Function: arm_vectorsvc
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
* SWI interrupt. We enter the SWI in SVC mode
|
* SWI interrupt. We enter the SWI in SVC mode
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.type arm_vectorswi, %function
|
.type arm_vectorsvc, %function
|
||||||
arm_vectorswi:
|
arm_vectorsvc:
|
||||||
|
|
||||||
/* The c547x rrload bootloader intemediates all
|
/* The c547x rrload bootloader intemediates all
|
||||||
* interrupts. For the* case of the SWI, it mucked
|
* interrupts. For the* case of the SWI, it mucked
|
||||||
|
@ -393,7 +393,7 @@ void arm_undefinedinsn(uint32_t *regs);
|
|||||||
#endif /* CONFIG_ARCH_ARMV[6-8]M */
|
#endif /* CONFIG_ARCH_ARMV[6-8]M */
|
||||||
|
|
||||||
void arm_vectorundefinsn(void);
|
void arm_vectorundefinsn(void);
|
||||||
void arm_vectorswi(void);
|
void arm_vectorsvc(void);
|
||||||
void arm_vectorprefetch(void);
|
void arm_vectorprefetch(void);
|
||||||
void arm_vectordata(void);
|
void arm_vectordata(void);
|
||||||
void arm_vectoraddrexcptn(void);
|
void arm_vectoraddrexcptn(void);
|
||||||
|
@ -457,7 +457,7 @@ _vector_table:
|
|||||||
|
|
||||||
.globl __start
|
.globl __start
|
||||||
.globl arm_vectorundefinsn
|
.globl arm_vectorundefinsn
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.globl arm_vectorprefetch
|
.globl arm_vectorprefetch
|
||||||
.globl arm_vectordata
|
.globl arm_vectordata
|
||||||
.globl arm_vectorirq
|
.globl arm_vectorirq
|
||||||
@ -468,7 +468,7 @@ _vector_table:
|
|||||||
.Lundefinedhandler:
|
.Lundefinedhandler:
|
||||||
.long arm_vectorundefinsn
|
.long arm_vectorundefinsn
|
||||||
.Lswihandler:
|
.Lswihandler:
|
||||||
.long arm_vectorswi
|
.long arm_vectorsvc
|
||||||
.Lprefetchaborthandler:
|
.Lprefetchaborthandler:
|
||||||
.long arm_vectorprefetch
|
.long arm_vectorprefetch
|
||||||
.Ldataaborthandler:
|
.Ldataaborthandler:
|
||||||
|
@ -100,7 +100,7 @@ _vector_table:
|
|||||||
|
|
||||||
.globl __start
|
.globl __start
|
||||||
.globl arm_vectorundefinsn
|
.globl arm_vectorundefinsn
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.globl arm_vectorprefetch
|
.globl arm_vectorprefetch
|
||||||
.globl arm_vectordata
|
.globl arm_vectordata
|
||||||
.globl arm_vectorirq
|
.globl arm_vectorirq
|
||||||
@ -111,7 +111,7 @@ _vector_table:
|
|||||||
.Lundefinedhandler:
|
.Lundefinedhandler:
|
||||||
.long arm_vectorundefinsn
|
.long arm_vectorundefinsn
|
||||||
.Lswihandler:
|
.Lswihandler:
|
||||||
.long arm_vectorswi
|
.long arm_vectorsvc
|
||||||
.Lprefetchaborthandler:
|
.Lprefetchaborthandler:
|
||||||
.long arm_vectorprefetch
|
.long arm_vectorprefetch
|
||||||
.Ldataaborthandler:
|
.Ldataaborthandler:
|
||||||
|
@ -47,7 +47,7 @@
|
|||||||
_undef_instr:
|
_undef_instr:
|
||||||
b arm_vectorundefinsn
|
b arm_vectorundefinsn
|
||||||
_sw_interr:
|
_sw_interr:
|
||||||
b arm_vectorswi
|
b arm_vectorsvc
|
||||||
_prefetch_abort:
|
_prefetch_abort:
|
||||||
b arm_vectorprefetch
|
b arm_vectorprefetch
|
||||||
_data_abort:
|
_data_abort:
|
||||||
|
@ -421,7 +421,7 @@ _vector_table:
|
|||||||
|
|
||||||
.globl __start
|
.globl __start
|
||||||
.globl arm_vectorundefinsn
|
.globl arm_vectorundefinsn
|
||||||
.globl arm_vectorswi
|
.globl arm_vectorsvc
|
||||||
.globl arm_vectorprefetch
|
.globl arm_vectorprefetch
|
||||||
.globl arm_vectordata
|
.globl arm_vectordata
|
||||||
.globl arm_vectorirq
|
.globl arm_vectorirq
|
||||||
@ -432,7 +432,7 @@ _vector_table:
|
|||||||
.Lundefinedhandler:
|
.Lundefinedhandler:
|
||||||
.long arm_vectorundefinsn
|
.long arm_vectorundefinsn
|
||||||
.Lswihandler:
|
.Lswihandler:
|
||||||
.long arm_vectorswi
|
.long arm_vectorsvc
|
||||||
.Lprefetchaborthandler:
|
.Lprefetchaborthandler:
|
||||||
.long arm_vectorprefetch
|
.long arm_vectorprefetch
|
||||||
.Ldataaborthandler:
|
.Ldataaborthandler:
|
||||||
|
Loading…
Reference in New Issue
Block a user