blob: 778062697ec076bfee0ec72306ed91b0062b647e [file] [log] [blame]
Yatharth Kochar5d361212016-06-28 17:07:09 +01001/*
David Cunadofee86532017-04-13 22:38:29 +01002 * Copyright (c) 2016-2017, ARM Limited and Contributors. All rights reserved.
Yatharth Kochar5d361212016-06-28 17:07:09 +01003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Yatharth Kochar5d361212016-06-28 17:07:09 +01005 */
6
7#include <arch.h>
8#include <asm_macros.S>
9#include <bl_common.h>
10#include <context.h>
11#include <el3_common_macros.S>
12#include <smcc_helpers.h>
13#include <smcc_macros.S>
14
15 .globl bl1_vector_table
16 .globl bl1_entrypoint
17
18 /* -----------------------------------------------------
19 * Setup the vector table to support SVC & MON mode.
20 * -----------------------------------------------------
21 */
22vector_base bl1_vector_table
23 b bl1_entrypoint
24 b report_exception /* Undef */
25 b bl1_aarch32_smc_handler /* SMC call */
26 b report_exception /* Prefetch abort */
27 b report_exception /* Data abort */
28 b report_exception /* Reserved */
29 b report_exception /* IRQ */
30 b report_exception /* FIQ */
31
32 /* -----------------------------------------------------
33 * bl1_entrypoint() is the entry point into the trusted
34 * firmware code when a cpu is released from warm or
35 * cold reset.
36 * -----------------------------------------------------
37 */
38
39func bl1_entrypoint
40/* ---------------------------------------------------------------------
41* If the reset address is programmable then bl1_entrypoint() is
42* executed only on the cold boot path. Therefore, we can skip the warm
43* boot mailbox mechanism.
44* ---------------------------------------------------------------------
45*/
46 el3_entrypoint_common \
David Cunadofee86532017-04-13 22:38:29 +010047 _init_sctlr=1 \
Yatharth Kochar5d361212016-06-28 17:07:09 +010048 _warm_boot_mailbox=!PROGRAMMABLE_RESET_ADDRESS \
49 _secondary_cold_boot=!COLD_BOOT_SINGLE_CPU \
50 _init_memory=1 \
51 _init_c_runtime=1 \
52 _exception_vectors=bl1_vector_table
53
54 /* -----------------------------------------------------
55 * Perform early platform setup & platform
56 * specific early arch. setup e.g. mmu setup
57 * -----------------------------------------------------
58 */
59 bl bl1_early_platform_setup
60 bl bl1_plat_arch_setup
61
62 /* -----------------------------------------------------
63 * Jump to main function.
64 * -----------------------------------------------------
65 */
66 bl bl1_main
67
68 /* -----------------------------------------------------
69 * Jump to next image.
70 * -----------------------------------------------------
71 */
72
73 /*
dp-armcdd03cb2017-02-15 11:07:55 +000074 * Get the smc_context for next BL image,
75 * program the gp/system registers and save it in `r4`.
76 */
77 bl smc_get_next_ctx
78 mov r4, r0
79
80 /* Only turn-off MMU if going to secure world */
81 ldr r5, [r4, #SMC_CTX_SCR]
82 tst r5, #SCR_NS_BIT
83 bne skip_mmu_off
84
85 /*
86 * MMU needs to be disabled because both BL1 and BL2/BL2U execute
Yatharth Kochar5d361212016-06-28 17:07:09 +010087 * in PL1, and therefore share the same address space.
dp-armcdd03cb2017-02-15 11:07:55 +000088 * BL2/BL2U will initialize the address space according to its
Yatharth Kochar5d361212016-06-28 17:07:09 +010089 * own requirement.
90 */
91 bl disable_mmu_icache_secure
92 stcopr r0, TLBIALL
93 dsb sy
94 isb
95
dp-armcdd03cb2017-02-15 11:07:55 +000096skip_mmu_off:
97 /* Restore smc_context from `r4` and exit secure monitor mode. */
98 mov r0, r4
Soby Mathewf3e3a432017-03-30 14:42:54 +010099 monitor_exit
Yatharth Kochar5d361212016-06-28 17:07:09 +0100100endfunc bl1_entrypoint