xref: /rk3399_ARM-atf/plat/ti/k3/common/k3_bl31_setup.c (revision 7af195e29a4213eefac0661d84e1c9c20476e166)
1 /*
2  * Copyright (c) 2017-2018, ARM Limited and Contributors. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 #include <assert.h>
8 #include <string.h>
9 
10 #include <platform_def.h>
11 
12 #include <arch.h>
13 #include <arch_helpers.h>
14 #include <common/bl_common.h>
15 #include <common/debug.h>
16 #include <lib/xlat_tables/xlat_tables_v2.h>
17 
18 #include <k3_console.h>
19 #include <k3_gicv3.h>
20 #include <ti_sci.h>
21 
22 /* Table of regions to map using the MMU */
23 const mmap_region_t plat_k3_mmap[] = {
24 	MAP_REGION_FLAT(K3_USART_BASE,       K3_USART_SIZE,       MT_DEVICE | MT_RW | MT_SECURE),
25 	MAP_REGION_FLAT(K3_GIC_BASE,         K3_GIC_SIZE,         MT_DEVICE | MT_RW | MT_SECURE),
26 	MAP_REGION_FLAT(SEC_PROXY_RT_BASE,   SEC_PROXY_RT_SIZE,   MT_DEVICE | MT_RW | MT_SECURE),
27 	MAP_REGION_FLAT(SEC_PROXY_SCFG_BASE, SEC_PROXY_SCFG_SIZE, MT_DEVICE | MT_RW | MT_SECURE),
28 	MAP_REGION_FLAT(SEC_PROXY_DATA_BASE, SEC_PROXY_DATA_SIZE, MT_DEVICE | MT_RW | MT_SECURE),
29 	{ /* sentinel */ }
30 };
31 
32 /*
33  * Placeholder variables for maintaining information about the next image(s)
34  */
35 static entry_point_info_t bl32_image_ep_info;
36 static entry_point_info_t bl33_image_ep_info;
37 
38 /*******************************************************************************
39  * Gets SPSR for BL33 entry
40  ******************************************************************************/
41 static uint32_t k3_get_spsr_for_bl33_entry(void)
42 {
43 	unsigned long el_status;
44 	unsigned int mode;
45 	uint32_t spsr;
46 
47 	/* Figure out what mode we enter the non-secure world in */
48 	el_status = read_id_aa64pfr0_el1() >> ID_AA64PFR0_EL2_SHIFT;
49 	el_status &= ID_AA64PFR0_ELX_MASK;
50 
51 	mode = (el_status) ? MODE_EL2 : MODE_EL1;
52 
53 	spsr = SPSR_64(mode, MODE_SP_ELX, DISABLE_ALL_EXCEPTIONS);
54 	return spsr;
55 }
56 
57 /*******************************************************************************
58  * Perform any BL3-1 early platform setup, such as console init and deciding on
59  * memory layout.
60  ******************************************************************************/
61 void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1,
62 				u_register_t arg2, u_register_t arg3)
63 {
64 	/* There are no parameters from BL2 if BL31 is a reset vector */
65 	assert(arg0 == 0U);
66 	assert(arg1 == 0U);
67 
68 	bl31_console_setup();
69 
70 #ifdef BL32_BASE
71 	/* Populate entry point information for BL32 */
72 	SET_PARAM_HEAD(&bl32_image_ep_info, PARAM_EP, VERSION_1, 0);
73 	bl32_image_ep_info.pc = BL32_BASE;
74 	bl32_image_ep_info.spsr = SPSR_64(MODE_EL1, MODE_SP_ELX,
75 					  DISABLE_ALL_EXCEPTIONS);
76 	SET_SECURITY_STATE(bl32_image_ep_info.h.attr, SECURE);
77 #endif
78 
79 	/* Populate entry point information for BL33 */
80 	SET_PARAM_HEAD(&bl33_image_ep_info, PARAM_EP, VERSION_1, 0);
81 	bl33_image_ep_info.pc = PRELOADED_BL33_BASE;
82 	bl33_image_ep_info.spsr = k3_get_spsr_for_bl33_entry();
83 	SET_SECURITY_STATE(bl33_image_ep_info.h.attr, NON_SECURE);
84 
85 #ifdef K3_HW_CONFIG_BASE
86 	/*
87 	 * According to the file ``Documentation/arm64/booting.txt`` of the
88 	 * Linux kernel tree, Linux expects the physical address of the device
89 	 * tree blob (DTB) in x0, while x1-x3 are reserved for future use and
90 	 * must be 0.
91 	 */
92 	bl33_image_ep_info.args.arg0 = (u_register_t)K3_HW_CONFIG_BASE;
93 	bl33_image_ep_info.args.arg1 = 0U;
94 	bl33_image_ep_info.args.arg2 = 0U;
95 	bl33_image_ep_info.args.arg3 = 0U;
96 #endif
97 }
98 
99 void bl31_plat_arch_setup(void)
100 {
101 	const mmap_region_t bl_regions[] = {
102 		MAP_REGION_FLAT(BL31_START,           BL31_END            - BL31_START,           MT_MEMORY  | MT_RW | MT_SECURE),
103 		MAP_REGION_FLAT(BL_CODE_BASE,         BL_CODE_END         - BL_CODE_BASE,         MT_CODE    | MT_RO | MT_SECURE),
104 		MAP_REGION_FLAT(BL_RO_DATA_BASE,      BL_RO_DATA_END      - BL_RO_DATA_BASE,      MT_RO_DATA | MT_RO | MT_SECURE),
105 #if USE_COHERENT_MEM
106 		MAP_REGION_FLAT(BL_COHERENT_RAM_BASE, BL_COHERENT_RAM_END - BL_COHERENT_RAM_BASE, MT_DEVICE  | MT_RW | MT_SECURE),
107 #endif
108 		{ /* sentinel */ }
109 	};
110 
111 	setup_page_tables(bl_regions, plat_k3_mmap);
112 	enable_mmu_el3(0);
113 }
114 
115 void bl31_platform_setup(void)
116 {
117 	k3_gic_driver_init(K3_GIC_BASE);
118 	k3_gic_init();
119 
120 	ti_sci_init();
121 }
122 
123 void platform_mem_init(void)
124 {
125 	/* Do nothing for now... */
126 }
127 
128 unsigned int plat_get_syscnt_freq2(void)
129 {
130 	return SYS_COUNTER_FREQ_IN_TICKS;
131 }
132 
133 /*
134  * Empty function to prevent the console from being uninitialized after BL33 is
135  * started and allow us to see messages from BL31.
136  */
137 void bl31_plat_runtime_setup(void)
138 {
139 }
140 
141 /*******************************************************************************
142  * Return a pointer to the 'entry_point_info' structure of the next image
143  * for the security state specified. BL3-3 corresponds to the non-secure
144  * image type while BL3-2 corresponds to the secure image type. A NULL
145  * pointer is returned if the image does not exist.
146  ******************************************************************************/
147 entry_point_info_t *bl31_plat_get_next_image_ep_info(uint32_t type)
148 {
149 	entry_point_info_t *next_image_info;
150 
151 	assert(sec_state_is_valid(type));
152 	next_image_info = (type == NON_SECURE) ? &bl33_image_ep_info :
153 						 &bl32_image_ep_info;
154 	/*
155 	 * None of the images on the ARM development platforms can have 0x0
156 	 * as the entrypoint
157 	 */
158 	if (next_image_info->pc)
159 		return next_image_info;
160 
161 	NOTICE("Requested nonexistent image\n");
162 	return NULL;
163 }
164