mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-19 02:54:24 +00:00
Merge pull request #189 from achingupta/ag/tf-issues#153
Unmask SError interrupt and clear SCR_EL3.EA bit
This commit is contained in:
commit
a1d80440c4
10 changed files with 62 additions and 23 deletions
|
@ -37,17 +37,8 @@
|
|||
******************************************************************************/
|
||||
void bl1_arch_setup(void)
|
||||
{
|
||||
/*
|
||||
* Set the next EL to be AArch64, route external abort and SError
|
||||
* interrupts to EL3
|
||||
*/
|
||||
write_scr_el3(SCR_RES1_BITS | SCR_RW_BIT | SCR_EA_BIT);
|
||||
|
||||
/*
|
||||
* Enable SError and Debug exceptions
|
||||
*/
|
||||
enable_serror();
|
||||
enable_debug_exceptions();
|
||||
/* Set the next EL to be AArch64 */
|
||||
write_scr_el3(SCR_RES1_BITS | SCR_RW_BIT);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
|
|
|
@ -76,6 +76,14 @@ func bl1_entrypoint
|
|||
*/
|
||||
adr x0, bl1_exceptions
|
||||
msr vbar_el3, x0
|
||||
isb
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the SError interrupt now that the
|
||||
* exception vectors have been setup.
|
||||
* ---------------------------------------------
|
||||
*/
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* The initial state of the Architectural feature trap register
|
||||
|
|
|
@ -112,6 +112,9 @@ SErrorSPx:
|
|||
*/
|
||||
.align 7
|
||||
SynchronousExceptionA64:
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ------------------------------------------------
|
||||
* Only a single SMC exception from BL2 to ask
|
||||
* BL1 to pass EL3 control to BL31 is expected
|
||||
|
|
|
@ -53,6 +53,14 @@ func bl2_entrypoint
|
|||
*/
|
||||
adr x0, early_exceptions
|
||||
msr vbar_el1, x0
|
||||
isb
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the SError interrupt now that the
|
||||
* exception vectors have been setup.
|
||||
* ---------------------------------------------
|
||||
*/
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the instruction cache, stack pointer
|
||||
|
|
|
@ -42,18 +42,8 @@
|
|||
******************************************************************************/
|
||||
void bl31_arch_setup(void)
|
||||
{
|
||||
/*
|
||||
* Route external abort and SError interrupts to EL3
|
||||
* other SCR bits will be configured before exiting to a lower exception
|
||||
* level
|
||||
*/
|
||||
write_scr_el3(SCR_RES1_BITS | SCR_EA_BIT);
|
||||
|
||||
/*
|
||||
* Enable SError and Debug exceptions
|
||||
*/
|
||||
enable_serror();
|
||||
enable_debug_exceptions();
|
||||
/* Set the RES1 bits in the SCR_EL3 */
|
||||
write_scr_el3(SCR_RES1_BITS);
|
||||
|
||||
/* Program the counter frequency */
|
||||
write_cntfrq_el0(plat_get_syscnt_freq());
|
||||
|
|
|
@ -98,6 +98,14 @@ func bl31_entrypoint
|
|||
*/
|
||||
adr x1, runtime_exceptions
|
||||
msr vbar_el3, x1
|
||||
isb
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the SError interrupt now that the
|
||||
* exception vectors have been setup.
|
||||
* ---------------------------------------------
|
||||
*/
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* The initial state of the Architectural feature trap register
|
||||
|
|
|
@ -44,6 +44,9 @@
|
|||
* -----------------------------------------------------
|
||||
*/
|
||||
.macro handle_sync_exception
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
str x30, [sp, #CTX_GPREGS_OFFSET + CTX_GPREG_LR]
|
||||
mrs x30, esr_el3
|
||||
ubfx x30, x30, #ESR_EC_SHIFT, #ESR_EC_LENGTH
|
||||
|
@ -70,6 +73,9 @@
|
|||
* -----------------------------------------------------
|
||||
*/
|
||||
.macro handle_interrupt_exception label
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
str x30, [sp, #CTX_GPREGS_OFFSET + CTX_GPREG_LR]
|
||||
bl save_gp_registers
|
||||
|
||||
|
|
|
@ -78,6 +78,14 @@ func tsp_entrypoint
|
|||
*/
|
||||
adr x0, tsp_exceptions
|
||||
msr vbar_el1, x0
|
||||
isb
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the SError interrupt now that the
|
||||
* exception vectors have been setup.
|
||||
* ---------------------------------------------
|
||||
*/
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the instruction cache, stack pointer
|
||||
|
@ -187,6 +195,10 @@ func tsp_cpu_on_entry
|
|||
*/
|
||||
adr x0, tsp_exceptions
|
||||
msr vbar_el1, x0
|
||||
isb
|
||||
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the instruction cache, stack pointer
|
||||
|
|
|
@ -120,6 +120,9 @@ sync_exception_sp_elx:
|
|||
|
||||
.align 7
|
||||
irq_sp_elx:
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
save_caller_regs_and_lr
|
||||
/* We just update some statistics in the handler */
|
||||
bl tsp_irq_received
|
||||
|
@ -132,6 +135,9 @@ irq_sp_elx:
|
|||
|
||||
.align 7
|
||||
fiq_sp_elx:
|
||||
/* Enable the SError interrupt */
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
save_caller_regs_and_lr
|
||||
bl tsp_fiq_handler
|
||||
cbz x0, fiq_sp_elx_done
|
||||
|
|
|
@ -87,6 +87,13 @@ psci_aff_common_finish_entry:
|
|||
msr vbar_el3, x0
|
||||
isb
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Enable the SError interrupt now that the
|
||||
* exception vectors have been setup.
|
||||
* ---------------------------------------------
|
||||
*/
|
||||
msr daifclr, #DAIF_ABT_BIT
|
||||
|
||||
/* ---------------------------------------------
|
||||
* Use SP_EL0 for the C runtime stack.
|
||||
* ---------------------------------------------
|
||||
|
|
Loading…
Add table
Reference in a new issue