blob: 405eff68a3bc1bd457c52c55950acf44af024af3 [file] [log] [blame]
Tom Rini4549e782018-05-06 18:27:01 -04001// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
Patrick Delaunay2514c2d2018-03-12 10:46:10 +01002/*
3 * Copyright (C) 2018, STMicroelectronics - All Rights Reserved
Patrick Delaunay2514c2d2018-03-12 10:46:10 +01004 */
5
Patrick Delaunayeb653ac2020-11-06 19:01:29 +01006#define LOG_CATEGORY LOGC_ARCH
7
Patrick Delaunay2514c2d2018-03-12 10:46:10 +01008#include <common.h>
Patrick Delaunaydc7e5f12020-04-30 16:30:21 +02009#include <cpu_func.h>
Patrick Delaunay2514c2d2018-03-12 10:46:10 +010010#include <dm.h>
Simon Glassdb41d652019-12-28 10:45:07 -070011#include <hang.h>
Simon Glass691d7192020-05-10 11:40:02 -060012#include <init.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060013#include <log.h>
Alexandru Gagniuc85332632021-07-15 14:19:26 -050014#include <ram.h>
Patrick Delaunay2514c2d2018-03-12 10:46:10 +010015#include <spl.h>
Simon Glass90526e92020-05-10 11:39:56 -060016#include <asm/cache.h>
Simon Glass401d1c42020-10-30 21:38:53 -060017#include <asm/global_data.h>
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010018#include <asm/io.h>
Patrick Delaunay006ea182019-02-27 17:01:14 +010019#include <asm/arch/sys_proto.h>
Alexandru Gagniuc85332632021-07-15 14:19:26 -050020#include <mach/tzc.h>
Patrick Delaunay006ea182019-02-27 17:01:14 +010021#include <linux/libfdt.h>
Patrick Delaunay2514c2d2018-03-12 10:46:10 +010022
23u32 spl_boot_device(void)
24{
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010025 u32 boot_mode;
26
Patrick Delaunay7f63c1e2019-02-27 17:01:12 +010027 boot_mode = get_bootmode();
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010028
29 switch (boot_mode) {
30 case BOOT_FLASH_SD_1:
31 case BOOT_FLASH_EMMC_1:
32 return BOOT_DEVICE_MMC1;
33 case BOOT_FLASH_SD_2:
34 case BOOT_FLASH_EMMC_2:
35 return BOOT_DEVICE_MMC2;
Patrick Delaunay7f63c1e2019-02-27 17:01:12 +010036 case BOOT_SERIAL_UART_1:
37 case BOOT_SERIAL_UART_2:
38 case BOOT_SERIAL_UART_3:
39 case BOOT_SERIAL_UART_4:
40 case BOOT_SERIAL_UART_5:
41 case BOOT_SERIAL_UART_6:
42 case BOOT_SERIAL_UART_7:
43 case BOOT_SERIAL_UART_8:
44 return BOOT_DEVICE_UART;
45 case BOOT_SERIAL_USB_OTG:
46 return BOOT_DEVICE_USB;
47 case BOOT_FLASH_NAND_FMC:
48 return BOOT_DEVICE_NAND;
49 case BOOT_FLASH_NOR_QSPI:
50 return BOOT_DEVICE_SPI;
Patrick Delaunayb664a742020-03-18 09:22:52 +010051 case BOOT_FLASH_SPINAND_1:
52 return BOOT_DEVICE_NONE; /* SPINAND not supported in SPL */
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010053 }
54
Patrick Delaunay2514c2d2018-03-12 10:46:10 +010055 return BOOT_DEVICE_MMC1;
56}
57
Harald Seilere9759062020-04-15 11:33:30 +020058u32 spl_mmc_boot_mode(const u32 boot_device)
Patrick Delaunay2514c2d2018-03-12 10:46:10 +010059{
60 return MMCSD_MODE_RAW;
61}
62
Richard Genoud40426d62020-10-12 16:11:09 +020063#ifdef CONFIG_SYS_MMCSD_RAW_MODE_U_BOOT_USE_PARTITION
Harald Seilerc51b7512020-04-15 11:33:31 +020064int spl_mmc_boot_partition(const u32 boot_device)
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010065{
66 switch (boot_device) {
67 case BOOT_DEVICE_MMC1:
68 return CONFIG_SYS_MMCSD_RAW_MODE_U_BOOT_PARTITION;
69 case BOOT_DEVICE_MMC2:
70 return CONFIG_SYS_MMCSD_RAW_MODE_U_BOOT_PARTITION_MMC2;
71 default:
72 return -EINVAL;
73 }
74}
Richard Genoud40426d62020-10-12 16:11:09 +020075#endif
Patrick Delaunay11dfd1a2018-03-20 10:54:54 +010076
Patrick Delaunay006ea182019-02-27 17:01:14 +010077#ifdef CONFIG_SPL_DISPLAY_PRINT
78void spl_display_print(void)
79{
80 DECLARE_GLOBAL_DATA_PTR;
81 const char *model;
82
83 /* same code than show_board_info() but not compiled for SPL
84 * see CONFIG_DISPLAY_BOARDINFO & common/board_info.c
85 */
86 model = fdt_getprop(gd->fdt_blob, 0, "model", NULL);
87 if (model)
Patrick Delaunayeb653ac2020-11-06 19:01:29 +010088 log_info("Model: %s\n", model);
Patrick Delaunay006ea182019-02-27 17:01:14 +010089}
90#endif
91
Marek Vasut65e38e82020-04-22 13:18:10 +020092__weak int board_early_init_f(void)
93{
94 return 0;
95}
96
Alexandru Gagniuc85332632021-07-15 14:19:26 -050097uint32_t stm32mp_get_dram_size(void)
98{
99 struct ram_info ram;
100 struct udevice *dev;
101 int ret;
102
103 if (uclass_get_device(UCLASS_RAM, 0, &dev))
104 return 0;
105
106 ret = ram_get_info(dev, &ram);
107 if (ret)
108 return 0;
109
110 return ram.size;
111}
112
113static int optee_get_reserved_memory(uint32_t *start, uint32_t *size)
114{
115 phys_size_t fdt_mem_size;
116 fdt_addr_t fdt_start;
117 ofnode node;
118
119 node = ofnode_path("/reserved-memory/optee");
120 if (!ofnode_valid(node))
121 return 0;
122
123 fdt_start = ofnode_get_addr_size(node, "reg", &fdt_mem_size);
124 *start = fdt_start;
125 *size = fdt_mem_size;
126 return (fdt_start < 0) ? fdt_start : 0;
127}
128
129#define CFG_SHMEM_SIZE 0x200000
130#define STM32_TZC_NSID_ALL 0xffff
131#define STM32_TZC_FILTER_ALL 3
132
133void stm32_init_tzc_for_optee(void)
134{
135 const uint32_t dram_size = stm32mp_get_dram_size();
136 const uintptr_t dram_top = STM32_DDR_BASE + (dram_size - 1);
137 uint32_t optee_base, optee_size, tee_shmem_base;
138 const uintptr_t tzc = STM32_TZC_BASE;
139 int ret;
140
141 if (dram_size == 0)
142 panic("Cannot determine DRAM size from devicetree\n");
143
144 ret = optee_get_reserved_memory(&optee_base, &optee_size);
145 if (ret < 0 || optee_size <= CFG_SHMEM_SIZE)
146 panic("Invalid OPTEE reserved memory in devicetree\n");
147
148 tee_shmem_base = optee_base + optee_size - CFG_SHMEM_SIZE;
149
150 const struct tzc_region optee_config[] = {
151 {
152 .base = STM32_DDR_BASE,
153 .top = optee_base - 1,
154 .sec_mode = TZC_ATTR_SEC_NONE,
155 .nsec_id = STM32_TZC_NSID_ALL,
156 .filters_mask = STM32_TZC_FILTER_ALL,
157 }, {
158 .base = optee_base,
159 .top = tee_shmem_base - 1,
160 .sec_mode = TZC_ATTR_SEC_RW,
161 .nsec_id = 0,
162 .filters_mask = STM32_TZC_FILTER_ALL,
163 }, {
164 .base = tee_shmem_base,
165 .top = dram_top,
166 .sec_mode = TZC_ATTR_SEC_NONE,
167 .nsec_id = STM32_TZC_NSID_ALL,
168 .filters_mask = STM32_TZC_FILTER_ALL,
169 }, {
170 .top = 0,
171 }
172 };
173
174 flush_dcache_all();
175
176 tzc_configure(tzc, optee_config);
177 tzc_dump_config(tzc);
178
179 dcache_disable();
180}
181
182void spl_board_prepare_for_optee(void *fdt)
183{
184 stm32_init_tzc_for_optee();
185}
186
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100187void board_init_f(ulong dummy)
188{
189 struct udevice *dev;
190 int ret;
191
192 arch_cpu_init();
193
194 ret = spl_early_init();
195 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100196 log_debug("spl_early_init() failed: %d\n", ret);
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100197 hang();
198 }
199
200 ret = uclass_get_device(UCLASS_CLK, 0, &dev);
201 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100202 log_debug("Clock init failed: %d\n", ret);
Patrick Delaunayeaec1f92020-04-22 14:29:10 +0200203 hang();
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100204 }
205
206 ret = uclass_get_device(UCLASS_RESET, 0, &dev);
207 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100208 log_debug("Reset init failed: %d\n", ret);
Patrick Delaunayeaec1f92020-04-22 14:29:10 +0200209 hang();
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100210 }
211
212 ret = uclass_get_device(UCLASS_PINCTRL, 0, &dev);
213 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100214 log_debug("%s: Cannot find pinctrl device\n", __func__);
Patrick Delaunayeaec1f92020-04-22 14:29:10 +0200215 hang();
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100216 }
217
218 /* enable console uart printing */
219 preloader_console_init();
220
Marek Vasut65e38e82020-04-22 13:18:10 +0200221 ret = board_early_init_f();
222 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100223 log_debug("board_early_init_f() failed: %d\n", ret);
Marek Vasut65e38e82020-04-22 13:18:10 +0200224 hang();
225 }
226
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100227 ret = uclass_get_device(UCLASS_RAM, 0, &dev);
228 if (ret) {
Patrick Delaunayeb653ac2020-11-06 19:01:29 +0100229 log_err("DRAM init failed: %d\n", ret);
Patrick Delaunay105a5ad2019-02-27 17:01:17 +0100230 hang();
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100231 }
Patrick Delaunaydc7e5f12020-04-30 16:30:21 +0200232
233 /*
234 * activate cache on DDR only when DDR is fully initialized
235 * to avoid speculative access and issue in get_ram_size()
236 */
237 if (!CONFIG_IS_ENABLED(SYS_DCACHE_OFF))
Patrick Delaunay67f9f112020-09-04 12:55:19 +0200238 mmu_set_region_dcache_behaviour(STM32_DDR_BASE,
239 CONFIG_DDR_CACHEABLE_SIZE,
Patrick Delaunaydc7e5f12020-04-30 16:30:21 +0200240 DCACHE_DEFAULT_OPTION);
241}
242
243void spl_board_prepare_for_boot(void)
244{
245 dcache_disable();
246}
247
Patrick Delaunay346034a2020-07-07 14:21:53 +0200248void spl_board_prepare_for_linux(void)
Patrick Delaunaydc7e5f12020-04-30 16:30:21 +0200249{
250 dcache_disable();
Patrick Delaunay2514c2d2018-03-12 10:46:10 +0100251}