1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * K3: Common Architecture initialization
4 *
5 * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com/
6 * Lokesh Vutla <lokeshvutla@ti.com>
7 */
8
9 #include <config.h>
10 #include <cpu_func.h>
11 #include <image.h>
12 #include <init.h>
13 #include <log.h>
14 #include <spl.h>
15 #include <asm/global_data.h>
16 #include <linux/printk.h>
17 #include "common.h"
18 #include <dm.h>
19 #include <remoteproc.h>
20 #include <asm/cache.h>
21 #include <linux/soc/ti/ti_sci_protocol.h>
22 #include <fdt_support.h>
23 #include <asm/hardware.h>
24 #include <asm/io.h>
25 #include <fs_loader.h>
26 #include <fs.h>
27 #include <efi_loader.h>
28 #include <env.h>
29 #include <elf.h>
30 #include <soc.h>
31 #include <dm/uclass-internal.h>
32 #include <dm/device-internal.h>
33
34 #define PROC_BOOT_CTRL_FLAG_R5_CORE_HALT 0x00000001
35 #define PROC_BOOT_STATUS_FLAG_R5_WFI 0x00000002
36 #define PROC_ID_MCU_R5FSS0_CORE1 0x02
37 #define PROC_BOOT_CFG_FLAG_R5_LOCKSTEP 0x00000100
38
39 #include <asm/arch/k3-qos.h>
40
get_ti_sci_handle(void)41 struct ti_sci_handle *get_ti_sci_handle(void)
42 {
43 struct udevice *dev;
44 int ret;
45
46 ret = uclass_get_device_by_driver(UCLASS_FIRMWARE,
47 DM_DRIVER_GET(ti_sci), &dev);
48 if (ret)
49 panic("Failed to get SYSFW (%d)\n", ret);
50
51 return (struct ti_sci_handle *)ti_sci_get_handle_from_sysfw(dev);
52 }
53
k3_sysfw_print_ver(void)54 void k3_sysfw_print_ver(void)
55 {
56 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
57 char fw_desc[sizeof(ti_sci->version.firmware_description) + 1];
58
59 /*
60 * Output System Firmware version info. Note that since the
61 * 'firmware_description' field is not guaranteed to be zero-
62 * terminated we manually add a \0 terminator if needed. Further
63 * note that we intentionally no longer rely on the extended
64 * printf() formatter '%.*s' to not having to require a more
65 * full-featured printf() implementation.
66 */
67 strncpy(fw_desc, ti_sci->version.firmware_description,
68 sizeof(ti_sci->version.firmware_description));
69 fw_desc[sizeof(fw_desc) - 1] = '\0';
70
71 printf("SYSFW ABI: %d.%d (firmware rev 0x%04x '%s')\n",
72 ti_sci->version.abi_major, ti_sci->version.abi_minor,
73 ti_sci->version.firmware_revision, fw_desc);
74 }
75
k3_dm_print_ver(void)76 void __maybe_unused k3_dm_print_ver(void)
77 {
78 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
79 struct ti_sci_firmware_ops *fw_ops = &ti_sci->ops.fw_ops;
80 struct ti_sci_dm_version_info dm_info = {0};
81 u64 fw_caps;
82 int ret;
83
84 ret = fw_ops->query_dm_cap(ti_sci, &fw_caps);
85 if (ret) {
86 printf("Failed to query DM firmware capability %d\n", ret);
87 return;
88 }
89
90 if (!(fw_caps & TI_SCI_MSG_FLAG_FW_CAP_DM))
91 return;
92
93 ret = fw_ops->get_dm_version(ti_sci, &dm_info);
94 if (ret) {
95 printf("Failed to fetch DM firmware version %d\n", ret);
96 return;
97 }
98
99 printf("DM ABI: %d.%d (firmware ver 0x%04x '%s--%s' "
100 "patch_ver: %d)\n", dm_info.abi_major, dm_info.abi_minor,
101 dm_info.dm_ver, dm_info.sci_server_version,
102 dm_info.rm_pm_hal_version, dm_info.patch_ver);
103 }
104
mmr_unlock(uintptr_t base,u32 partition)105 void mmr_unlock(uintptr_t base, u32 partition)
106 {
107 /* Translate the base address */
108 uintptr_t part_base = base + partition * CTRL_MMR0_PARTITION_SIZE;
109
110 /* Unlock the requested partition if locked using two-step sequence */
111 writel(CTRLMMR_LOCK_KICK0_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK0);
112 writel(CTRLMMR_LOCK_KICK1_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK1);
113 }
114
is_rom_loaded_sysfw(struct rom_extended_boot_data * data)115 bool is_rom_loaded_sysfw(struct rom_extended_boot_data *data)
116 {
117 if (strncmp(data->header, K3_ROM_BOOT_HEADER_MAGIC, 7))
118 return false;
119
120 return data->num_components > 1;
121 }
122
123 DECLARE_GLOBAL_DATA_PTR;
124
125 #ifdef CONFIG_K3_EARLY_CONS
early_console_init(void)126 int early_console_init(void)
127 {
128 struct udevice *dev;
129 int ret;
130
131 gd->baudrate = CONFIG_BAUDRATE;
132
133 ret = uclass_get_device_by_seq(UCLASS_SERIAL, CONFIG_K3_EARLY_CONS_IDX,
134 &dev);
135 if (ret) {
136 printf("Error getting serial dev for early console! (%d)\n",
137 ret);
138 return ret;
139 }
140
141 gd->cur_serial_dev = dev;
142 gd->flags |= GD_FLG_SERIAL_READY;
143 gd->flags |= GD_FLG_HAVE_CONSOLE;
144
145 return 0;
146 }
147 #endif
148
149 #if CONFIG_IS_ENABLED(FIT_IMAGE_POST_PROCESS) && !IS_ENABLED(CONFIG_SYS_K3_SPL_ATF)
board_fit_image_post_process(const void * fit,int node,void ** p_image,size_t * p_size)150 void board_fit_image_post_process(const void *fit, int node, void **p_image,
151 size_t *p_size)
152 {
153 ti_secure_image_check_binary(p_image, p_size);
154 ti_secure_image_post_process(p_image, p_size);
155 }
156 #endif
157
158 #ifndef CONFIG_SYSRESET
reset_cpu(void)159 void reset_cpu(void)
160 {
161 }
162 #endif
163
get_device_type(void)164 enum k3_device_type get_device_type(void)
165 {
166 u32 sys_status = readl(K3_SEC_MGR_SYS_STATUS);
167
168 u32 sys_dev_type = (sys_status & SYS_STATUS_DEV_TYPE_MASK) >>
169 SYS_STATUS_DEV_TYPE_SHIFT;
170
171 u32 sys_sub_type = (sys_status & SYS_STATUS_SUB_TYPE_MASK) >>
172 SYS_STATUS_SUB_TYPE_SHIFT;
173
174 switch (sys_dev_type) {
175 case SYS_STATUS_DEV_TYPE_GP:
176 return K3_DEVICE_TYPE_GP;
177 case SYS_STATUS_DEV_TYPE_TEST:
178 return K3_DEVICE_TYPE_TEST;
179 case SYS_STATUS_DEV_TYPE_EMU:
180 return K3_DEVICE_TYPE_EMU;
181 case SYS_STATUS_DEV_TYPE_HS:
182 if (sys_sub_type == SYS_STATUS_SUB_TYPE_VAL_FS)
183 return K3_DEVICE_TYPE_HS_FS;
184 else
185 return K3_DEVICE_TYPE_HS_SE;
186 default:
187 return K3_DEVICE_TYPE_BAD;
188 }
189 }
190
191 #if defined(CONFIG_DISPLAY_CPUINFO)
get_device_type_name(void)192 static const char *get_device_type_name(void)
193 {
194 enum k3_device_type type = get_device_type();
195
196 switch (type) {
197 case K3_DEVICE_TYPE_GP:
198 return "GP";
199 case K3_DEVICE_TYPE_TEST:
200 return "TEST";
201 case K3_DEVICE_TYPE_EMU:
202 return "EMU";
203 case K3_DEVICE_TYPE_HS_FS:
204 return "HS-FS";
205 case K3_DEVICE_TYPE_HS_SE:
206 return "HS-SE";
207 default:
208 return "BAD";
209 }
210 }
211
get_reset_reason(void)212 __weak const char *get_reset_reason(void)
213 {
214 return NULL;
215 }
216
print_cpuinfo(void)217 int print_cpuinfo(void)
218 {
219 struct udevice *soc;
220 char name[64];
221 int ret;
222 const char *reset_reason;
223
224 printf("SoC: ");
225
226 ret = soc_get(&soc);
227 if (ret) {
228 printf("UNKNOWN\n");
229 return 0;
230 }
231
232 ret = soc_get_family(soc, name, 64);
233 if (!ret) {
234 printf("%s ", name);
235 }
236
237 ret = soc_get_revision(soc, name, 64);
238 if (!ret) {
239 printf("%s ", name);
240 }
241
242 printf("%s\n", get_device_type_name());
243
244 reset_reason = get_reset_reason();
245 if (reset_reason)
246 printf("Reset reason: %s\n", reset_reason);
247
248 return 0;
249 }
250 #endif
251
252 #ifdef CONFIG_ARM64
board_prep_linux(struct bootm_headers * images)253 void board_prep_linux(struct bootm_headers *images)
254 {
255 debug("Linux kernel Image start = 0x%lx end = 0x%lx\n",
256 images->os.start, images->os.end);
257 __asm_flush_dcache_range(images->os.start,
258 ROUND(images->os.end,
259 CONFIG_SYS_CACHELINE_SIZE));
260 }
261 #endif
262
spl_enable_cache(void)263 void spl_enable_cache(void)
264 {
265 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
266 gd->ram_top = CFG_SYS_SDRAM_BASE;
267 int ret = 0;
268
269 dram_init();
270
271 /* reserve TLB table */
272 gd->arch.tlb_size = PGTABLE_SIZE;
273
274 gd->ram_top += get_effective_memsize();
275 gd->relocaddr = gd->ram_top;
276
277 ret = spl_reserve_video_from_ram_top();
278 if (ret)
279 panic("Failed to reserve framebuffer memory (%d)\n", ret);
280
281 gd->arch.tlb_addr = gd->relocaddr - gd->arch.tlb_size;
282 gd->arch.tlb_addr &= ~(0x10000 - 1);
283 debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
284 gd->arch.tlb_addr + gd->arch.tlb_size);
285 gd->relocaddr = gd->arch.tlb_addr;
286
287 enable_caches();
288 #endif
289 }
290
k3_dma_remove(void)291 static __maybe_unused void k3_dma_remove(void)
292 {
293 struct udevice *dev;
294 int rc;
295
296 rc = uclass_find_device(UCLASS_DMA, 0, &dev);
297 if (!rc && dev) {
298 rc = device_remove(dev, DM_REMOVE_NORMAL);
299 if (rc)
300 pr_warn("Cannot remove dma device '%s' (err=%d)\n",
301 dev->name, rc);
302 } else
303 pr_warn("DMA Device not found (err=%d)\n", rc);
304 }
305
spl_board_prepare_for_boot(void)306 void spl_board_prepare_for_boot(void)
307 {
308 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
309 dcache_disable();
310 #endif
311 #if IS_ENABLED(CONFIG_SPL_DMA) && IS_ENABLED(CONFIG_SPL_DM_DEVICE_REMOVE)
312 k3_dma_remove();
313 #endif
314 }
315
316 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
spl_board_prepare_for_linux(void)317 void spl_board_prepare_for_linux(void)
318 {
319 dcache_disable();
320 }
321 #endif
322
misc_init_r(void)323 int misc_init_r(void)
324 {
325 if (IS_ENABLED(CONFIG_TI_AM65_CPSW_NUSS)) {
326 struct udevice *dev;
327 int ret;
328
329 ret = uclass_get_device_by_driver(UCLASS_MISC,
330 DM_DRIVER_GET(am65_cpsw_nuss),
331 &dev);
332 if (ret)
333 printf("Failed to probe am65_cpsw_nuss driver\n");
334 }
335
336 if (IS_ENABLED(CONFIG_TI_ICSSG_PRUETH)) {
337 struct udevice *dev;
338 int ret;
339
340 ret = uclass_get_device_by_driver(UCLASS_MISC,
341 DM_DRIVER_GET(prueth),
342 &dev);
343 if (ret)
344 printf("Failed to probe prueth driver\n");
345 }
346
347 /* Default FIT boot on HS-SE devices */
348 if (get_device_type() == K3_DEVICE_TYPE_HS_SE) {
349 env_set("boot_fit", "1");
350 env_set("secure_rprocs", "1");
351 }
352
353 return 0;
354 }
355
356 /**
357 * do_board_detect() - Detect board description
358 *
359 * Function to detect board description. This is expected to be
360 * overridden in the SoC family board file where desired.
361 */
do_board_detect(void)362 void __weak do_board_detect(void)
363 {
364 }
365
366 #if (IS_ENABLED(CONFIG_K3_QOS))
setup_qos(void)367 void setup_qos(void)
368 {
369 u32 i;
370
371 for (i = 0; i < qos_count; i++)
372 writel(qos_data[i].val, (uintptr_t)qos_data[i].reg);
373 }
374 #endif
375
shutdown_mcu_r5_core1(void)376 int __maybe_unused shutdown_mcu_r5_core1(void)
377 {
378 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
379 struct ti_sci_dev_ops *dev_ops = &ti_sci->ops.dev_ops;
380 struct ti_sci_proc_ops *proc_ops = &ti_sci->ops.proc_ops;
381 u32 dev_id_mcu_r5_core1 = put_core_ids[0];
382 u64 boot_vector;
383 u32 cfg, ctrl, sts, halted;
384 int cluster_mode_lockstep, ret;
385 bool r_state = false, c_state = false;
386
387 ret = proc_ops->proc_request(ti_sci, PROC_ID_MCU_R5FSS0_CORE1);
388 if (ret) {
389 printf("Unable to request processor control for MCU1_1 core, %d\n",
390 ret);
391 return ret;
392 }
393
394 ret = dev_ops->is_on(ti_sci, dev_id_mcu_r5_core1, &r_state, &c_state);
395 if (ret) {
396 printf("Unable to get device status for MCU1_1 core, %d\n", ret);
397 return ret;
398 }
399
400 ret = proc_ops->get_proc_boot_status(ti_sci, PROC_ID_MCU_R5FSS0_CORE1,
401 &boot_vector, &cfg, &ctrl, &sts);
402 if (ret) {
403 printf("Unable to get Processor boot status for MCU1_1 core, %d\n",
404 ret);
405 goto release_proc_ctrl;
406 }
407
408 halted = !!(sts & PROC_BOOT_STATUS_FLAG_R5_WFI);
409 cluster_mode_lockstep = !!(cfg & PROC_BOOT_CFG_FLAG_R5_LOCKSTEP);
410
411 /*
412 * Shutdown MCU R5F Core 1 only if:
413 * - cluster is booted in SplitMode
414 * - core is powered on
415 * - core is in WFI (halted)
416 */
417 if (cluster_mode_lockstep || !c_state || !halted) {
418 ret = -EINVAL;
419 goto release_proc_ctrl;
420 }
421
422 ret = proc_ops->set_proc_boot_ctrl(ti_sci, PROC_ID_MCU_R5FSS0_CORE1,
423 PROC_BOOT_CTRL_FLAG_R5_CORE_HALT, 0);
424 if (ret) {
425 printf("Unable to Halt MCU1_1 core, %d\n", ret);
426 goto release_proc_ctrl;
427 }
428
429 ret = dev_ops->put_device(ti_sci, dev_id_mcu_r5_core1);
430 if (ret) {
431 printf("Unable to assert reset on MCU1_1 core, %d\n", ret);
432 return ret;
433 }
434
435 release_proc_ctrl:
436 proc_ops->proc_release(ti_sci, PROC_ID_MCU_R5FSS0_CORE1);
437 return ret;
438 }
439