1
2
3
4
5
6
7
8
9#include <common.h>
10#include <command.h>
11#include <efi_loader.h>
12#include <errno.h>
13#include <libfdt.h>
14#include <libfdt_env.h>
15#include <memalign.h>
16#include <asm/global_data.h>
17
18DECLARE_GLOBAL_DATA_PTR;
19
20
21
22
23
24
25
26
27
28static struct efi_device_path_file_path bootefi_image_path[] = {
29 {
30 .dp.type = DEVICE_PATH_TYPE_MEDIA_DEVICE,
31 .dp.sub_type = DEVICE_PATH_SUB_TYPE_FILE_PATH,
32 .dp.length = sizeof(bootefi_image_path[0]),
33 .str = { 'b','o','o','t','e','f','i' },
34 }, {
35 .dp.type = DEVICE_PATH_TYPE_END,
36 .dp.sub_type = DEVICE_PATH_SUB_TYPE_END,
37 .dp.length = sizeof(bootefi_image_path[0]),
38 }
39};
40
41static struct efi_device_path_file_path bootefi_device_path[] = {
42 {
43 .dp.type = DEVICE_PATH_TYPE_MEDIA_DEVICE,
44 .dp.sub_type = DEVICE_PATH_SUB_TYPE_FILE_PATH,
45 .dp.length = sizeof(bootefi_image_path[0]),
46 .str = { 'b','o','o','t','e','f','i' },
47 }, {
48 .dp.type = DEVICE_PATH_TYPE_END,
49 .dp.sub_type = DEVICE_PATH_SUB_TYPE_END,
50 .dp.length = sizeof(bootefi_image_path[0]),
51 }
52};
53
54static efi_status_t bootefi_open_dp(void *handle, efi_guid_t *protocol,
55 void **protocol_interface, void *agent_handle,
56 void *controller_handle, uint32_t attributes)
57{
58 *protocol_interface = bootefi_device_path;
59 return EFI_SUCCESS;
60}
61
62
63static struct efi_loaded_image loaded_image_info = {
64 .device_handle = bootefi_device_path,
65 .file_path = bootefi_image_path,
66};
67
68
69static struct efi_object loaded_image_info_obj = {
70 .handle = &loaded_image_info,
71 .protocols = {
72 {
73
74
75
76
77 .guid = &efi_guid_loaded_image,
78 .open = &efi_return_handle,
79 },
80 {
81
82
83
84
85 .guid = &efi_guid_device_path,
86 .open = &bootefi_open_dp,
87 },
88 },
89};
90
91
92static struct efi_object bootefi_device_obj = {
93 .handle = bootefi_device_path,
94 .protocols = {
95 {
96
97
98 .guid = &efi_guid_device_path,
99 .open = &bootefi_open_dp,
100 }
101 },
102};
103
104static void *copy_fdt(void *fdt)
105{
106 u64 fdt_size = fdt_totalsize(fdt);
107 unsigned long fdt_ram_start = -1L, fdt_pages;
108 u64 new_fdt_addr;
109 void *new_fdt;
110 int i;
111
112 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
113 u64 ram_start = gd->bd->bi_dram[i].start;
114 u64 ram_size = gd->bd->bi_dram[i].size;
115
116 if (!ram_size)
117 continue;
118
119 if (ram_start < fdt_ram_start)
120 fdt_ram_start = ram_start;
121 }
122
123
124 fdt_size = ALIGN(fdt_size + 4096, 4096);
125 fdt_pages = fdt_size >> EFI_PAGE_SHIFT;
126
127
128 new_fdt_addr = fdt_ram_start + (128 * 1024 * 1024) + fdt_size;
129 if (efi_allocate_pages(1, EFI_BOOT_SERVICES_DATA, fdt_pages,
130 &new_fdt_addr) != EFI_SUCCESS) {
131
132 new_fdt_addr = (ulong)memalign(4096, fdt_size);
133 }
134 new_fdt = (void*)(ulong)new_fdt_addr;
135 memcpy(new_fdt, fdt, fdt_totalsize(fdt));
136 fdt_set_totalsize(new_fdt, fdt_size);
137
138 return new_fdt;
139}
140
141
142
143
144
145static unsigned long do_bootefi_exec(void *efi, void *fdt)
146{
147 ulong (*entry)(void *image_handle, struct efi_system_table *st);
148 ulong fdt_pages, fdt_size, fdt_start, fdt_end;
149 bootm_headers_t img = { 0 };
150
151
152
153
154
155 efi_save_gd();
156
157 if (fdt && !fdt_check_header(fdt)) {
158
159 fdt = copy_fdt(fdt);
160
161 if (image_setup_libfdt(&img, fdt, 0, NULL)) {
162 printf("ERROR: Failed to process device tree\n");
163 return -EINVAL;
164 }
165
166
167 systab.tables[0].guid = EFI_FDT_GUID;
168 systab.tables[0].table = fdt;
169 systab.nr_tables = 1;
170
171
172 fdt_start = ((ulong)fdt) & ~EFI_PAGE_MASK;
173 fdt_end = ((ulong)fdt) + fdt_totalsize(fdt);
174 fdt_size = (fdt_end - fdt_start) + EFI_PAGE_MASK;
175 fdt_pages = fdt_size >> EFI_PAGE_SHIFT;
176
177 fdt_pages += 2;
178 efi_add_memory_map(fdt_start, fdt_pages,
179 EFI_BOOT_SERVICES_DATA, true);
180 } else {
181 printf("WARNING: Invalid device tree, expect boot to fail\n");
182 systab.nr_tables = 0;
183 }
184
185
186 entry = efi_load_pe(efi, &loaded_image_info);
187 if (!entry)
188 return -ENOENT;
189
190
191 INIT_LIST_HEAD(&efi_obj_list);
192 list_add_tail(&loaded_image_info_obj.link, &efi_obj_list);
193 list_add_tail(&bootefi_device_obj.link, &efi_obj_list);
194#ifdef CONFIG_PARTITIONS
195 efi_disk_register();
196#endif
197#ifdef CONFIG_LCD
198 efi_gop_register();
199#endif
200#ifdef CONFIG_NET
201 void *nethandle = loaded_image_info.device_handle;
202 efi_net_register(&nethandle);
203
204 if (!memcmp(bootefi_device_path[0].str, "N\0e\0t", 6))
205 loaded_image_info.device_handle = nethandle;
206#endif
207
208
209 debug("%s:%d Jumping to 0x%lx\n", __func__, __LINE__, (long)entry);
210
211 if (setjmp(&loaded_image_info.exit_jmp)) {
212 efi_status_t status = loaded_image_info.exit_status;
213 return status == EFI_SUCCESS ? 0 : -EINVAL;
214 }
215
216 return entry(&loaded_image_info, &systab);
217}
218
219
220
221static int do_bootefi(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
222{
223 char *saddr, *sfdt;
224 unsigned long addr, fdt_addr = 0;
225 int r = 0;
226
227 if (argc < 2)
228 return 1;
229 saddr = argv[1];
230
231 addr = simple_strtoul(saddr, NULL, 16);
232
233 if (argc > 2) {
234 sfdt = argv[2];
235 fdt_addr = simple_strtoul(sfdt, NULL, 16);
236 }
237
238 printf("## Starting EFI application at 0x%08lx ...\n", addr);
239 r = do_bootefi_exec((void *)addr, (void*)fdt_addr);
240 printf("## Application terminated, r = %d\n", r);
241
242 if (r != 0)
243 r = 1;
244
245 return r;
246}
247
248#ifdef CONFIG_SYS_LONGHELP
249static char bootefi_help_text[] =
250 "<image address> [fdt address]\n"
251 " - boot EFI payload stored at address <image address>.\n"
252 " If specified, the device tree located at <fdt address> gets\n"
253 " exposed as EFI configuration table.\n";
254#endif
255
256U_BOOT_CMD(
257 bootefi, 3, 0, do_bootefi,
258 "Boots an EFI payload from memory",
259 bootefi_help_text
260);
261
262void efi_set_bootdev(const char *dev, const char *devnr, const char *path)
263{
264 __maybe_unused struct blk_desc *desc;
265 char devname[32] = { 0 };
266 char *colon;
267
268
269 snprintf(devname, sizeof(devname), "%s%s", dev, devnr);
270 colon = strchr(devname, ':');
271
272#ifdef CONFIG_ISO_PARTITION
273
274 desc = blk_get_dev(dev, simple_strtol(devnr, NULL, 10));
275 if (desc && (desc->type != DEV_TYPE_UNKNOWN) &&
276 (desc->part_type == PART_TYPE_ISO)) {
277 if (!colon)
278 snprintf(devname, sizeof(devname), "%s%s:1", dev,
279 devnr);
280 colon = NULL;
281 }
282#endif
283
284 if (colon)
285 *colon = '\0';
286
287
288 memset(bootefi_device_path[0].str, 0, sizeof(bootefi_device_path[0].str));
289 ascii2unicode(bootefi_device_path[0].str, devname);
290
291
292 memset(bootefi_image_path[0].str, 0, sizeof(bootefi_image_path[0].str));
293 snprintf(devname, sizeof(devname), "%s", path);
294 ascii2unicode(bootefi_image_path[0].str, devname);
295}
296