mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-27 15:24:54 +00:00
Fix exception in save/restore of EL2 registers.
Removing FPEXC32_EL2 from the register save/restore routine for EL2 registers since it is already a part of save/restore routine for fpregs. Signed-off-by: Max Shvetsov <maksims.svecovs@arm.com> Change-Id: I5ed45fdbf7c8efa8dcfcd96586328d4f6b256bc4
This commit is contained in:
Max Shvetsov
parent
4108abb4a0
commit
30ee3755d0
2 changed files with 124 additions and 129 deletions
|
|
@ -168,76 +168,75 @@
|
|||
#define CTX_ELR_EL2 U(0x58)
|
||||
#define CTX_ESR_EL2 U(0x60)
|
||||
#define CTX_FAR_EL2 U(0x68)
|
||||
#define CTX_FPEXC32_EL2 U(0x70)
|
||||
#define CTX_HACR_EL2 U(0x78)
|
||||
#define CTX_HCR_EL2 U(0x80)
|
||||
#define CTX_HPFAR_EL2 U(0x88)
|
||||
#define CTX_HSTR_EL2 U(0x90)
|
||||
#define CTX_ICC_SRE_EL2 U(0x98)
|
||||
#define CTX_ICH_HCR_EL2 U(0xa0)
|
||||
#define CTX_ICH_VMCR_EL2 U(0xa8)
|
||||
#define CTX_MAIR_EL2 U(0xb0)
|
||||
#define CTX_MDCR_EL2 U(0xb8)
|
||||
#define CTX_PMSCR_EL2 U(0xc0)
|
||||
#define CTX_SCTLR_EL2 U(0xc8)
|
||||
#define CTX_SPSR_EL2 U(0xd0)
|
||||
#define CTX_SP_EL2 U(0xd8)
|
||||
#define CTX_TCR_EL2 U(0xe0)
|
||||
#define CTX_TPIDR_EL2 U(0xe8)
|
||||
#define CTX_TTBR0_EL2 U(0xf0)
|
||||
#define CTX_VBAR_EL2 U(0xf8)
|
||||
#define CTX_VMPIDR_EL2 U(0x100)
|
||||
#define CTX_VPIDR_EL2 U(0x108)
|
||||
#define CTX_VTCR_EL2 U(0x110)
|
||||
#define CTX_VTTBR_EL2 U(0x118)
|
||||
#define CTX_HACR_EL2 U(0x70)
|
||||
#define CTX_HCR_EL2 U(0x78)
|
||||
#define CTX_HPFAR_EL2 U(0x80)
|
||||
#define CTX_HSTR_EL2 U(0x88)
|
||||
#define CTX_ICC_SRE_EL2 U(0x90)
|
||||
#define CTX_ICH_HCR_EL2 U(0x98)
|
||||
#define CTX_ICH_VMCR_EL2 U(0xa0)
|
||||
#define CTX_MAIR_EL2 U(0xa8)
|
||||
#define CTX_MDCR_EL2 U(0xb0)
|
||||
#define CTX_PMSCR_EL2 U(0xb8)
|
||||
#define CTX_SCTLR_EL2 U(0xc0)
|
||||
#define CTX_SPSR_EL2 U(0xc8)
|
||||
#define CTX_SP_EL2 U(0xd0)
|
||||
#define CTX_TCR_EL2 U(0xd8)
|
||||
#define CTX_TPIDR_EL2 U(0xe0)
|
||||
#define CTX_TTBR0_EL2 U(0xe8)
|
||||
#define CTX_VBAR_EL2 U(0xf0)
|
||||
#define CTX_VMPIDR_EL2 U(0xf8)
|
||||
#define CTX_VPIDR_EL2 U(0x100)
|
||||
#define CTX_VTCR_EL2 U(0x108)
|
||||
#define CTX_VTTBR_EL2 U(0x110)
|
||||
|
||||
// Only if MTE registers in use
|
||||
#define CTX_TFSR_EL2 U(0x120)
|
||||
#define CTX_TFSR_EL2 U(0x118)
|
||||
|
||||
// Only if ENABLE_MPAM_FOR_LOWER_ELS==1
|
||||
#define CTX_MPAM2_EL2 U(0x128)
|
||||
#define CTX_MPAMHCR_EL2 U(0x130)
|
||||
#define CTX_MPAMVPM0_EL2 U(0x138)
|
||||
#define CTX_MPAMVPM1_EL2 U(0x140)
|
||||
#define CTX_MPAMVPM2_EL2 U(0x148)
|
||||
#define CTX_MPAMVPM3_EL2 U(0x150)
|
||||
#define CTX_MPAMVPM4_EL2 U(0x158)
|
||||
#define CTX_MPAMVPM5_EL2 U(0x160)
|
||||
#define CTX_MPAMVPM6_EL2 U(0x168)
|
||||
#define CTX_MPAMVPM7_EL2 U(0x170)
|
||||
#define CTX_MPAMVPMV_EL2 U(0x178)
|
||||
#define CTX_MPAM2_EL2 U(0x120)
|
||||
#define CTX_MPAMHCR_EL2 U(0x128)
|
||||
#define CTX_MPAMVPM0_EL2 U(0x130)
|
||||
#define CTX_MPAMVPM1_EL2 U(0x138)
|
||||
#define CTX_MPAMVPM2_EL2 U(0x140)
|
||||
#define CTX_MPAMVPM3_EL2 U(0x148)
|
||||
#define CTX_MPAMVPM4_EL2 U(0x150)
|
||||
#define CTX_MPAMVPM5_EL2 U(0x158)
|
||||
#define CTX_MPAMVPM6_EL2 U(0x160)
|
||||
#define CTX_MPAMVPM7_EL2 U(0x168)
|
||||
#define CTX_MPAMVPMV_EL2 U(0x170)
|
||||
|
||||
// Starting with Armv8.6
|
||||
#define CTX_HAFGRTR_EL2 U(0x180)
|
||||
#define CTX_HDFGRTR_EL2 U(0x188)
|
||||
#define CTX_HDFGWTR_EL2 U(0x190)
|
||||
#define CTX_HFGITR_EL2 U(0x198)
|
||||
#define CTX_HFGRTR_EL2 U(0x1a0)
|
||||
#define CTX_HFGWTR_EL2 U(0x1a8)
|
||||
#define CTX_CNTPOFF_EL2 U(0x1b0)
|
||||
#define CTX_HAFGRTR_EL2 U(0x178)
|
||||
#define CTX_HDFGRTR_EL2 U(0x180)
|
||||
#define CTX_HDFGWTR_EL2 U(0x188)
|
||||
#define CTX_HFGITR_EL2 U(0x190)
|
||||
#define CTX_HFGRTR_EL2 U(0x198)
|
||||
#define CTX_HFGWTR_EL2 U(0x1a0)
|
||||
#define CTX_CNTPOFF_EL2 U(0x1a8)
|
||||
|
||||
// Starting with Armv8.4
|
||||
#define CTX_CNTHPS_CTL_EL2 U(0x1b8)
|
||||
#define CTX_CNTHPS_CVAL_EL2 U(0x1c0)
|
||||
#define CTX_CNTHPS_TVAL_EL2 U(0x1c8)
|
||||
#define CTX_CNTHVS_CTL_EL2 U(0x1d0)
|
||||
#define CTX_CNTHVS_CVAL_EL2 U(0x1d8)
|
||||
#define CTX_CNTHVS_TVAL_EL2 U(0x1e0)
|
||||
#define CTX_CNTHV_CTL_EL2 U(0x1e8)
|
||||
#define CTX_CNTHV_CVAL_EL2 U(0x1f0)
|
||||
#define CTX_CNTHV_TVAL_EL2 U(0x1f8)
|
||||
#define CTX_CONTEXTIDR_EL2 U(0x200)
|
||||
#define CTX_SDER32_EL2 U(0x208)
|
||||
#define CTX_TTBR1_EL2 U(0x210)
|
||||
#define CTX_VDISR_EL2 U(0x218)
|
||||
#define CTX_VNCR_EL2 U(0x220)
|
||||
#define CTX_VSESR_EL2 U(0x228)
|
||||
#define CTX_VSTCR_EL2 U(0x230)
|
||||
#define CTX_VSTTBR_EL2 U(0x238)
|
||||
#define CTX_TRFCR_EL2 U(0x240)
|
||||
#define CTX_CNTHPS_CTL_EL2 U(0x1b0)
|
||||
#define CTX_CNTHPS_CVAL_EL2 U(0x1b8)
|
||||
#define CTX_CNTHPS_TVAL_EL2 U(0x1c0)
|
||||
#define CTX_CNTHVS_CTL_EL2 U(0x1c8)
|
||||
#define CTX_CNTHVS_CVAL_EL2 U(0x1d0)
|
||||
#define CTX_CNTHVS_TVAL_EL2 U(0x1d8)
|
||||
#define CTX_CNTHV_CTL_EL2 U(0x1e0)
|
||||
#define CTX_CNTHV_CVAL_EL2 U(0x1e8)
|
||||
#define CTX_CNTHV_TVAL_EL2 U(0x1f0)
|
||||
#define CTX_CONTEXTIDR_EL2 U(0x1f8)
|
||||
#define CTX_SDER32_EL2 U(0x200)
|
||||
#define CTX_TTBR1_EL2 U(0x208)
|
||||
#define CTX_VDISR_EL2 U(0x210)
|
||||
#define CTX_VNCR_EL2 U(0x218)
|
||||
#define CTX_VSESR_EL2 U(0x220)
|
||||
#define CTX_VSTCR_EL2 U(0x228)
|
||||
#define CTX_VSTTBR_EL2 U(0x230)
|
||||
#define CTX_TRFCR_EL2 U(0x238)
|
||||
|
||||
// Starting with Armv8.5
|
||||
#define CTX_SCXTNUM_EL2 U(0x248)
|
||||
#define CTX_SCXTNUM_EL2 U(0x240)
|
||||
/* Align to the next 16 byte boundary */
|
||||
#define CTX_EL2_SYSREGS_END U(0x250)
|
||||
|
||||
|
|
|
|||
|
|
@ -71,53 +71,52 @@ func el2_sysregs_context_save
|
|||
mrs x15, far_el2
|
||||
stp x14, x15, [x0, #CTX_ESR_EL2]
|
||||
|
||||
mrs x16, fpexc32_el2
|
||||
mrs x17, hacr_el2
|
||||
stp x16, x17, [x0, #CTX_FPEXC32_EL2]
|
||||
mrs x16, hacr_el2
|
||||
mrs x17, hcr_el2
|
||||
stp x16, x17, [x0, #CTX_HACR_EL2]
|
||||
|
||||
mrs x9, hcr_el2
|
||||
mrs x10, hpfar_el2
|
||||
stp x9, x10, [x0, #CTX_HCR_EL2]
|
||||
mrs x9, hpfar_el2
|
||||
mrs x10, hstr_el2
|
||||
stp x9, x10, [x0, #CTX_HPFAR_EL2]
|
||||
|
||||
mrs x11, hstr_el2
|
||||
mrs x12, ICC_SRE_EL2
|
||||
stp x11, x12, [x0, #CTX_HSTR_EL2]
|
||||
mrs x11, ICC_SRE_EL2
|
||||
mrs x12, ICH_HCR_EL2
|
||||
stp x11, x12, [x0, #CTX_ICC_SRE_EL2]
|
||||
|
||||
mrs x13, ICH_HCR_EL2
|
||||
mrs x14, ICH_VMCR_EL2
|
||||
stp x13, x14, [x0, #CTX_ICH_HCR_EL2]
|
||||
mrs x13, ICH_VMCR_EL2
|
||||
mrs x14, mair_el2
|
||||
stp x13, x14, [x0, #CTX_ICH_VMCR_EL2]
|
||||
|
||||
mrs x15, mair_el2
|
||||
mrs x16, mdcr_el2
|
||||
stp x15, x16, [x0, #CTX_MAIR_EL2]
|
||||
mrs x15, mdcr_el2
|
||||
mrs x16, PMSCR_EL2
|
||||
stp x15, x16, [x0, #CTX_MDCR_EL2]
|
||||
|
||||
mrs x17, PMSCR_EL2
|
||||
mrs x9, sctlr_el2
|
||||
stp x17, x9, [x0, #CTX_PMSCR_EL2]
|
||||
mrs x17, sctlr_el2
|
||||
mrs x9, spsr_el2
|
||||
stp x17, x9, [x0, #CTX_SCTLR_EL2]
|
||||
|
||||
mrs x10, spsr_el2
|
||||
mrs x11, sp_el2
|
||||
stp x10, x11, [x0, #CTX_SPSR_EL2]
|
||||
mrs x10, sp_el2
|
||||
mrs x11, tcr_el2
|
||||
stp x10, x11, [x0, #CTX_SP_EL2]
|
||||
|
||||
mrs x12, tcr_el2
|
||||
mrs x13, tpidr_el2
|
||||
stp x12, x13, [x0, #CTX_TCR_EL2]
|
||||
mrs x12, tpidr_el2
|
||||
mrs x13, ttbr0_el2
|
||||
stp x12, x13, [x0, #CTX_TPIDR_EL2]
|
||||
|
||||
mrs x14, ttbr0_el2
|
||||
mrs x15, vbar_el2
|
||||
stp x14, x15, [x0, #CTX_TTBR0_EL2]
|
||||
mrs x14, vbar_el2
|
||||
mrs x15, vmpidr_el2
|
||||
stp x14, x15, [x0, #CTX_VBAR_EL2]
|
||||
|
||||
mrs x16, vmpidr_el2
|
||||
mrs x17, vpidr_el2
|
||||
stp x16, x17, [x0, #CTX_VMPIDR_EL2]
|
||||
mrs x16, vpidr_el2
|
||||
mrs x17, vtcr_el2
|
||||
stp x16, x17, [x0, #CTX_VPIDR_EL2]
|
||||
|
||||
mrs x9, vtcr_el2
|
||||
mrs x10, vttbr_el2
|
||||
stp x9, x10, [x0, #CTX_VTCR_EL2]
|
||||
mrs x9, vttbr_el2
|
||||
str x9, [x0, #CTX_VTTBR_EL2]
|
||||
|
||||
#if CTX_INCLUDE_MTE_REGS
|
||||
mrs x11, TFSR_EL2
|
||||
str x11, [x0, #CTX_TFSR_EL2]
|
||||
mrs x10, TFSR_EL2
|
||||
str x10, [x0, #CTX_TFSR_EL2]
|
||||
#endif
|
||||
|
||||
#if ENABLE_MPAM_FOR_LOWER_ELS
|
||||
|
|
@ -277,51 +276,48 @@ func el2_sysregs_context_restore
|
|||
msr esr_el2, x14
|
||||
msr far_el2, x15
|
||||
|
||||
ldp x16, x17, [x0, #CTX_FPEXC32_EL2]
|
||||
msr fpexc32_el2, x16
|
||||
msr hacr_el2, x17
|
||||
ldp x16, x17, [x0, #CTX_HACR_EL2]
|
||||
msr hacr_el2, x16
|
||||
msr hcr_el2, x17
|
||||
|
||||
ldp x9, x10, [x0, #CTX_HCR_EL2]
|
||||
msr hcr_el2, x9
|
||||
msr hpfar_el2, x10
|
||||
ldp x9, x10, [x0, #CTX_HPFAR_EL2]
|
||||
msr hpfar_el2, x9
|
||||
msr hstr_el2, x10
|
||||
|
||||
ldp x11, x12, [x0, #CTX_HSTR_EL2]
|
||||
msr hstr_el2, x11
|
||||
msr ICC_SRE_EL2, x12
|
||||
ldp x11, x12, [x0, #CTX_ICC_SRE_EL2]
|
||||
msr ICC_SRE_EL2, x11
|
||||
msr ICH_HCR_EL2, x12
|
||||
|
||||
ldp x13, x14, [x0, #CTX_ICH_HCR_EL2]
|
||||
msr ICH_HCR_EL2, x13
|
||||
msr ICH_VMCR_EL2, x14
|
||||
ldp x13, x14, [x0, #CTX_ICH_VMCR_EL2]
|
||||
msr ICH_VMCR_EL2, x13
|
||||
msr mair_el2, x14
|
||||
|
||||
ldp x15, x16, [x0, #CTX_MAIR_EL2]
|
||||
msr mair_el2, x15
|
||||
msr mdcr_el2, x16
|
||||
ldp x15, x16, [x0, #CTX_MDCR_EL2]
|
||||
msr mdcr_el2, x15
|
||||
msr PMSCR_EL2, x16
|
||||
|
||||
ldr x17, [x0, #CTX_PMSCR_EL2]
|
||||
msr PMSCR_EL2, x17
|
||||
ldp x17, x9, [x0, #CTX_SPSR_EL2]
|
||||
msr spsr_el2, x17
|
||||
msr sp_el2, x9
|
||||
|
||||
ldp x10, x11, [x0, #CTX_SPSR_EL2]
|
||||
msr spsr_el2, x10
|
||||
msr sp_el2, x11
|
||||
ldp x10, x11, [x0, #CTX_TPIDR_EL2]
|
||||
msr tpidr_el2, x10
|
||||
msr ttbr0_el2, x11
|
||||
|
||||
ldr x12, [x0, #CTX_TPIDR_EL2]
|
||||
msr tpidr_el2, x12
|
||||
ldp x12, x13, [x0, #CTX_VBAR_EL2]
|
||||
msr vbar_el2, x12
|
||||
msr vmpidr_el2, x13
|
||||
|
||||
ldp x14, x15, [x0, #CTX_TTBR0_EL2]
|
||||
msr ttbr0_el2, x14
|
||||
msr vbar_el2, x15
|
||||
ldp x14, x15, [x0, #CTX_VPIDR_EL2]
|
||||
msr vpidr_el2, x14
|
||||
msr vtcr_el2, x15
|
||||
|
||||
ldp x16, x17, [x0, #CTX_VMPIDR_EL2]
|
||||
msr vmpidr_el2, x16
|
||||
msr vpidr_el2, x17
|
||||
|
||||
ldp x9, x10, [x0, #CTX_VTCR_EL2]
|
||||
msr vtcr_el2, x9
|
||||
msr vttbr_el2, x10
|
||||
ldr x16, [x0, #CTX_VTTBR_EL2]
|
||||
msr vttbr_el2, x16
|
||||
|
||||
#if CTX_INCLUDE_MTE_REGS
|
||||
ldr x11, [x0, #CTX_TFSR_EL2]
|
||||
msr TFSR_EL2, x11
|
||||
ldr x17, [x0, #CTX_TFSR_EL2]
|
||||
msr TFSR_EL2, x17
|
||||
#endif
|
||||
|
||||
#if ENABLE_MPAM_FOR_LOWER_ELS
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue