1 // SPDX-License-Identifier: GPL-2.0+
3 * K3: Common Architecture initialization
5 * Copyright (C) 2018 Texas Instruments Incorporated - http://www.ti.com/
6 * Lokesh Vutla <lokeshvutla@ti.com>
15 #include <asm/global_data.h>
18 #include <remoteproc.h>
19 #include <asm/cache.h>
20 #include <linux/soc/ti/ti_sci_protocol.h>
21 #include <fdt_support.h>
22 #include <asm/hardware.h>
24 #include <fs_loader.h>
30 #if IS_ENABLED(CONFIG_SYS_K3_SPL_ATF)
39 #if CONFIG_IS_ENABLED(FIT_IMAGE_POST_PROCESS)
40 static const char *image_os_match[IMAGE_AMT] = {
41 "arm-trusted-firmware",
48 static struct image_info fit_image_info[IMAGE_AMT];
51 struct ti_sci_handle *get_ti_sci_handle(void)
56 ret = uclass_get_device_by_driver(UCLASS_FIRMWARE,
57 DM_DRIVER_GET(ti_sci), &dev);
59 panic("Failed to get SYSFW (%d)\n", ret);
61 return (struct ti_sci_handle *)ti_sci_get_handle_from_sysfw(dev);
64 void k3_sysfw_print_ver(void)
66 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
67 char fw_desc[sizeof(ti_sci->version.firmware_description) + 1];
70 * Output System Firmware version info. Note that since the
71 * 'firmware_description' field is not guaranteed to be zero-
72 * terminated we manually add a \0 terminator if needed. Further
73 * note that we intentionally no longer rely on the extended
74 * printf() formatter '%.*s' to not having to require a more
75 * full-featured printf() implementation.
77 strncpy(fw_desc, ti_sci->version.firmware_description,
78 sizeof(ti_sci->version.firmware_description));
79 fw_desc[sizeof(fw_desc) - 1] = '\0';
81 printf("SYSFW ABI: %d.%d (firmware rev 0x%04x '%s')\n",
82 ti_sci->version.abi_major, ti_sci->version.abi_minor,
83 ti_sci->version.firmware_revision, fw_desc);
86 void mmr_unlock(phys_addr_t base, u32 partition)
88 /* Translate the base address */
89 phys_addr_t part_base = base + partition * CTRL_MMR0_PARTITION_SIZE;
91 /* Unlock the requested partition if locked using two-step sequence */
92 writel(CTRLMMR_LOCK_KICK0_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK0);
93 writel(CTRLMMR_LOCK_KICK1_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK1);
96 bool is_rom_loaded_sysfw(struct rom_extended_boot_data *data)
98 if (strncmp(data->header, K3_ROM_BOOT_HEADER_MAGIC, 7))
101 return data->num_components > 1;
104 DECLARE_GLOBAL_DATA_PTR;
106 #ifdef CONFIG_K3_EARLY_CONS
107 int early_console_init(void)
112 gd->baudrate = CONFIG_BAUDRATE;
114 ret = uclass_get_device_by_seq(UCLASS_SERIAL, CONFIG_K3_EARLY_CONS_IDX,
117 printf("Error getting serial dev for early console! (%d)\n",
122 gd->cur_serial_dev = dev;
123 gd->flags |= GD_FLG_SERIAL_READY;
124 gd->have_console = 1;
130 #if IS_ENABLED(CONFIG_SYS_K3_SPL_ATF)
134 #ifdef CONFIG_SPL_ENV_SUPPORT
139 switch (spl_boot_device()) {
140 case BOOT_DEVICE_MMC2:
141 part = env_get("bootpart");
142 env_set("storage_interface", "mmc");
143 env_set("fw_dev_part", part);
145 case BOOT_DEVICE_SPI:
146 env_set("storage_interface", "ubi");
147 env_set("fw_ubi_mtdpart", "UBI");
148 env_set("fw_ubi_volume", "UBI0");
151 printf("%s from device %u not supported!\n",
152 __func__, spl_boot_device());
158 int load_firmware(char *name_fw, char *name_loadaddr, u32 *loadaddr)
160 struct udevice *fsdev;
164 if (!IS_ENABLED(CONFIG_FS_LOADER))
168 #ifdef CONFIG_SPL_ENV_SUPPORT
169 switch (spl_boot_device()) {
170 case BOOT_DEVICE_MMC2:
171 name = env_get(name_fw);
172 *loadaddr = env_get_hex(name_loadaddr, *loadaddr);
175 printf("Loading rproc fw image from device %u not supported!\n",
183 if (!get_fs_loader(&fsdev)) {
184 size = request_firmware_into_buf(fsdev, name, (void *)*loadaddr,
191 void release_resources_for_core_shutdown(void)
193 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
194 struct ti_sci_dev_ops *dev_ops = &ti_sci->ops.dev_ops;
195 struct ti_sci_proc_ops *proc_ops = &ti_sci->ops.proc_ops;
199 /* Iterate through list of devices to put (shutdown) */
200 for (i = 0; i < ARRAY_SIZE(put_device_ids); i++) {
201 u32 id = put_device_ids[i];
203 ret = dev_ops->put_device(ti_sci, id);
205 panic("Failed to put device %u (%d)\n", id, ret);
208 /* Iterate through list of cores to put (shutdown) */
209 for (i = 0; i < ARRAY_SIZE(put_core_ids); i++) {
210 u32 id = put_core_ids[i];
213 * Queue up the core shutdown request. Note that this call
214 * needs to be followed up by an actual invocation of an WFE
215 * or WFI CPU instruction.
217 ret = proc_ops->proc_shutdown_no_wait(ti_sci, id);
219 panic("Failed sending core %u shutdown message (%d)\n",
224 void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
226 typedef void __noreturn (*image_entry_noargs_t)(void);
227 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
229 int ret, size = 0, shut_cpu = 0;
231 /* Release all the exclusive devices held by SPL before starting ATF */
232 ti_sci->ops.dev_ops.release_exclusive_devices(ti_sci);
236 panic("rproc failed to be initialized (%d)\n", ret);
240 if (!fit_image_info[IMAGE_ID_DM_FW].image_start) {
241 size = load_firmware("name_mcur5f0_0fw", "addr_mcur5f0_0load",
246 * It is assumed that remoteproc device 1 is the corresponding
247 * Cortex-A core which runs ATF. Make sure DT reflects the same.
249 if (!fit_image_info[IMAGE_ID_ATF].image_start)
250 fit_image_info[IMAGE_ID_ATF].image_start =
251 spl_image->entry_point;
253 ret = rproc_load(1, fit_image_info[IMAGE_ID_ATF].image_start, 0x200);
255 panic("%s: ATF failed to load on rproc (%d)\n", __func__, ret);
257 #if (CONFIG_IS_ENABLED(FIT_IMAGE_POST_PROCESS) && IS_ENABLED(CONFIG_SYS_K3_SPL_ATF))
258 /* Authenticate ATF */
259 void *image_addr = (void *)fit_image_info[IMAGE_ID_ATF].image_start;
261 debug("%s: Authenticating image: addr=%lx, size=%ld, os=%s\n", __func__,
262 fit_image_info[IMAGE_ID_ATF].image_start,
263 fit_image_info[IMAGE_ID_ATF].image_len,
264 image_os_match[IMAGE_ID_ATF]);
266 ti_secure_image_post_process(&image_addr,
267 (size_t *)&fit_image_info[IMAGE_ID_ATF].image_len);
269 /* Authenticate OPTEE */
270 image_addr = (void *)fit_image_info[IMAGE_ID_OPTEE].image_start;
272 debug("%s: Authenticating image: addr=%lx, size=%ld, os=%s\n", __func__,
273 fit_image_info[IMAGE_ID_OPTEE].image_start,
274 fit_image_info[IMAGE_ID_OPTEE].image_len,
275 image_os_match[IMAGE_ID_OPTEE]);
277 ti_secure_image_post_process(&image_addr,
278 (size_t *)&fit_image_info[IMAGE_ID_OPTEE].image_len);
282 if (!fit_image_info[IMAGE_ID_DM_FW].image_len &&
283 !(size > 0 && valid_elf_image(loadaddr))) {
288 if (!fit_image_info[IMAGE_ID_DM_FW].image_start) {
289 loadaddr = load_elf_image_phdr(loadaddr);
291 loadaddr = fit_image_info[IMAGE_ID_DM_FW].image_start;
292 if (valid_elf_image(loadaddr))
293 loadaddr = load_elf_image_phdr(loadaddr);
296 debug("%s: jumping to address %x\n", __func__, loadaddr);
299 /* Add an extra newline to differentiate the ATF logs from SPL */
300 printf("Starting ATF on ARM64 core...\n\n");
302 ret = rproc_start(1);
304 panic("%s: ATF failed to start on rproc (%d)\n", __func__, ret);
307 debug("Shutting down...\n");
308 release_resources_for_core_shutdown();
313 image_entry_noargs_t image_entry = (image_entry_noargs_t)loadaddr;
319 #if CONFIG_IS_ENABLED(FIT_IMAGE_POST_PROCESS)
320 void board_fit_image_post_process(const void *fit, int node, void **p_image,
323 #if IS_ENABLED(CONFIG_SYS_K3_SPL_ATF)
329 os = fdt_getprop(fit, node, "os", &len);
330 addr = fdt_getprop_u32_default_node(fit, node, 0, "entry", -1);
332 debug("%s: processing image: addr=%x, size=%d, os=%s\n", __func__,
335 for (i = 0; i < IMAGE_AMT; i++) {
336 if (!strcmp(os, image_os_match[i])) {
337 fit_image_info[i].image_start = addr;
338 fit_image_info[i].image_len = *p_size;
339 debug("%s: matched image for ID %d\n", __func__, i);
344 * Only DM and the DTBs are being authenticated here,
345 * rest will be authenticated when A72 cluster is up
347 if ((i != IMAGE_ID_ATF) && (i != IMAGE_ID_OPTEE))
350 ti_secure_image_post_process(p_image, p_size);
355 #if defined(CONFIG_OF_LIBFDT)
356 int fdt_fixup_msmc_ram(void *blob, char *parent_path, char *node_name)
358 u64 msmc_start = 0, msmc_end = 0, msmc_size, reg[2];
359 struct ti_sci_handle *ti_sci = get_ti_sci_handle();
360 int ret, node, subnode, len, prev_node;
361 u32 range[4], addr, size;
362 const fdt32_t *sub_reg;
364 ti_sci->ops.core_ops.query_msmc(ti_sci, &msmc_start, &msmc_end);
365 msmc_size = msmc_end - msmc_start + 1;
366 debug("%s: msmc_start = 0x%llx, msmc_size = 0x%llx\n", __func__,
367 msmc_start, msmc_size);
369 /* find or create "msmc_sram node */
370 ret = fdt_path_offset(blob, parent_path);
374 node = fdt_find_or_add_subnode(blob, ret, node_name);
378 ret = fdt_setprop_string(blob, node, "compatible", "mmio-sram");
382 reg[0] = cpu_to_fdt64(msmc_start);
383 reg[1] = cpu_to_fdt64(msmc_size);
384 ret = fdt_setprop(blob, node, "reg", reg, sizeof(reg));
388 fdt_setprop_cell(blob, node, "#address-cells", 1);
389 fdt_setprop_cell(blob, node, "#size-cells", 1);
392 range[1] = cpu_to_fdt32(msmc_start >> 32);
393 range[2] = cpu_to_fdt32(msmc_start & 0xffffffff);
394 range[3] = cpu_to_fdt32(msmc_size);
395 ret = fdt_setprop(blob, node, "ranges", range, sizeof(range));
399 subnode = fdt_first_subnode(blob, node);
402 /* Look for invalid subnodes and delete them */
403 while (subnode >= 0) {
404 sub_reg = fdt_getprop(blob, subnode, "reg", &len);
405 addr = fdt_read_number(sub_reg, 1);
407 size = fdt_read_number(sub_reg, 1);
408 debug("%s: subnode = %d, addr = 0x%x. size = 0x%x\n", __func__,
409 subnode, addr, size);
410 if (addr + size > msmc_size ||
411 !strncmp(fdt_get_name(blob, subnode, &len), "sysfw", 5) ||
412 !strncmp(fdt_get_name(blob, subnode, &len), "l3cache", 7)) {
413 fdt_del_node(blob, subnode);
414 debug("%s: deleting subnode %d\n", __func__, subnode);
416 subnode = fdt_first_subnode(blob, node);
418 subnode = fdt_next_subnode(blob, prev_node);
421 subnode = fdt_next_subnode(blob, prev_node);
428 #if defined(CONFIG_OF_SYSTEM_SETUP)
429 int ft_system_setup(void *blob, struct bd_info *bd)
433 ret = fdt_fixup_msmc_ram(blob, "/bus@100000", "sram@70000000");
435 ret = fdt_fixup_msmc_ram(blob, "/interconnect@100000",
438 printf("%s: fixing up msmc ram failed %d\n", __func__, ret);
446 #ifndef CONFIG_SYSRESET
452 enum k3_device_type get_device_type(void)
454 u32 sys_status = readl(K3_SEC_MGR_SYS_STATUS);
456 u32 sys_dev_type = (sys_status & SYS_STATUS_DEV_TYPE_MASK) >>
457 SYS_STATUS_DEV_TYPE_SHIFT;
459 u32 sys_sub_type = (sys_status & SYS_STATUS_SUB_TYPE_MASK) >>
460 SYS_STATUS_SUB_TYPE_SHIFT;
462 switch (sys_dev_type) {
463 case SYS_STATUS_DEV_TYPE_GP:
464 return K3_DEVICE_TYPE_GP;
465 case SYS_STATUS_DEV_TYPE_TEST:
466 return K3_DEVICE_TYPE_TEST;
467 case SYS_STATUS_DEV_TYPE_EMU:
468 return K3_DEVICE_TYPE_EMU;
469 case SYS_STATUS_DEV_TYPE_HS:
470 if (sys_sub_type == SYS_STATUS_SUB_TYPE_VAL_FS)
471 return K3_DEVICE_TYPE_HS_FS;
473 return K3_DEVICE_TYPE_HS_SE;
475 return K3_DEVICE_TYPE_BAD;
479 #if defined(CONFIG_DISPLAY_CPUINFO)
480 static const char *get_device_type_name(void)
482 enum k3_device_type type = get_device_type();
485 case K3_DEVICE_TYPE_GP:
487 case K3_DEVICE_TYPE_TEST:
489 case K3_DEVICE_TYPE_EMU:
491 case K3_DEVICE_TYPE_HS_FS:
493 case K3_DEVICE_TYPE_HS_SE:
500 int print_cpuinfo(void)
514 ret = soc_get_family(soc, name, 64);
519 ret = soc_get_revision(soc, name, 64);
524 printf("%s\n", get_device_type_name());
531 void board_prep_linux(struct bootm_headers *images)
533 debug("Linux kernel Image start = 0x%lx end = 0x%lx\n",
534 images->os.start, images->os.end);
535 __asm_flush_dcache_range(images->os.start,
536 ROUND(images->os.end,
537 CONFIG_SYS_CACHELINE_SIZE));
541 #ifdef CONFIG_CPU_V7R
542 void disable_linefill_optimization(void)
547 * On K3 devices there are 2 conditions where R5F can deadlock:
548 * 1.When software is performing series of store operations to
549 * cacheable write back/write allocate memory region and later
550 * on software execute barrier operation (DSB or DMB). R5F may
551 * hang at the barrier instruction.
552 * 2.When software is performing a mix of load and store operations
553 * within a tight loop and store operations are all writing to
554 * cacheable write back/write allocates memory regions, R5F may
555 * hang at one of the load instruction.
557 * To avoid the above two conditions disable linefill optimization
560 asm("mrc p15, 0, %0, c1, c0, 1" : "=r" (actlr));
561 actlr |= (1 << 13); /* Set DLFO bit */
562 asm("mcr p15, 0, %0, c1, c0, 1" : : "r" (actlr));
566 void remove_fwl_configs(struct fwl_data *fwl_data, size_t fwl_data_size)
568 struct ti_sci_msg_fwl_region region;
569 struct ti_sci_fwl_ops *fwl_ops;
570 struct ti_sci_handle *ti_sci;
573 ti_sci = get_ti_sci_handle();
574 fwl_ops = &ti_sci->ops.fwl_ops;
575 for (i = 0; i < fwl_data_size; i++) {
576 for (j = 0; j < fwl_data[i].regions; j++) {
577 region.fwl_id = fwl_data[i].fwl_id;
579 region.n_permission_regs = 3;
581 fwl_ops->get_fwl_region(ti_sci, ®ion);
583 /* Don't disable the background regions */
584 if (region.control != 0 &&
585 ((region.control & K3_BACKGROUND_FIREWALL_BIT) ==
587 pr_debug("Attempting to disable firewall %5d (%25s)\n",
588 region.fwl_id, fwl_data[i].name);
591 if (fwl_ops->set_fwl_region(ti_sci, ®ion))
592 pr_err("Could not disable firewall %5d (%25s)\n",
593 region.fwl_id, fwl_data[i].name);
599 void spl_enable_dcache(void)
601 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
602 phys_addr_t ram_top = CFG_SYS_SDRAM_BASE;
606 /* reserve TLB table */
607 gd->arch.tlb_size = PGTABLE_SIZE;
609 ram_top += get_effective_memsize();
610 /* keep ram_top in the 32-bit address space */
611 if (ram_top >= 0x100000000)
612 ram_top = (phys_addr_t) 0x100000000;
614 gd->arch.tlb_addr = ram_top - gd->arch.tlb_size;
615 debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
616 gd->arch.tlb_addr + gd->arch.tlb_size);
622 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
623 void spl_board_prepare_for_boot(void)
628 void spl_board_prepare_for_linux(void)
634 int misc_init_r(void)
636 if (IS_ENABLED(CONFIG_TI_AM65_CPSW_NUSS)) {
640 ret = uclass_get_device_by_driver(UCLASS_MISC,
641 DM_DRIVER_GET(am65_cpsw_nuss),
644 printf("Failed to probe am65_cpsw_nuss driver\n");
647 /* Default FIT boot on HS-SE devices */
648 if (get_device_type() == K3_DEVICE_TYPE_HS_SE)
649 env_set("boot_fit", "1");
655 * do_board_detect() - Detect board description
657 * Function to detect board description. This is expected to be
658 * overridden in the SoC family board file where desired.
660 void __weak do_board_detect(void)