xref: /rk3399_ARM-atf/bl2/aarch64/bl2_el3_entrypoint.S (revision f461fe346b728d0e88142fd7b8f2816415af18bc)
1b1d27b48SRoberto Vargas/*
2*f461fe34SAnthony Steinhauser * Copyright (c) 2017-2020, 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                               \
29da90359bSManish Pandey		_exception_vectors=bl2_el3_exceptions		\
30da90359bSManish Pandey		_pie_fixup_size=0
31b1d27b48SRoberto Vargas
32dcbfa11bSAntonio Nino Diaz	/* ---------------------------------------------
33b1d27b48SRoberto Vargas	 * Restore parameters of boot rom
34dcbfa11bSAntonio 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
41dcbfa11bSAntonio Nino Diaz	/* ---------------------------------------------
42dcbfa11bSAntonio Nino Diaz	 * Perform BL2 setup
43dcbfa11bSAntonio Nino Diaz	 * ---------------------------------------------
44dcbfa11bSAntonio Nino Diaz	 */
45dcbfa11bSAntonio Nino Diaz	bl	bl2_el3_setup
46dcbfa11bSAntonio Nino Diaz
47dcbfa11bSAntonio Nino Diaz#if ENABLE_PAUTH
489fc59639SAlexei Fedorov	/* ---------------------------------------------
49ed108b56SAlexei Fedorov	 * Program APIAKey_EL1 and enable pointer authentication.
509fc59639SAlexei Fedorov	 * ---------------------------------------------
519fc59639SAlexei Fedorov	 */
52ed108b56SAlexei Fedorov	bl	pauth_init_enable_el3
53dcbfa11bSAntonio Nino Diaz#endif /* ENABLE_PAUTH */
54b1d27b48SRoberto Vargas
55b1d27b48SRoberto Vargas	/* ---------------------------------------------
56b1d27b48SRoberto Vargas	 * Jump to main function.
57b1d27b48SRoberto Vargas	 * ---------------------------------------------
58b1d27b48SRoberto Vargas	 */
59b1d27b48SRoberto Vargas	bl	bl2_main
60b1d27b48SRoberto Vargas
61b1d27b48SRoberto Vargas	/* ---------------------------------------------
62b1d27b48SRoberto Vargas	 * Should never reach this point.
63b1d27b48SRoberto Vargas	 * ---------------------------------------------
64b1d27b48SRoberto Vargas	 */
65b1d27b48SRoberto Vargas	no_ret	plat_panic_handler
66b1d27b48SRoberto Vargasendfunc bl2_entrypoint
67b1d27b48SRoberto Vargas
68b1d27b48SRoberto Vargasfunc bl2_run_next_image
69b1d27b48SRoberto Vargas	mov	x20,x0
70dcbfa11bSAntonio Nino Diaz	/* ---------------------------------------------
71b1d27b48SRoberto Vargas	 * MMU needs to be disabled because both BL2 and BL31 execute
72b1d27b48SRoberto Vargas	 * in EL3, and therefore share the same address space.
73b1d27b48SRoberto Vargas	 * BL31 will initialize the address space according to its
74b1d27b48SRoberto Vargas	 * own requirement.
75dcbfa11bSAntonio Nino Diaz	 * ---------------------------------------------
76b1d27b48SRoberto Vargas	 */
77b1d27b48SRoberto Vargas	bl	disable_mmu_icache_el3
78b1d27b48SRoberto Vargas	tlbi	alle3
79b1d27b48SRoberto Vargas	bl	bl2_el3_plat_prepare_exit
80b1d27b48SRoberto Vargas
81ed108b56SAlexei Fedorov#if ENABLE_PAUTH
82dcbfa11bSAntonio Nino Diaz	/* ---------------------------------------------
83ed108b56SAlexei Fedorov	 * Disable pointer authentication before jumping
84ed108b56SAlexei Fedorov	 * to next boot image.
85dcbfa11bSAntonio Nino Diaz	 * ---------------------------------------------
86dcbfa11bSAntonio Nino Diaz	 */
87ed108b56SAlexei Fedorov	bl	pauth_disable_el3
88dcbfa11bSAntonio Nino Diaz#endif /* ENABLE_PAUTH */
89dcbfa11bSAntonio Nino Diaz
90b1d27b48SRoberto Vargas	ldp	x0, x1, [x20, #ENTRY_POINT_INFO_PC_OFFSET]
91b1d27b48SRoberto Vargas	msr	elr_el3, x0
92b1d27b48SRoberto Vargas	msr	spsr_el3, x1
93b1d27b48SRoberto Vargas
94b1d27b48SRoberto Vargas	ldp	x6, x7, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x30)]
95b1d27b48SRoberto Vargas	ldp	x4, x5, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x20)]
96b1d27b48SRoberto Vargas	ldp	x2, x3, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x10)]
97b1d27b48SRoberto Vargas	ldp	x0, x1, [x20, #(ENTRY_POINT_INFO_ARGS_OFFSET + 0x0)]
98*f461fe34SAnthony Steinhauser	exception_return
99b1d27b48SRoberto Vargasendfunc bl2_run_next_image
100