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