1b1d27b48SRoberto Vargas/* 2dcbfa11bSAntonio Nino Diaz * Copyright (c) 2017-2019, ARM Limited and Contributors. All rights reserved. 3b1d27b48SRoberto Vargas * 4b1d27b48SRoberto Vargas * SPDX-License-Identifier: BSD-3-Clause 5b1d27b48SRoberto Vargas */ 6b1d27b48SRoberto Vargas 7b1d27b48SRoberto Vargas#include <arch.h> 8b1d27b48SRoberto Vargas#include <asm_macros.S> 909d40e0eSAntonio Nino Diaz#include <common/bl_common.h> 10b1d27b48SRoberto Vargas#include <el3_common_macros.S> 11b1d27b48SRoberto Vargas 12b1d27b48SRoberto Vargas .globl bl2_entrypoint 13b1d27b48SRoberto Vargas .globl bl2_el3_run_image 14b1d27b48SRoberto Vargas .globl bl2_run_next_image 15b1d27b48SRoberto Vargas 16b1d27b48SRoberto Vargasfunc bl2_entrypoint 17b1d27b48SRoberto Vargas /* Save arguments x0-x3 from previous Boot loader */ 18b1d27b48SRoberto Vargas mov x20, x0 19b1d27b48SRoberto Vargas mov x21, x1 20b1d27b48SRoberto Vargas mov x22, x2 21b1d27b48SRoberto Vargas mov x23, x3 22b1d27b48SRoberto Vargas 23b1d27b48SRoberto Vargas el3_entrypoint_common \ 24b1d27b48SRoberto Vargas _init_sctlr=1 \ 25b1d27b48SRoberto Vargas _warm_boot_mailbox=!PROGRAMMABLE_RESET_ADDRESS \ 26b1d27b48SRoberto Vargas _secondary_cold_boot=!COLD_BOOT_SINGLE_CPU \ 27b1d27b48SRoberto Vargas _init_memory=1 \ 28b1d27b48SRoberto Vargas _init_c_runtime=1 \ 29b1d27b48SRoberto Vargas _exception_vectors=bl2_el3_exceptions 30b1d27b48SRoberto Vargas 31dcbfa11bSAntonio Nino Diaz /* --------------------------------------------- 32b1d27b48SRoberto Vargas * Restore parameters of boot rom 33dcbfa11bSAntonio Nino Diaz * --------------------------------------------- 34b1d27b48SRoberto Vargas */ 35b1d27b48SRoberto Vargas mov x0, x20 36b1d27b48SRoberto Vargas mov x1, x21 37b1d27b48SRoberto Vargas mov x2, x22 38b1d27b48SRoberto Vargas mov x3, x23 39b1d27b48SRoberto Vargas 40dcbfa11bSAntonio Nino Diaz /* --------------------------------------------- 41dcbfa11bSAntonio Nino Diaz * Perform BL2 setup 42dcbfa11bSAntonio Nino Diaz * --------------------------------------------- 43dcbfa11bSAntonio Nino Diaz */ 44dcbfa11bSAntonio Nino Diaz bl bl2_el3_setup 45dcbfa11bSAntonio Nino Diaz 46dcbfa11bSAntonio Nino Diaz /* --------------------------------------------- 47dcbfa11bSAntonio Nino Diaz * Enable pointer authentication 48dcbfa11bSAntonio Nino Diaz * --------------------------------------------- 49dcbfa11bSAntonio Nino Diaz */ 50dcbfa11bSAntonio Nino Diaz#if ENABLE_PAUTH 51dcbfa11bSAntonio Nino Diaz mrs x0, sctlr_el3 52dcbfa11bSAntonio Nino Diaz orr x0, x0, #SCTLR_EnIA_BIT 53*9fc59639SAlexei Fedorov#if ENABLE_BTI 54*9fc59639SAlexei Fedorov /* --------------------------------------------- 55*9fc59639SAlexei Fedorov * Enable PAC branch type compatibility 56*9fc59639SAlexei Fedorov * --------------------------------------------- 57*9fc59639SAlexei Fedorov */ 58*9fc59639SAlexei Fedorov bic x0, x0, #SCTLR_BT_BIT 59*9fc59639SAlexei Fedorov#endif /* ENABLE_BTI */ 60dcbfa11bSAntonio Nino Diaz msr sctlr_el3, x0 61dcbfa11bSAntonio Nino Diaz isb 62dcbfa11bSAntonio Nino Diaz#endif /* ENABLE_PAUTH */ 63b1d27b48SRoberto Vargas 64b1d27b48SRoberto Vargas /* --------------------------------------------- 65b1d27b48SRoberto Vargas * Jump to main function. 66b1d27b48SRoberto Vargas * --------------------------------------------- 67b1d27b48SRoberto Vargas */ 68b1d27b48SRoberto Vargas bl bl2_main 69b1d27b48SRoberto Vargas 70b1d27b48SRoberto Vargas /* --------------------------------------------- 71b1d27b48SRoberto Vargas * Should never reach this point. 72b1d27b48SRoberto Vargas * --------------------------------------------- 73b1d27b48SRoberto Vargas */ 74b1d27b48SRoberto Vargas no_ret plat_panic_handler 75b1d27b48SRoberto Vargasendfunc bl2_entrypoint 76b1d27b48SRoberto Vargas 77b1d27b48SRoberto Vargasfunc bl2_run_next_image 78b1d27b48SRoberto Vargas mov x20,x0 79dcbfa11bSAntonio Nino Diaz /* --------------------------------------------- 80b1d27b48SRoberto Vargas * MMU needs to be disabled because both BL2 and BL31 execute 81b1d27b48SRoberto Vargas * in EL3, and therefore share the same address space. 82b1d27b48SRoberto Vargas * BL31 will initialize the address space according to its 83b1d27b48SRoberto Vargas * own requirement. 84dcbfa11bSAntonio Nino Diaz * --------------------------------------------- 85b1d27b48SRoberto Vargas */ 86b1d27b48SRoberto Vargas bl disable_mmu_icache_el3 87b1d27b48SRoberto Vargas tlbi alle3 88b1d27b48SRoberto Vargas bl bl2_el3_plat_prepare_exit 89b1d27b48SRoberto Vargas 90dcbfa11bSAntonio Nino Diaz /* --------------------------------------------- 91dcbfa11bSAntonio Nino Diaz * Disable pointer authentication before jumping to BL31 or that will 92dcbfa11bSAntonio Nino Diaz * cause an authentication failure during the early platform init. 93dcbfa11bSAntonio Nino Diaz * --------------------------------------------- 94dcbfa11bSAntonio Nino Diaz */ 95dcbfa11bSAntonio Nino Diaz#if ENABLE_PAUTH 96dcbfa11bSAntonio Nino Diaz mrs x0, sctlr_el3 97dcbfa11bSAntonio Nino Diaz bic x0, x0, #SCTLR_EnIA_BIT 98dcbfa11bSAntonio Nino Diaz msr sctlr_el3, x0 99dcbfa11bSAntonio Nino Diaz isb 100dcbfa11bSAntonio Nino Diaz#endif /* ENABLE_PAUTH */ 101dcbfa11bSAntonio Nino Diaz 102b1d27b48SRoberto Vargas ldp x0, x1, [x20, #ENTRY_POINT_INFO_PC_OFFSET] 103b1d27b48SRoberto Vargas msr elr_el3, x0 104b1d27b48SRoberto Vargas msr spsr_el3, x1 105b1d27b48SRoberto Vargas 106b1d27b48SRoberto Vargas ldp x6, x7, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x30)] 107b1d27b48SRoberto Vargas ldp x4, x5, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x20)] 108b1d27b48SRoberto Vargas ldp x2, x3, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x10)] 109b1d27b48SRoberto Vargas ldp x0, x1, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x0)] 110b1d27b48SRoberto Vargas eret 111b1d27b48SRoberto Vargasendfunc bl2_run_next_image 112