blob: 102fd2f5143c9337c2b65633c54a224ef7cec181 [file] [log] [blame]
Yatharth Kochardafb2472016-06-30 14:52:12 +01001/*
Antonio Nino Diaz6e4b0832019-01-31 10:48:47 +00002 * Copyright (c) 2016-2019, ARM Limited and Contributors. All rights reserved.
Yatharth Kochardafb2472016-06-30 14:52:12 +01003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Yatharth Kochardafb2472016-06-30 14:52:12 +01005 */
6
7#include <arch.h>
8#include <asm_macros.S>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +00009#include <common/bl_common.h>
Yatharth Kochardafb2472016-06-30 14:52:12 +010010
11 .globl bl2_vector_table
12 .globl bl2_entrypoint
13
14
15vector_base bl2_vector_table
16 b bl2_entrypoint
17 b report_exception /* Undef */
18 b report_exception /* SVC call */
19 b report_exception /* Prefetch abort */
20 b report_exception /* Data abort */
21 b report_exception /* Reserved */
22 b report_exception /* IRQ */
23 b report_exception /* FIQ */
24
25
26func bl2_entrypoint
27 /*---------------------------------------------
Soby Mathew73308d02018-01-09 14:36:14 +000028 * Save arguments x0 - x3 from BL1 for future
29 * use.
Yatharth Kochardafb2472016-06-30 14:52:12 +010030 * ---------------------------------------------
31 */
Soby Mathew73308d02018-01-09 14:36:14 +000032 mov r9, r0
33 mov r10, r1
34 mov r11, r2
35 mov r12, r3
Yatharth Kochardafb2472016-06-30 14:52:12 +010036
37 /* ---------------------------------------------
38 * Set the exception vector to something sane.
39 * ---------------------------------------------
40 */
41 ldr r0, =bl2_vector_table
42 stcopr r0, VBAR
43 isb
44
John Tsichritzisd5a59602019-03-04 16:42:54 +000045 /* --------------------------------------------------------
46 * Enable the instruction cache - disable speculative loads
47 * --------------------------------------------------------
Yatharth Kochardafb2472016-06-30 14:52:12 +010048 */
49 ldcopr r0, SCTLR
50 orr r0, r0, #SCTLR_I_BIT
John Tsichritzisd5a59602019-03-04 16:42:54 +000051 bic r0, r0, #SCTLR_DSSBS_BIT
Yatharth Kochardafb2472016-06-30 14:52:12 +010052 stcopr r0, SCTLR
53 isb
54
55 /* ---------------------------------------------
56 * Since BL2 executes after BL1, it is assumed
57 * here that BL1 has already has done the
58 * necessary register initializations.
59 * ---------------------------------------------
60 */
61
62 /* ---------------------------------------------
63 * Invalidate the RW memory used by the BL2
64 * image. This includes the data and NOBITS
65 * sections. This is done to safeguard against
66 * possible corruption of this memory by dirty
67 * cache lines in a system cache as a result of
68 * use by an earlier boot loader stage.
69 * ---------------------------------------------
70 */
71 ldr r0, =__RW_START__
72 ldr r1, =__RW_END__
73 sub r1, r1, r0
74 bl inv_dcache_range
75
76 /* ---------------------------------------------
77 * Zero out NOBITS sections. There are 2 of them:
78 * - the .bss section;
79 * - the coherent memory section.
80 * ---------------------------------------------
81 */
82 ldr r0, =__BSS_START__
83 ldr r1, =__BSS_SIZE__
84 bl zeromem
85
86#if USE_COHERENT_MEM
87 ldr r0, =__COHERENT_RAM_START__
88 ldr r1, =__COHERENT_RAM_UNALIGNED_SIZE__
89 bl zeromem
90#endif
91
92 /* --------------------------------------------
93 * Allocate a stack whose memory will be marked
94 * as Normal-IS-WBWA when the MMU is enabled.
95 * There is no risk of reading stale stack
96 * memory after enabling the MMU as only the
97 * primary cpu is running at the moment.
98 * --------------------------------------------
99 */
100 bl plat_set_my_stack
101
102 /* ---------------------------------------------
Douglas Raillard306593d2017-02-24 18:14:15 +0000103 * Initialize the stack protector canary before
104 * any C code is called.
105 * ---------------------------------------------
106 */
107#if STACK_PROTECTOR_ENABLED
108 bl update_stack_protector_canary
109#endif
110
111 /* ---------------------------------------------
Antonio Nino Diaz6e4b0832019-01-31 10:48:47 +0000112 * Perform BL2 setup
Yatharth Kochardafb2472016-06-30 14:52:12 +0100113 * ---------------------------------------------
114 */
Soby Mathew73308d02018-01-09 14:36:14 +0000115 mov r0, r9
116 mov r1, r10
117 mov r2, r11
118 mov r3, r12
Antonio Nino Diaz6e4b0832019-01-31 10:48:47 +0000119
120 bl bl2_setup
Yatharth Kochardafb2472016-06-30 14:52:12 +0100121
122 /* ---------------------------------------------
123 * Jump to main function.
124 * ---------------------------------------------
125 */
126 bl bl2_main
127
128 /* ---------------------------------------------
129 * Should never reach this point.
130 * ---------------------------------------------
131 */
Jeenu Viswambharan68aef102016-11-30 15:21:11 +0000132 no_ret plat_panic_handler
Yatharth Kochardafb2472016-06-30 14:52:12 +0100133
134endfunc bl2_entrypoint