xref: /rk3399_ARM-atf/bl1/bl1_main.c (revision 408c37682a0233c8c4fa88700b603f0b09d6361f)
1 /*
2  * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved.
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions are met:
6  *
7  * Redistributions of source code must retain the above copyright notice, this
8  * list of conditions and the following disclaimer.
9  *
10  * Redistributions in binary form must reproduce the above copyright notice,
11  * this list of conditions and the following disclaimer in the documentation
12  * and/or other materials provided with the distribution.
13  *
14  * Neither the name of ARM nor the names of its contributors may be used
15  * to endorse or promote products derived from this software without specific
16  * prior written permission.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28  * POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 #include <arch.h>
32 #include <arch_helpers.h>
33 #include <assert.h>
34 #include <bl_common.h>
35 #include <bl1.h>
36 #include <platform.h>
37 #include <stdio.h>
38 #include "bl1_private.h"
39 
40 /*******************************************************************************
41  * Function to perform late architectural and platform specific initialization.
42  * It also locates and loads the BL2 raw binary image in the trusted DRAM. Only
43  * called by the primary cpu after a cold boot.
44  * TODO: Add support for alternative image load mechanism e.g using virtio/elf
45  * loader etc.
46   ******************************************************************************/
47 void bl1_main(void)
48 {
49 #if DEBUG
50 	unsigned long sctlr_el3 = read_sctlr_el3();
51 #endif
52 	unsigned long bl2_base;
53 	unsigned int load_type = TOP_LOAD, spsr;
54 	meminfo_t *bl1_tzram_layout;
55 	meminfo_t *bl2_tzram_layout = 0x0;
56 
57 	/*
58 	 * Ensure that MMU/Caches and coherency are turned on
59 	 */
60 	assert(sctlr_el3 | SCTLR_M_BIT);
61 	assert(sctlr_el3 | SCTLR_C_BIT);
62 	assert(sctlr_el3 | SCTLR_I_BIT);
63 
64 	/* Perform remaining generic architectural setup from EL3 */
65 	bl1_arch_setup();
66 
67 	/* Perform platform setup in BL1. */
68 	bl1_platform_setup();
69 
70 	/* Announce our arrival */
71 	printf(FIRMWARE_WELCOME_STR);
72 	printf("%s\n\r", build_message);
73 
74 	/*
75 	 * Find out how much free trusted ram remains after BL1 load
76 	 * & load the BL2 image at its top
77 	 */
78 	bl1_tzram_layout = bl1_plat_sec_mem_layout();
79 	bl2_base = load_image(bl1_tzram_layout,
80 			      (const char *) BL2_IMAGE_NAME,
81 			      load_type, BL2_BASE);
82 
83 	/*
84 	 * Create a new layout of memory for BL2 as seen by BL1 i.e.
85 	 * tell it the amount of total and free memory available.
86 	 * This layout is created at the first free address visible
87 	 * to BL2. BL2 will read the memory layout before using its
88 	 * memory for other purposes.
89 	 */
90 	bl2_tzram_layout = (meminfo_t *) bl1_tzram_layout->free_base;
91 	init_bl2_mem_layout(bl1_tzram_layout,
92 			    bl2_tzram_layout,
93 			    load_type,
94 			    bl2_base);
95 
96 	if (bl2_base) {
97 		bl1_arch_next_el_setup();
98 		spsr = make_spsr(MODE_EL1, MODE_SP_ELX, MODE_RW_64);
99 		printf("Booting trusted firmware boot loader stage 2\n\r");
100 #if DEBUG
101 		printf("BL2 address = 0x%llx \n\r", (unsigned long long) bl2_base);
102 		printf("BL2 cpsr = 0x%x \n\r", spsr);
103 		printf("BL2 memory layout address = 0x%llx \n\r",
104 		       (unsigned long long) bl2_tzram_layout);
105 #endif
106 		run_image(bl2_base,
107 			  spsr,
108 			  SECURE,
109 			  (void *) bl2_tzram_layout,
110 			  NULL);
111 	}
112 
113 	/*
114 	 * TODO: print failure to load BL2 but also add a tzwdog timer
115 	 * which will reset the system eventually.
116 	 */
117 	printf("Failed to load boot loader stage 2 (BL2) firmware.\n\r");
118 	return;
119 }
120 
121 /*******************************************************************************
122  * Temporary function to print the fact that BL2 has done its job and BL31 is
123  * about to be loaded. This is needed as long as printfs cannot be used
124  ******************************************************************************/
125 void display_boot_progress(unsigned long entrypoint,
126 			   unsigned long spsr,
127 			   unsigned long mem_layout,
128 			   unsigned long ns_image_info)
129 {
130 	printf("Booting trusted firmware boot loader stage 3\n\r");
131 #if DEBUG
132 	printf("BL31 address = 0x%llx \n\r", (unsigned long long) entrypoint);
133 	printf("BL31 cpsr = 0x%llx \n\r", (unsigned long long)spsr);
134 	printf("BL31 memory layout address = 0x%llx \n\r", (unsigned long long)mem_layout);
135 	printf("BL31 non-trusted image info address = 0x%llx\n\r", (unsigned long long)ns_image_info);
136 #endif
137 	return;
138 }
139