1f739fcd8STom Rini // SPDX-License-Identifier: GPL-2.0+ 2b9939336SAlexander Graf /* 3b9939336SAlexander Graf * EFI application loader 4b9939336SAlexander Graf * 5b9939336SAlexander Graf * Copyright (c) 2016 Alexander Graf 6b9939336SAlexander Graf */ 7b9939336SAlexander Graf 8d78e40d6SHeinrich Schuchardt #include <charset.h> 9b9939336SAlexander Graf #include <common.h> 10b9939336SAlexander Graf #include <command.h> 119d922450SSimon Glass #include <dm.h> 12b9939336SAlexander Graf #include <efi_loader.h> 13d78e40d6SHeinrich Schuchardt #include <efi_selftest.h> 14b9939336SAlexander Graf #include <errno.h> 15b08c8c48SMasahiro Yamada #include <linux/libfdt.h> 16b08c8c48SMasahiro Yamada #include <linux/libfdt_env.h> 17354264b3SAlexander Graf #include <mapmem.h> 18ad0c1a3dSAlexander Graf #include <memalign.h> 190d9d501fSAlexander Graf #include <asm/global_data.h> 20e275458cSSimon Glass #include <asm-generic/sections.h> 21c3b11deaSHeinrich Schuchardt #include <asm-generic/unaligned.h> 22e275458cSSimon Glass #include <linux/linkage.h> 230d9d501fSAlexander Graf 24dc500c36SMark Kettenis #ifdef CONFIG_ARMV7_NONSEC 25dc500c36SMark Kettenis #include <asm/armv7.h> 26dc500c36SMark Kettenis #include <asm/secure.h> 27dc500c36SMark Kettenis #endif 28dc500c36SMark Kettenis 290d9d501fSAlexander Graf DECLARE_GLOBAL_DATA_PTR; 30b9939336SAlexander Graf 31fc225e60SHeinrich Schuchardt #define OBJ_LIST_NOT_INITIALIZED 1 32fc225e60SHeinrich Schuchardt 33fc225e60SHeinrich Schuchardt static efi_status_t efi_obj_list_initialized = OBJ_LIST_NOT_INITIALIZED; 347cbc1241SHeinrich Schuchardt 3595c5553eSRob Clark static struct efi_device_path *bootefi_image_path; 3695c5553eSRob Clark static struct efi_device_path *bootefi_device_path; 37b9939336SAlexander Graf 387cbc1241SHeinrich Schuchardt /* Initialize and populate EFI object list */ 39fc225e60SHeinrich Schuchardt efi_status_t efi_init_obj_list(void) 407cbc1241SHeinrich Schuchardt { 41fc225e60SHeinrich Schuchardt efi_status_t ret = EFI_SUCCESS; 42fc225e60SHeinrich Schuchardt 43098a6cddSHeinrich Schuchardt /* Initialize once only */ 44fc225e60SHeinrich Schuchardt if (efi_obj_list_initialized != OBJ_LIST_NOT_INITIALIZED) 45fc225e60SHeinrich Schuchardt return efi_obj_list_initialized; 467cbc1241SHeinrich Schuchardt 47640adadfSHeinrich Schuchardt /* Initialize system table */ 48640adadfSHeinrich Schuchardt ret = efi_initialize_system_table(); 49640adadfSHeinrich Schuchardt if (ret != EFI_SUCCESS) 50640adadfSHeinrich Schuchardt goto out; 51640adadfSHeinrich Schuchardt 5205ef48a2SHeinrich Schuchardt /* Initialize EFI driver uclass */ 53fc225e60SHeinrich Schuchardt ret = efi_driver_init(); 54fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 55fc225e60SHeinrich Schuchardt goto out; 5605ef48a2SHeinrich Schuchardt 57fc225e60SHeinrich Schuchardt ret = efi_console_register(); 58fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 59fc225e60SHeinrich Schuchardt goto out; 607cbc1241SHeinrich Schuchardt #ifdef CONFIG_PARTITIONS 61fc225e60SHeinrich Schuchardt ret = efi_disk_register(); 62fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 63fc225e60SHeinrich Schuchardt goto out; 647cbc1241SHeinrich Schuchardt #endif 657cbc1241SHeinrich Schuchardt #if defined(CONFIG_LCD) || defined(CONFIG_DM_VIDEO) 66fc225e60SHeinrich Schuchardt ret = efi_gop_register(); 67fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 68fc225e60SHeinrich Schuchardt goto out; 697cbc1241SHeinrich Schuchardt #endif 70092f2f35SJoe Hershberger #ifdef CONFIG_NET 71fc225e60SHeinrich Schuchardt ret = efi_net_register(); 72fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 73fc225e60SHeinrich Schuchardt goto out; 747cbc1241SHeinrich Schuchardt #endif 7586df34d4SBin Meng #ifdef CONFIG_GENERATE_ACPI_TABLE 7686df34d4SBin Meng ret = efi_acpi_register(); 7786df34d4SBin Meng if (ret != EFI_SUCCESS) 7886df34d4SBin Meng goto out; 7986df34d4SBin Meng #endif 807cbc1241SHeinrich Schuchardt #ifdef CONFIG_GENERATE_SMBIOS_TABLE 81fc225e60SHeinrich Schuchardt ret = efi_smbios_register(); 82fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 83fc225e60SHeinrich Schuchardt goto out; 847cbc1241SHeinrich Schuchardt #endif 85fc225e60SHeinrich Schuchardt ret = efi_watchdog_register(); 86fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 87fc225e60SHeinrich Schuchardt goto out; 887cbc1241SHeinrich Schuchardt 897cbc1241SHeinrich Schuchardt /* Initialize EFI runtime services */ 90fc225e60SHeinrich Schuchardt ret = efi_reset_system_init(); 91fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 92fc225e60SHeinrich Schuchardt goto out; 93fc225e60SHeinrich Schuchardt 94fc225e60SHeinrich Schuchardt out: 95fc225e60SHeinrich Schuchardt efi_obj_list_initialized = ret; 96fc225e60SHeinrich Schuchardt return ret; 977cbc1241SHeinrich Schuchardt } 987cbc1241SHeinrich Schuchardt 99d78e40d6SHeinrich Schuchardt /* 100c3b11deaSHeinrich Schuchardt * Allow unaligned memory access. 101c3b11deaSHeinrich Schuchardt * 102c3b11deaSHeinrich Schuchardt * This routine is overridden by architectures providing this feature. 103c3b11deaSHeinrich Schuchardt */ 104c3b11deaSHeinrich Schuchardt void __weak allow_unaligned(void) 105c3b11deaSHeinrich Schuchardt { 106c3b11deaSHeinrich Schuchardt } 107c3b11deaSHeinrich Schuchardt 108c3b11deaSHeinrich Schuchardt /* 109d78e40d6SHeinrich Schuchardt * Set the load options of an image from an environment variable. 110d78e40d6SHeinrich Schuchardt * 111d78e40d6SHeinrich Schuchardt * @loaded_image_info: the image 112d78e40d6SHeinrich Schuchardt * @env_var: name of the environment variable 113d78e40d6SHeinrich Schuchardt */ 114d78e40d6SHeinrich Schuchardt static void set_load_options(struct efi_loaded_image *loaded_image_info, 115d78e40d6SHeinrich Schuchardt const char *env_var) 116d78e40d6SHeinrich Schuchardt { 117d78e40d6SHeinrich Schuchardt size_t size; 118d78e40d6SHeinrich Schuchardt const char *env = env_get(env_var); 119*7086a71aSHeinrich Schuchardt u16 *pos; 120d78e40d6SHeinrich Schuchardt 121d78e40d6SHeinrich Schuchardt loaded_image_info->load_options = NULL; 122d78e40d6SHeinrich Schuchardt loaded_image_info->load_options_size = 0; 123d78e40d6SHeinrich Schuchardt if (!env) 124d78e40d6SHeinrich Schuchardt return; 125*7086a71aSHeinrich Schuchardt size = utf8_utf16_strlen(env) + 1; 126d78e40d6SHeinrich Schuchardt loaded_image_info->load_options = calloc(size, sizeof(u16)); 127d78e40d6SHeinrich Schuchardt if (!loaded_image_info->load_options) { 128d78e40d6SHeinrich Schuchardt printf("ERROR: Out of memory\n"); 129d78e40d6SHeinrich Schuchardt return; 130d78e40d6SHeinrich Schuchardt } 131*7086a71aSHeinrich Schuchardt pos = loaded_image_info->load_options; 132*7086a71aSHeinrich Schuchardt utf8_utf16_strcpy(&pos, env); 133d78e40d6SHeinrich Schuchardt loaded_image_info->load_options_size = size * 2; 134d78e40d6SHeinrich Schuchardt } 135d78e40d6SHeinrich Schuchardt 1369dff4900SSimon Glass /** 1379dff4900SSimon Glass * copy_fdt() - Copy the device tree to a new location available to EFI 1389dff4900SSimon Glass * 1399dff4900SSimon Glass * The FDT is relocated into a suitable location within the EFI memory map. 1409dff4900SSimon Glass * An additional 12KB is added to the space in case the device tree needs to be 1419dff4900SSimon Glass * expanded later with fdt_open_into(). 1429dff4900SSimon Glass * 1439dff4900SSimon Glass * @fdt_addr: On entry, address of start of FDT. On exit, address of relocated 1449dff4900SSimon Glass * FDT start 1459dff4900SSimon Glass * @fdt_sizep: Returns new size of FDT, including 1469dff4900SSimon Glass * @return new relocated address of FDT 1479dff4900SSimon Glass */ 1489dff4900SSimon Glass static efi_status_t copy_fdt(ulong *fdt_addrp, ulong *fdt_sizep) 1490d9d501fSAlexander Graf { 150ad0c1a3dSAlexander Graf unsigned long fdt_ram_start = -1L, fdt_pages; 1519dff4900SSimon Glass efi_status_t ret = 0; 1529dff4900SSimon Glass void *fdt, *new_fdt; 153ad0c1a3dSAlexander Graf u64 new_fdt_addr; 1549dff4900SSimon Glass uint fdt_size; 155ad0c1a3dSAlexander Graf int i; 1560d9d501fSAlexander Graf 157ad0c1a3dSAlexander Graf for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 158ad0c1a3dSAlexander Graf u64 ram_start = gd->bd->bi_dram[i].start; 159ad0c1a3dSAlexander Graf u64 ram_size = gd->bd->bi_dram[i].size; 1600d9d501fSAlexander Graf 161ad0c1a3dSAlexander Graf if (!ram_size) 162ad0c1a3dSAlexander Graf continue; 163ad0c1a3dSAlexander Graf 164ad0c1a3dSAlexander Graf if (ram_start < fdt_ram_start) 165ad0c1a3dSAlexander Graf fdt_ram_start = ram_start; 166ad0c1a3dSAlexander Graf } 167ad0c1a3dSAlexander Graf 168bc9a638aSSimon Glass /* 169bc9a638aSSimon Glass * Give us at least 4KB of breathing room in case the device tree needs 170bc9a638aSSimon Glass * to be expanded later. Round up to the nearest EFI page boundary. 171bc9a638aSSimon Glass */ 1729dff4900SSimon Glass fdt = map_sysmem(*fdt_addrp, 0); 1739dff4900SSimon Glass fdt_size = fdt_totalsize(fdt); 1749dff4900SSimon Glass fdt_size += 4096 * 3; 175bc9a638aSSimon Glass fdt_size = ALIGN(fdt_size + EFI_PAGE_SIZE - 1, EFI_PAGE_SIZE); 176ad0c1a3dSAlexander Graf fdt_pages = fdt_size >> EFI_PAGE_SHIFT; 177ad0c1a3dSAlexander Graf 178baf70c02SSimon Glass /* Safe fdt location is at 127MB */ 179baf70c02SSimon Glass new_fdt_addr = fdt_ram_start + (127 * 1024 * 1024) + fdt_size; 1809dff4900SSimon Glass ret = efi_allocate_pages(EFI_ALLOCATE_MAX_ADDRESS, 181e09159c8SHeinrich Schuchardt EFI_RUNTIME_SERVICES_DATA, fdt_pages, 1829dff4900SSimon Glass &new_fdt_addr); 1839dff4900SSimon Glass if (ret != EFI_SUCCESS) { 184ad0c1a3dSAlexander Graf /* If we can't put it there, put it somewhere */ 185a44bffccSxypron.glpk@gmx.de new_fdt_addr = (ulong)memalign(EFI_PAGE_SIZE, fdt_size); 1869dff4900SSimon Glass ret = efi_allocate_pages(EFI_ALLOCATE_MAX_ADDRESS, 187e09159c8SHeinrich Schuchardt EFI_RUNTIME_SERVICES_DATA, fdt_pages, 1889dff4900SSimon Glass &new_fdt_addr); 1899dff4900SSimon Glass if (ret != EFI_SUCCESS) { 19085a6e9b3SAlexander Graf printf("ERROR: Failed to reserve space for FDT\n"); 1919dff4900SSimon Glass goto done; 192ad0c1a3dSAlexander Graf } 19385a6e9b3SAlexander Graf } 19485a6e9b3SAlexander Graf 1959dff4900SSimon Glass new_fdt = map_sysmem(new_fdt_addr, fdt_size); 1960d9d501fSAlexander Graf memcpy(new_fdt, fdt, fdt_totalsize(fdt)); 1970d9d501fSAlexander Graf fdt_set_totalsize(new_fdt, fdt_size); 1980d9d501fSAlexander Graf 1999dff4900SSimon Glass *fdt_addrp = new_fdt_addr; 2009dff4900SSimon Glass *fdt_sizep = fdt_size; 2019dff4900SSimon Glass done: 2029dff4900SSimon Glass return ret; 2030d9d501fSAlexander Graf } 2040d9d501fSAlexander Graf 2053eb0841bSHeinrich Schuchardt static efi_status_t efi_do_enter( 2062074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st, 207c6fa5df6SAlexander Graf EFIAPI efi_status_t (*entry)( 208c6fa5df6SAlexander Graf efi_handle_t image_handle, 209b06d8ac3Sxypron.glpk@gmx.de struct efi_system_table *st)) 210b06d8ac3Sxypron.glpk@gmx.de { 211b06d8ac3Sxypron.glpk@gmx.de efi_status_t ret = EFI_LOAD_ERROR; 212b06d8ac3Sxypron.glpk@gmx.de 213b06d8ac3Sxypron.glpk@gmx.de if (entry) 214b06d8ac3Sxypron.glpk@gmx.de ret = entry(image_handle, st); 215b06d8ac3Sxypron.glpk@gmx.de st->boottime->exit(image_handle, ret, 0, NULL); 216b06d8ac3Sxypron.glpk@gmx.de return ret; 217b06d8ac3Sxypron.glpk@gmx.de } 218b06d8ac3Sxypron.glpk@gmx.de 219ec6617c3SAlison Wang #ifdef CONFIG_ARM64 220c6fa5df6SAlexander Graf static efi_status_t efi_run_in_el2(EFIAPI efi_status_t (*entry)( 2212074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st), 2222074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st) 223ec6617c3SAlison Wang { 224ec6617c3SAlison Wang /* Enable caches again */ 225ec6617c3SAlison Wang dcache_enable(); 226ec6617c3SAlison Wang 227b06d8ac3Sxypron.glpk@gmx.de return efi_do_enter(image_handle, st, entry); 228ec6617c3SAlison Wang } 229ec6617c3SAlison Wang #endif 230ec6617c3SAlison Wang 231dc500c36SMark Kettenis #ifdef CONFIG_ARMV7_NONSEC 232f17f2001SMark Kettenis static bool is_nonsec; 233f17f2001SMark Kettenis 234dc500c36SMark Kettenis static efi_status_t efi_run_in_hyp(EFIAPI efi_status_t (*entry)( 235dc500c36SMark Kettenis efi_handle_t image_handle, struct efi_system_table *st), 236dc500c36SMark Kettenis efi_handle_t image_handle, struct efi_system_table *st) 237dc500c36SMark Kettenis { 238dc500c36SMark Kettenis /* Enable caches again */ 239dc500c36SMark Kettenis dcache_enable(); 240dc500c36SMark Kettenis 241f17f2001SMark Kettenis is_nonsec = true; 242f17f2001SMark Kettenis 243dc500c36SMark Kettenis return efi_do_enter(image_handle, st, entry); 244dc500c36SMark Kettenis } 245dc500c36SMark Kettenis #endif 246dc500c36SMark Kettenis 247416e07e2SSimon Glass /* 248416e07e2SSimon Glass * efi_carve_out_dt_rsv() - Carve out DT reserved memory ranges 249416e07e2SSimon Glass * 250416e07e2SSimon Glass * The mem_rsv entries of the FDT are added to the memory map. Any failures are 251416e07e2SSimon Glass * ignored because this is not critical and we would rather continue to try to 252416e07e2SSimon Glass * boot. 253416e07e2SSimon Glass * 254416e07e2SSimon Glass * @fdt: Pointer to device tree 255416e07e2SSimon Glass */ 256416e07e2SSimon Glass static void efi_carve_out_dt_rsv(void *fdt) 257806d2fa8SAlexander Graf { 258806d2fa8SAlexander Graf int nr_rsv, i; 259806d2fa8SAlexander Graf uint64_t addr, size, pages; 260806d2fa8SAlexander Graf 261806d2fa8SAlexander Graf nr_rsv = fdt_num_mem_rsv(fdt); 262806d2fa8SAlexander Graf 263806d2fa8SAlexander Graf /* Look for an existing entry and add it to the efi mem map. */ 264806d2fa8SAlexander Graf for (i = 0; i < nr_rsv; i++) { 265806d2fa8SAlexander Graf if (fdt_get_mem_rsv(fdt, i, &addr, &size) != 0) 266806d2fa8SAlexander Graf continue; 267806d2fa8SAlexander Graf 268806d2fa8SAlexander Graf pages = ALIGN(size, EFI_PAGE_SIZE) >> EFI_PAGE_SHIFT; 269416e07e2SSimon Glass if (!efi_add_memory_map(addr, pages, EFI_RESERVED_MEMORY_TYPE, 270416e07e2SSimon Glass false)) 271416e07e2SSimon Glass printf("FDT memrsv map %d: Failed to add to map\n", i); 272806d2fa8SAlexander Graf } 273806d2fa8SAlexander Graf } 274806d2fa8SAlexander Graf 2759dff4900SSimon Glass static efi_status_t efi_install_fdt(ulong fdt_addr) 276bc4f9133SHeinrich Schuchardt { 277bc4f9133SHeinrich Schuchardt bootm_headers_t img = { 0 }; 2789dff4900SSimon Glass ulong fdt_pages, fdt_size, fdt_start; 279bc4f9133SHeinrich Schuchardt efi_status_t ret; 2809dff4900SSimon Glass void *fdt; 281bc4f9133SHeinrich Schuchardt 2829dff4900SSimon Glass fdt = map_sysmem(fdt_addr, 0); 283bc4f9133SHeinrich Schuchardt if (fdt_check_header(fdt)) { 284bc4f9133SHeinrich Schuchardt printf("ERROR: invalid device tree\n"); 285bc4f9133SHeinrich Schuchardt return EFI_INVALID_PARAMETER; 286bc4f9133SHeinrich Schuchardt } 287bc4f9133SHeinrich Schuchardt 288bc4f9133SHeinrich Schuchardt /* Prepare fdt for payload */ 2899dff4900SSimon Glass ret = copy_fdt(&fdt_addr, &fdt_size); 2909dff4900SSimon Glass if (ret) 2919dff4900SSimon Glass return ret; 292bc4f9133SHeinrich Schuchardt 2939dff4900SSimon Glass unmap_sysmem(fdt); 2949dff4900SSimon Glass fdt = map_sysmem(fdt_addr, 0); 2959dff4900SSimon Glass fdt_size = fdt_totalsize(fdt); 296bc4f9133SHeinrich Schuchardt if (image_setup_libfdt(&img, fdt, 0, NULL)) { 297bc4f9133SHeinrich Schuchardt printf("ERROR: failed to process device tree\n"); 298bc4f9133SHeinrich Schuchardt return EFI_LOAD_ERROR; 299bc4f9133SHeinrich Schuchardt } 300bc4f9133SHeinrich Schuchardt 301416e07e2SSimon Glass efi_carve_out_dt_rsv(fdt); 302806d2fa8SAlexander Graf 303bc4f9133SHeinrich Schuchardt /* Link to it in the efi tables */ 304bc4f9133SHeinrich Schuchardt ret = efi_install_configuration_table(&efi_guid_fdt, fdt); 305bc4f9133SHeinrich Schuchardt if (ret != EFI_SUCCESS) 306bc4f9133SHeinrich Schuchardt return EFI_OUT_OF_RESOURCES; 307bc4f9133SHeinrich Schuchardt 308bc4f9133SHeinrich Schuchardt /* And reserve the space in the memory map */ 3099dff4900SSimon Glass fdt_start = fdt_addr; 310bc4f9133SHeinrich Schuchardt fdt_pages = fdt_size >> EFI_PAGE_SHIFT; 3119dff4900SSimon Glass 312bc4f9133SHeinrich Schuchardt ret = efi_add_memory_map(fdt_start, fdt_pages, 313bc4f9133SHeinrich Schuchardt EFI_BOOT_SERVICES_DATA, true); 3149dff4900SSimon Glass 315bc4f9133SHeinrich Schuchardt return ret; 316bc4f9133SHeinrich Schuchardt } 317bc4f9133SHeinrich Schuchardt 318b9939336SAlexander Graf /* 319b9939336SAlexander Graf * Load an EFI payload into a newly allocated piece of memory, register all 320b9939336SAlexander Graf * EFI objects it would want to access and jump to it. 321b9939336SAlexander Graf */ 322bc4f9133SHeinrich Schuchardt static efi_status_t do_bootefi_exec(void *efi, 32395c5553eSRob Clark struct efi_device_path *device_path, 32495c5553eSRob Clark struct efi_device_path *image_path) 325b9939336SAlexander Graf { 32695c5553eSRob Clark struct efi_loaded_image loaded_image_info = {}; 32795c5553eSRob Clark struct efi_object loaded_image_info_obj = {}; 32858bc69d2SAlexander Graf struct efi_object mem_obj = {}; 329bf19273eSRob Clark struct efi_device_path *memdp = NULL; 33045204b10SHeinrich Schuchardt efi_status_t ret; 33195c5553eSRob Clark 332c6fa5df6SAlexander Graf EFIAPI efi_status_t (*entry)(efi_handle_t image_handle, 333c6fa5df6SAlexander Graf struct efi_system_table *st); 334b9939336SAlexander Graf 335bf19273eSRob Clark /* 336bf19273eSRob Clark * Special case for efi payload not loaded from disk, such as 337bf19273eSRob Clark * 'bootefi hello' or for example payload loaded directly into 338bf19273eSRob Clark * memory via jtag/etc: 339bf19273eSRob Clark */ 340bf19273eSRob Clark if (!device_path && !image_path) { 341bf19273eSRob Clark printf("WARNING: using memory device/image path, this may confuse some payloads!\n"); 342bf19273eSRob Clark /* actual addresses filled in after efi_load_pe() */ 343bf19273eSRob Clark memdp = efi_dp_from_mem(0, 0, 0); 344bf19273eSRob Clark device_path = image_path = memdp; 34558bc69d2SAlexander Graf efi_add_handle(&mem_obj); 34658bc69d2SAlexander Graf 34758bc69d2SAlexander Graf ret = efi_add_protocol(mem_obj.handle, &efi_guid_device_path, 34858bc69d2SAlexander Graf device_path); 34958bc69d2SAlexander Graf if (ret != EFI_SUCCESS) 35058bc69d2SAlexander Graf goto exit; 351bf19273eSRob Clark } else { 352bf19273eSRob Clark assert(device_path && image_path); 353bf19273eSRob Clark } 354bf19273eSRob Clark 35595c5553eSRob Clark efi_setup_loaded_image(&loaded_image_info, &loaded_image_info_obj, 35695c5553eSRob Clark device_path, image_path); 35795c5553eSRob Clark 358b9939336SAlexander Graf /* 359b9939336SAlexander Graf * gd lives in a fixed register which may get clobbered while we execute 360b9939336SAlexander Graf * the payload. So save it here and restore it on every callback entry 361b9939336SAlexander Graf */ 362b9939336SAlexander Graf efi_save_gd(); 363b9939336SAlexander Graf 364b57f48a8SHeinrich Schuchardt /* Transfer environment variable bootargs as load options */ 365b57f48a8SHeinrich Schuchardt set_load_options(&loaded_image_info, "bootargs"); 366b9939336SAlexander Graf /* Load the EFI payload */ 367b9939336SAlexander Graf entry = efi_load_pe(efi, &loaded_image_info); 36895c5553eSRob Clark if (!entry) { 36945204b10SHeinrich Schuchardt ret = EFI_LOAD_ERROR; 37095c5553eSRob Clark goto exit; 37195c5553eSRob Clark } 37280a4800eSAlexander Graf 373bf19273eSRob Clark if (memdp) { 374bf19273eSRob Clark struct efi_device_path_memory *mdp = (void *)memdp; 375bf19273eSRob Clark mdp->memory_type = loaded_image_info.image_code_type; 376bf19273eSRob Clark mdp->start_address = (uintptr_t)loaded_image_info.image_base; 377bf19273eSRob Clark mdp->end_address = mdp->start_address + 378bf19273eSRob Clark loaded_image_info.image_size; 379bf19273eSRob Clark } 380bf19273eSRob Clark 381ad644e7cSRob Clark /* we don't support much: */ 382ad644e7cSRob Clark env_set("efi_8be4df61-93ca-11d2-aa0d-00e098032b8c_OsIndicationsSupported", 383ad644e7cSRob Clark "{ro,boot}(blob)0000000000000000"); 384ad644e7cSRob Clark 385b9939336SAlexander Graf /* Call our payload! */ 386edcef3baSAlexander Graf debug("%s:%d Jumping to 0x%lx\n", __func__, __LINE__, (long)entry); 387a86aeaf2SAlexander Graf 388a86aeaf2SAlexander Graf if (setjmp(&loaded_image_info.exit_jmp)) { 38995c5553eSRob Clark ret = loaded_image_info.exit_status; 39095c5553eSRob Clark goto exit; 391a86aeaf2SAlexander Graf } 392a86aeaf2SAlexander Graf 39369bd459dSAlexander Graf #ifdef CONFIG_ARM64 39469bd459dSAlexander Graf /* On AArch64 we need to make sure we call our payload in < EL3 */ 39569bd459dSAlexander Graf if (current_el() == 3) { 39669bd459dSAlexander Graf smp_kick_all_cpus(); 39769bd459dSAlexander Graf dcache_disable(); /* flush cache before switch to EL2 */ 398ec6617c3SAlison Wang 399ec6617c3SAlison Wang /* Move into EL2 and keep running there */ 400ea54ad59SHeinrich Schuchardt armv8_switch_to_el2((ulong)entry, 401ea54ad59SHeinrich Schuchardt (ulong)&loaded_image_info_obj.handle, 4027c5e1febSAlison Wang (ulong)&systab, 0, (ulong)efi_run_in_el2, 403ec6617c3SAlison Wang ES_TO_AARCH64); 404ec6617c3SAlison Wang 405ec6617c3SAlison Wang /* Should never reach here, efi exits with longjmp */ 406ec6617c3SAlison Wang while (1) { } 40769bd459dSAlexander Graf } 40869bd459dSAlexander Graf #endif 40969bd459dSAlexander Graf 410dc500c36SMark Kettenis #ifdef CONFIG_ARMV7_NONSEC 411f17f2001SMark Kettenis if (armv7_boot_nonsec() && !is_nonsec) { 412dc500c36SMark Kettenis dcache_disable(); /* flush cache before switch to HYP */ 413dc500c36SMark Kettenis 414dc500c36SMark Kettenis armv7_init_nonsec(); 415dc500c36SMark Kettenis secure_ram_addr(_do_nonsec_entry)( 416dc500c36SMark Kettenis efi_run_in_hyp, 417dc500c36SMark Kettenis (uintptr_t)entry, 418dc500c36SMark Kettenis (uintptr_t)loaded_image_info_obj.handle, 419dc500c36SMark Kettenis (uintptr_t)&systab); 420dc500c36SMark Kettenis 421dc500c36SMark Kettenis /* Should never reach here, efi exits with longjmp */ 422dc500c36SMark Kettenis while (1) { } 423dc500c36SMark Kettenis } 424dc500c36SMark Kettenis #endif 425dc500c36SMark Kettenis 426ea54ad59SHeinrich Schuchardt ret = efi_do_enter(loaded_image_info_obj.handle, &systab, entry); 42795c5553eSRob Clark 42895c5553eSRob Clark exit: 42995c5553eSRob Clark /* image has returned, loaded-image obj goes *poof*: */ 43095c5553eSRob Clark list_del(&loaded_image_info_obj.link); 43158bc69d2SAlexander Graf if (mem_obj.handle) 43258bc69d2SAlexander Graf list_del(&mem_obj.link); 43395c5553eSRob Clark 43495c5553eSRob Clark return ret; 435b9939336SAlexander Graf } 436b9939336SAlexander Graf 437bc4f9133SHeinrich Schuchardt static int do_bootefi_bootmgr_exec(void) 4389975fe96SRob Clark { 4399975fe96SRob Clark struct efi_device_path *device_path, *file_path; 4409975fe96SRob Clark void *addr; 4419975fe96SRob Clark efi_status_t r; 4429975fe96SRob Clark 4439975fe96SRob Clark /* 4449975fe96SRob Clark * gd lives in a fixed register which may get clobbered while we execute 4459975fe96SRob Clark * the payload. So save it here and restore it on every callback entry 4469975fe96SRob Clark */ 4479975fe96SRob Clark efi_save_gd(); 4489975fe96SRob Clark 4499975fe96SRob Clark addr = efi_bootmgr_load(&device_path, &file_path); 4509975fe96SRob Clark if (!addr) 4519975fe96SRob Clark return 1; 4529975fe96SRob Clark 4539975fe96SRob Clark printf("## Starting EFI application at %p ...\n", addr); 454bc4f9133SHeinrich Schuchardt r = do_bootefi_exec(addr, device_path, file_path); 4559975fe96SRob Clark printf("## Application terminated, r = %lu\n", 4569975fe96SRob Clark r & ~EFI_ERROR_MASK); 4579975fe96SRob Clark 4589975fe96SRob Clark if (r != EFI_SUCCESS) 4599975fe96SRob Clark return 1; 4609975fe96SRob Clark 4619975fe96SRob Clark return 0; 4629975fe96SRob Clark } 4639975fe96SRob Clark 464b9939336SAlexander Graf /* Interpreter command to boot an arbitrary EFI image from memory */ 465b9939336SAlexander Graf static int do_bootefi(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 466b9939336SAlexander Graf { 467bc4f9133SHeinrich Schuchardt unsigned long addr; 468bc4f9133SHeinrich Schuchardt char *saddr; 4693eb0841bSHeinrich Schuchardt efi_status_t r; 470354264b3SAlexander Graf unsigned long fdt_addr; 471b9939336SAlexander Graf 472c3b11deaSHeinrich Schuchardt /* Allow unaligned memory access */ 473c3b11deaSHeinrich Schuchardt allow_unaligned(); 474c3b11deaSHeinrich Schuchardt 475fc225e60SHeinrich Schuchardt /* Initialize EFI drivers */ 476fc225e60SHeinrich Schuchardt r = efi_init_obj_list(); 477fc225e60SHeinrich Schuchardt if (r != EFI_SUCCESS) { 478fc225e60SHeinrich Schuchardt printf("Error: Cannot set up EFI drivers, r = %lu\n", 479fc225e60SHeinrich Schuchardt r & ~EFI_ERROR_MASK); 480fc225e60SHeinrich Schuchardt return CMD_RET_FAILURE; 481fc225e60SHeinrich Schuchardt } 482fc225e60SHeinrich Schuchardt 483b9939336SAlexander Graf if (argc < 2) 4843c1dcef6SBin Meng return CMD_RET_USAGE; 485bc4f9133SHeinrich Schuchardt 486bc4f9133SHeinrich Schuchardt if (argc > 2) { 487354264b3SAlexander Graf fdt_addr = simple_strtoul(argv[2], NULL, 16); 488bc4f9133SHeinrich Schuchardt if (!fdt_addr && *argv[2] != '0') 489bc4f9133SHeinrich Schuchardt return CMD_RET_USAGE; 490bc4f9133SHeinrich Schuchardt /* Install device tree */ 4919dff4900SSimon Glass r = efi_install_fdt(fdt_addr); 492bc4f9133SHeinrich Schuchardt if (r != EFI_SUCCESS) { 493bc4f9133SHeinrich Schuchardt printf("ERROR: failed to install device tree\n"); 494bc4f9133SHeinrich Schuchardt return CMD_RET_FAILURE; 495bc4f9133SHeinrich Schuchardt } 496bc4f9133SHeinrich Schuchardt } else { 497bc4f9133SHeinrich Schuchardt /* Remove device tree. EFI_NOT_FOUND can be ignored here */ 498bc4f9133SHeinrich Schuchardt efi_install_configuration_table(&efi_guid_fdt, NULL); 499bc4f9133SHeinrich Schuchardt printf("WARNING: booting without device tree\n"); 500bc4f9133SHeinrich Schuchardt } 501c7ae3dfdSSimon Glass #ifdef CONFIG_CMD_BOOTEFI_HELLO 502c7ae3dfdSSimon Glass if (!strcmp(argv[1], "hello")) { 5035e44489bSHeinrich Schuchardt ulong size = __efi_helloworld_end - __efi_helloworld_begin; 504c7ae3dfdSSimon Glass 50551c533fdSHeinrich Schuchardt saddr = env_get("loadaddr"); 50651c533fdSHeinrich Schuchardt if (saddr) 50751c533fdSHeinrich Schuchardt addr = simple_strtoul(saddr, NULL, 16); 50851c533fdSHeinrich Schuchardt else 509c7ae3dfdSSimon Glass addr = CONFIG_SYS_LOAD_ADDR; 510354264b3SAlexander Graf memcpy(map_sysmem(addr, size), __efi_helloworld_begin, size); 511c7ae3dfdSSimon Glass } else 512c7ae3dfdSSimon Glass #endif 513623b3a57SHeinrich Schuchardt #ifdef CONFIG_CMD_BOOTEFI_SELFTEST 514623b3a57SHeinrich Schuchardt if (!strcmp(argv[1], "selftest")) { 5157aca68caSHeinrich Schuchardt struct efi_loaded_image loaded_image_info = {}; 5167aca68caSHeinrich Schuchardt struct efi_object loaded_image_info_obj = {}; 5177aca68caSHeinrich Schuchardt 518f972dc14SHeinrich Schuchardt /* Construct a dummy device path. */ 519f972dc14SHeinrich Schuchardt bootefi_device_path = efi_dp_from_mem(EFI_RESERVED_MEMORY_TYPE, 520f972dc14SHeinrich Schuchardt (uintptr_t)&efi_selftest, 521f972dc14SHeinrich Schuchardt (uintptr_t)&efi_selftest); 522f972dc14SHeinrich Schuchardt bootefi_image_path = efi_dp_from_file(NULL, 0, "\\selftest"); 523f972dc14SHeinrich Schuchardt 5247aca68caSHeinrich Schuchardt efi_setup_loaded_image(&loaded_image_info, 5257aca68caSHeinrich Schuchardt &loaded_image_info_obj, 5267aca68caSHeinrich Schuchardt bootefi_device_path, bootefi_image_path); 527623b3a57SHeinrich Schuchardt /* 528623b3a57SHeinrich Schuchardt * gd lives in a fixed register which may get clobbered while we 529623b3a57SHeinrich Schuchardt * execute the payload. So save it here and restore it on every 530623b3a57SHeinrich Schuchardt * callback entry 531623b3a57SHeinrich Schuchardt */ 532623b3a57SHeinrich Schuchardt efi_save_gd(); 533d78e40d6SHeinrich Schuchardt /* Transfer environment variable efi_selftest as load options */ 534d78e40d6SHeinrich Schuchardt set_load_options(&loaded_image_info, "efi_selftest"); 535d78e40d6SHeinrich Schuchardt /* Execute the test */ 536ea54ad59SHeinrich Schuchardt r = efi_selftest(loaded_image_info_obj.handle, &systab); 537c2b53902SHeinrich Schuchardt efi_restore_gd(); 538d78e40d6SHeinrich Schuchardt free(loaded_image_info.load_options); 539c2b53902SHeinrich Schuchardt list_del(&loaded_image_info_obj.link); 540c2b53902SHeinrich Schuchardt return r != EFI_SUCCESS; 541623b3a57SHeinrich Schuchardt } else 542623b3a57SHeinrich Schuchardt #endif 5439975fe96SRob Clark if (!strcmp(argv[1], "bootmgr")) { 544bc4f9133SHeinrich Schuchardt return do_bootefi_bootmgr_exec(); 5459975fe96SRob Clark } else { 546b9939336SAlexander Graf saddr = argv[1]; 547b9939336SAlexander Graf 548b9939336SAlexander Graf addr = simple_strtoul(saddr, NULL, 16); 54949db1cb8SHeinrich Schuchardt /* Check that a numeric value was passed */ 55049db1cb8SHeinrich Schuchardt if (!addr && *saddr != '0') 55149db1cb8SHeinrich Schuchardt return CMD_RET_USAGE; 552b9939336SAlexander Graf 553c7ae3dfdSSimon Glass } 5541c39809bSAlexander Graf 5555ee31bafSSimon Glass printf("## Starting EFI application at %08lx ...\n", addr); 556354264b3SAlexander Graf r = do_bootefi_exec(map_sysmem(addr, 0), bootefi_device_path, 557bc4f9133SHeinrich Schuchardt bootefi_image_path); 5581da1bac4Sxypron.glpk@gmx.de printf("## Application terminated, r = %lu\n", 5591da1bac4Sxypron.glpk@gmx.de r & ~EFI_ERROR_MASK); 560b9939336SAlexander Graf 5611da1bac4Sxypron.glpk@gmx.de if (r != EFI_SUCCESS) 5621da1bac4Sxypron.glpk@gmx.de return 1; 5631da1bac4Sxypron.glpk@gmx.de else 5641da1bac4Sxypron.glpk@gmx.de return 0; 565b9939336SAlexander Graf } 566b9939336SAlexander Graf 567b9939336SAlexander Graf #ifdef CONFIG_SYS_LONGHELP 568b9939336SAlexander Graf static char bootefi_help_text[] = 5691c39809bSAlexander Graf "<image address> [fdt address]\n" 5701c39809bSAlexander Graf " - boot EFI payload stored at address <image address>.\n" 5711c39809bSAlexander Graf " If specified, the device tree located at <fdt address> gets\n" 572c7ae3dfdSSimon Glass " exposed as EFI configuration table.\n" 573c7ae3dfdSSimon Glass #ifdef CONFIG_CMD_BOOTEFI_HELLO 574623b3a57SHeinrich Schuchardt "bootefi hello\n" 575623b3a57SHeinrich Schuchardt " - boot a sample Hello World application stored within U-Boot\n" 576623b3a57SHeinrich Schuchardt #endif 577623b3a57SHeinrich Schuchardt #ifdef CONFIG_CMD_BOOTEFI_SELFTEST 578bc4f9133SHeinrich Schuchardt "bootefi selftest [fdt address]\n" 579623b3a57SHeinrich Schuchardt " - boot an EFI selftest application stored within U-Boot\n" 580d78e40d6SHeinrich Schuchardt " Use environment variable efi_selftest to select a single test.\n" 581d78e40d6SHeinrich Schuchardt " Use 'setenv efi_selftest list' to enumerate all tests.\n" 582c7ae3dfdSSimon Glass #endif 583f623e07fSHeinrich Schuchardt "bootefi bootmgr [fdt addr]\n" 5849975fe96SRob Clark " - load and boot EFI payload based on BootOrder/BootXXXX variables.\n" 5859975fe96SRob Clark "\n" 5869975fe96SRob Clark " If specified, the device tree located at <fdt address> gets\n" 5879975fe96SRob Clark " exposed as EFI configuration table.\n"; 588b9939336SAlexander Graf #endif 589b9939336SAlexander Graf 590b9939336SAlexander Graf U_BOOT_CMD( 5911c39809bSAlexander Graf bootefi, 3, 0, do_bootefi, 59292dfd922SSergey Kubushyn "Boots an EFI payload from memory", 593b9939336SAlexander Graf bootefi_help_text 594b9939336SAlexander Graf ); 5950f4060ebSAlexander Graf 596c07ad7c0SAlexander Graf void efi_set_bootdev(const char *dev, const char *devnr, const char *path) 5970f4060ebSAlexander Graf { 59895c5553eSRob Clark char filename[32] = { 0 }; /* dp->str is u16[32] long */ 59995c5553eSRob Clark char *s; 6000f4060ebSAlexander Graf 60195c5553eSRob Clark if (strcmp(dev, "Net")) { 60295c5553eSRob Clark struct blk_desc *desc; 6032db1eba1SHeinrich Schuchardt disk_partition_t fs_partition; 60495c5553eSRob Clark int part; 60595c5553eSRob Clark 6062db1eba1SHeinrich Schuchardt part = blk_get_device_part_str(dev, devnr, &desc, &fs_partition, 6072db1eba1SHeinrich Schuchardt 1); 6082db1eba1SHeinrich Schuchardt if (part < 0) 6098300be61SStefan Roese return; 610f9d334bdSAlexander Graf 61195c5553eSRob Clark bootefi_device_path = efi_dp_from_part(desc, part); 61295c5553eSRob Clark } else { 613092f2f35SJoe Hershberger #ifdef CONFIG_NET 61495c5553eSRob Clark bootefi_device_path = efi_dp_from_eth(); 615f9d334bdSAlexander Graf #endif 616f9d334bdSAlexander Graf } 617f9d334bdSAlexander Graf 6189975fe96SRob Clark if (!path) 6199975fe96SRob Clark return; 6209975fe96SRob Clark 62149271666SAlexander Graf if (strcmp(dev, "Net")) { 62249271666SAlexander Graf /* Add leading / to fs paths, because they're absolute */ 62395c5553eSRob Clark snprintf(filename, sizeof(filename), "/%s", path); 62449271666SAlexander Graf } else { 62595c5553eSRob Clark snprintf(filename, sizeof(filename), "%s", path); 62649271666SAlexander Graf } 6273e433e96SRob Clark /* DOS style file path: */ 62895c5553eSRob Clark s = filename; 6293e433e96SRob Clark while ((s = strchr(s, '/'))) 6303e433e96SRob Clark *s++ = '\\'; 63195c5553eSRob Clark bootefi_image_path = efi_dp_from_file(NULL, 0, filename); 6320f4060ebSAlexander Graf } 633