1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2019 Fraunhofer AISEC,
4 * Lukas Auer <lukas.auer@aisec.fraunhofer.de>
5 *
6 * Based on common/spl/spl_atf.c
7 */
8 #include <common.h>
9 #include <cpu_func.h>
10 #include <errno.h>
11 #include <hang.h>
12 #include <image.h>
13 #include <spl.h>
14 #include <asm/global_data.h>
15 #include <asm/smp.h>
16 #include <opensbi.h>
17 #include <linux/libfdt.h>
18
19 DECLARE_GLOBAL_DATA_PTR;
20
21 struct fw_dynamic_info opensbi_info;
22
spl_opensbi_find_uboot_node(void * blob,int * uboot_node)23 static int spl_opensbi_find_uboot_node(void *blob, int *uboot_node)
24 {
25 int fit_images_node, node;
26 const char *fit_os;
27
28 fit_images_node = fdt_path_offset(blob, "/fit-images");
29 if (fit_images_node < 0)
30 return -ENODEV;
31
32 fdt_for_each_subnode(node, blob, fit_images_node) {
33 fit_os = fdt_getprop(blob, node, FIT_OS_PROP, NULL);
34 if (!fit_os)
35 continue;
36
37 if (genimg_get_os_id(fit_os) == IH_OS_U_BOOT) {
38 *uboot_node = node;
39 return 0;
40 }
41 }
42
43 return -ENODEV;
44 }
45
spl_invoke_opensbi(struct spl_image_info * spl_image)46 void spl_invoke_opensbi(struct spl_image_info *spl_image)
47 {
48 int ret, uboot_node;
49 ulong uboot_entry;
50 void (*opensbi_entry)(ulong hartid, ulong dtb, ulong info);
51
52 if (!spl_image->fdt_addr) {
53 pr_err("No device tree specified in SPL image\n");
54 hang();
55 }
56
57 /* Find U-Boot image in /fit-images */
58 ret = spl_opensbi_find_uboot_node(spl_image->fdt_addr, &uboot_node);
59 if (ret) {
60 pr_err("Can't find U-Boot node, %d\n", ret);
61 hang();
62 }
63
64 /* Get U-Boot entry point */
65 ret = fit_image_get_entry(spl_image->fdt_addr, uboot_node, &uboot_entry);
66 if (ret)
67 ret = fit_image_get_load(spl_image->fdt_addr, uboot_node, &uboot_entry);
68
69 /* Prepare obensbi_info object */
70 opensbi_info.magic = FW_DYNAMIC_INFO_MAGIC_VALUE;
71 opensbi_info.version = FW_DYNAMIC_INFO_VERSION;
72 opensbi_info.next_addr = uboot_entry;
73 opensbi_info.next_mode = FW_DYNAMIC_INFO_NEXT_MODE_S;
74 opensbi_info.options = SBI_SCRATCH_NO_BOOT_PRINTS;
75 opensbi_info.boot_hart = gd->arch.boot_hart;
76
77 opensbi_entry = (void (*)(ulong, ulong, ulong))spl_image->entry_point;
78 invalidate_icache_all();
79
80 #ifdef CONFIG_SPL_SMP
81 /*
82 * Start OpenSBI on all secondary harts and wait for acknowledgment.
83 *
84 * OpenSBI first relocates itself to its link address. This is done by
85 * the main hart. To make sure no hart is still running U-Boot SPL
86 * during relocation, we wait for all secondary harts to acknowledge
87 * the call-function request before entering OpenSBI on the main hart.
88 * Otherwise, code corruption can occur if the link address ranges of
89 * U-Boot SPL and OpenSBI overlap.
90 */
91 ret = smp_call_function((ulong)spl_image->entry_point,
92 (ulong)spl_image->fdt_addr,
93 (ulong)&opensbi_info, 1);
94 if (ret)
95 hang();
96 #endif
97 opensbi_entry(gd->arch.boot_hart, (ulong)spl_image->fdt_addr,
98 (ulong)&opensbi_info);
99 }
100