9cd4328f5e
Avoid a call and use a jump instead, so that the LR value does not need to be recorded in a different register. This is generally neater, but it also avoids potential confusion in the debugger, given that no frame record is created for this call. Signed-off-by: Ard Biesheuvel <ardb@kernel.org>
39 lines
1.4 KiB
ArmAsm
39 lines
1.4 KiB
ArmAsm
#========================================================================================
|
|
# Copyright (c) 2011-2017, ARM Limited. All rights reserved.
|
|
#
|
|
# SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
#
|
|
#=======================================================================================
|
|
|
|
#include <AsmMacroLib.h>
|
|
#include <AArch64/AArch64.h>
|
|
|
|
.set HCR_EL2_E2H, 0x1 << 34
|
|
|
|
// Setup EL1 while in EL1
|
|
ASM_FUNC(SetupExceptionLevel1)
|
|
mov x0, #CPACR_DEFAULT
|
|
b ASM_PFX(ArmWriteCpacr) // Tail call
|
|
|
|
// Setup EL2 while in EL2
|
|
ASM_FUNC(SetupExceptionLevel2)
|
|
msr sctlr_el2, xzr
|
|
mrs x0, hcr_el2 // Read EL2 Hypervisor configuration Register
|
|
|
|
// Send all interrupts to their respective Exception levels for EL2
|
|
orr x0, x0, #(1 << 3) // Enable EL2 FIQ
|
|
orr x0, x0, #(1 << 4) // Enable EL2 IRQ
|
|
orr x0, x0, #(1 << 5) // Enable EL2 SError and Abort
|
|
msr hcr_el2, x0 // Write back our settings
|
|
|
|
// Check whether we have been entered with HCR_EL2.E2H set, which is
|
|
// permitted to be RES1. In this case, CPTR_EL2 looks like CPACR_EL1.
|
|
tst x0, #HCR_EL2_E2H
|
|
mov x0, #AARCH64_CPTR_DEFAULT
|
|
mov x1, #CPACR_DEFAULT
|
|
csel x0, x0, x1, eq
|
|
msr cptr_el2, x0 // Enable architectural features
|
|
ret
|
|
|
|
ASM_FUNCTION_REMOVE_IF_UNREFERENCED
|