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> 17ad0c1a3dSAlexander Graf #include <memalign.h> 180d9d501fSAlexander Graf #include <asm/global_data.h> 19e275458cSSimon Glass #include <asm-generic/sections.h> 20c3b11deaSHeinrich Schuchardt #include <asm-generic/unaligned.h> 21e275458cSSimon Glass #include <linux/linkage.h> 220d9d501fSAlexander Graf 230d9d501fSAlexander Graf DECLARE_GLOBAL_DATA_PTR; 24b9939336SAlexander Graf 25fc225e60SHeinrich Schuchardt #define OBJ_LIST_NOT_INITIALIZED 1 26fc225e60SHeinrich Schuchardt 27fc225e60SHeinrich Schuchardt static efi_status_t efi_obj_list_initialized = OBJ_LIST_NOT_INITIALIZED; 287cbc1241SHeinrich Schuchardt 2995c5553eSRob Clark static struct efi_device_path *bootefi_image_path; 3095c5553eSRob Clark static struct efi_device_path *bootefi_device_path; 31b9939336SAlexander Graf 327cbc1241SHeinrich Schuchardt /* Initialize and populate EFI object list */ 33fc225e60SHeinrich Schuchardt efi_status_t efi_init_obj_list(void) 347cbc1241SHeinrich Schuchardt { 35fc225e60SHeinrich Schuchardt efi_status_t ret = EFI_SUCCESS; 36fc225e60SHeinrich Schuchardt 37098a6cddSHeinrich Schuchardt /* Initialize once only */ 38fc225e60SHeinrich Schuchardt if (efi_obj_list_initialized != OBJ_LIST_NOT_INITIALIZED) 39fc225e60SHeinrich Schuchardt return efi_obj_list_initialized; 407cbc1241SHeinrich Schuchardt 4105ef48a2SHeinrich Schuchardt /* Initialize EFI driver uclass */ 42fc225e60SHeinrich Schuchardt ret = efi_driver_init(); 43fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 44fc225e60SHeinrich Schuchardt goto out; 4505ef48a2SHeinrich Schuchardt 46fc225e60SHeinrich Schuchardt ret = efi_console_register(); 47fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 48fc225e60SHeinrich Schuchardt goto out; 497cbc1241SHeinrich Schuchardt #ifdef CONFIG_PARTITIONS 50fc225e60SHeinrich Schuchardt ret = efi_disk_register(); 51fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 52fc225e60SHeinrich Schuchardt goto out; 537cbc1241SHeinrich Schuchardt #endif 547cbc1241SHeinrich Schuchardt #if defined(CONFIG_LCD) || defined(CONFIG_DM_VIDEO) 55fc225e60SHeinrich Schuchardt ret = efi_gop_register(); 56fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 57fc225e60SHeinrich Schuchardt goto out; 587cbc1241SHeinrich Schuchardt #endif 59092f2f35SJoe Hershberger #ifdef CONFIG_NET 60fc225e60SHeinrich Schuchardt ret = efi_net_register(); 61fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 62fc225e60SHeinrich Schuchardt goto out; 637cbc1241SHeinrich Schuchardt #endif 647cbc1241SHeinrich Schuchardt #ifdef CONFIG_GENERATE_SMBIOS_TABLE 65fc225e60SHeinrich Schuchardt ret = efi_smbios_register(); 66fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 67fc225e60SHeinrich Schuchardt goto out; 687cbc1241SHeinrich Schuchardt #endif 69fc225e60SHeinrich Schuchardt ret = efi_watchdog_register(); 70fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 71fc225e60SHeinrich Schuchardt goto out; 727cbc1241SHeinrich Schuchardt 737cbc1241SHeinrich Schuchardt /* Initialize EFI runtime services */ 74fc225e60SHeinrich Schuchardt ret = efi_reset_system_init(); 75fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 76fc225e60SHeinrich Schuchardt goto out; 77fc225e60SHeinrich Schuchardt ret = efi_get_time_init(); 78fc225e60SHeinrich Schuchardt if (ret != EFI_SUCCESS) 79fc225e60SHeinrich Schuchardt goto out; 80fc225e60SHeinrich Schuchardt 81fc225e60SHeinrich Schuchardt out: 82fc225e60SHeinrich Schuchardt efi_obj_list_initialized = ret; 83fc225e60SHeinrich Schuchardt return ret; 847cbc1241SHeinrich Schuchardt } 857cbc1241SHeinrich Schuchardt 86d78e40d6SHeinrich Schuchardt /* 87c3b11deaSHeinrich Schuchardt * Allow unaligned memory access. 88c3b11deaSHeinrich Schuchardt * 89c3b11deaSHeinrich Schuchardt * This routine is overridden by architectures providing this feature. 90c3b11deaSHeinrich Schuchardt */ 91c3b11deaSHeinrich Schuchardt void __weak allow_unaligned(void) 92c3b11deaSHeinrich Schuchardt { 93c3b11deaSHeinrich Schuchardt } 94c3b11deaSHeinrich Schuchardt 95c3b11deaSHeinrich Schuchardt /* 96d78e40d6SHeinrich Schuchardt * Set the load options of an image from an environment variable. 97d78e40d6SHeinrich Schuchardt * 98d78e40d6SHeinrich Schuchardt * @loaded_image_info: the image 99d78e40d6SHeinrich Schuchardt * @env_var: name of the environment variable 100d78e40d6SHeinrich Schuchardt */ 101d78e40d6SHeinrich Schuchardt static void set_load_options(struct efi_loaded_image *loaded_image_info, 102d78e40d6SHeinrich Schuchardt const char *env_var) 103d78e40d6SHeinrich Schuchardt { 104d78e40d6SHeinrich Schuchardt size_t size; 105d78e40d6SHeinrich Schuchardt const char *env = env_get(env_var); 106d78e40d6SHeinrich Schuchardt 107d78e40d6SHeinrich Schuchardt loaded_image_info->load_options = NULL; 108d78e40d6SHeinrich Schuchardt loaded_image_info->load_options_size = 0; 109d78e40d6SHeinrich Schuchardt if (!env) 110d78e40d6SHeinrich Schuchardt return; 111d78e40d6SHeinrich Schuchardt size = strlen(env) + 1; 112d78e40d6SHeinrich Schuchardt loaded_image_info->load_options = calloc(size, sizeof(u16)); 113d78e40d6SHeinrich Schuchardt if (!loaded_image_info->load_options) { 114d78e40d6SHeinrich Schuchardt printf("ERROR: Out of memory\n"); 115d78e40d6SHeinrich Schuchardt return; 116d78e40d6SHeinrich Schuchardt } 117d78e40d6SHeinrich Schuchardt utf8_to_utf16(loaded_image_info->load_options, (u8 *)env, size); 118d78e40d6SHeinrich Schuchardt loaded_image_info->load_options_size = size * 2; 119d78e40d6SHeinrich Schuchardt } 120d78e40d6SHeinrich Schuchardt 1210d9d501fSAlexander Graf static void *copy_fdt(void *fdt) 1220d9d501fSAlexander Graf { 1230d9d501fSAlexander Graf u64 fdt_size = fdt_totalsize(fdt); 124ad0c1a3dSAlexander Graf unsigned long fdt_ram_start = -1L, fdt_pages; 125ad0c1a3dSAlexander Graf u64 new_fdt_addr; 1260d9d501fSAlexander Graf void *new_fdt; 127ad0c1a3dSAlexander Graf int i; 1280d9d501fSAlexander Graf 129ad0c1a3dSAlexander Graf for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 130ad0c1a3dSAlexander Graf u64 ram_start = gd->bd->bi_dram[i].start; 131ad0c1a3dSAlexander Graf u64 ram_size = gd->bd->bi_dram[i].size; 1320d9d501fSAlexander Graf 133ad0c1a3dSAlexander Graf if (!ram_size) 134ad0c1a3dSAlexander Graf continue; 135ad0c1a3dSAlexander Graf 136ad0c1a3dSAlexander Graf if (ram_start < fdt_ram_start) 137ad0c1a3dSAlexander Graf fdt_ram_start = ram_start; 138ad0c1a3dSAlexander Graf } 139ad0c1a3dSAlexander Graf 140ad0c1a3dSAlexander Graf /* Give us at least 4kb breathing room */ 141a44bffccSxypron.glpk@gmx.de fdt_size = ALIGN(fdt_size + 4096, EFI_PAGE_SIZE); 142ad0c1a3dSAlexander Graf fdt_pages = fdt_size >> EFI_PAGE_SHIFT; 143ad0c1a3dSAlexander Graf 144ad0c1a3dSAlexander Graf /* Safe fdt location is at 128MB */ 145ad0c1a3dSAlexander Graf new_fdt_addr = fdt_ram_start + (128 * 1024 * 1024) + fdt_size; 146*e09159c8SHeinrich Schuchardt if (efi_allocate_pages(EFI_ALLOCATE_MAX_ADDRESS, 147*e09159c8SHeinrich Schuchardt EFI_RUNTIME_SERVICES_DATA, fdt_pages, 148ad0c1a3dSAlexander Graf &new_fdt_addr) != EFI_SUCCESS) { 149ad0c1a3dSAlexander Graf /* If we can't put it there, put it somewhere */ 150a44bffccSxypron.glpk@gmx.de new_fdt_addr = (ulong)memalign(EFI_PAGE_SIZE, fdt_size); 151*e09159c8SHeinrich Schuchardt if (efi_allocate_pages(EFI_ALLOCATE_MAX_ADDRESS, 152*e09159c8SHeinrich Schuchardt EFI_RUNTIME_SERVICES_DATA, fdt_pages, 15385a6e9b3SAlexander Graf &new_fdt_addr) != EFI_SUCCESS) { 15485a6e9b3SAlexander Graf printf("ERROR: Failed to reserve space for FDT\n"); 15585a6e9b3SAlexander Graf return NULL; 156ad0c1a3dSAlexander Graf } 15785a6e9b3SAlexander Graf } 15885a6e9b3SAlexander Graf 159ad0c1a3dSAlexander Graf new_fdt = (void*)(ulong)new_fdt_addr; 1600d9d501fSAlexander Graf memcpy(new_fdt, fdt, fdt_totalsize(fdt)); 1610d9d501fSAlexander Graf fdt_set_totalsize(new_fdt, fdt_size); 1620d9d501fSAlexander Graf 1630d9d501fSAlexander Graf return new_fdt; 1640d9d501fSAlexander Graf } 1650d9d501fSAlexander Graf 1663eb0841bSHeinrich Schuchardt static efi_status_t efi_do_enter( 1672074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st, 168c6fa5df6SAlexander Graf EFIAPI efi_status_t (*entry)( 169c6fa5df6SAlexander Graf efi_handle_t image_handle, 170b06d8ac3Sxypron.glpk@gmx.de struct efi_system_table *st)) 171b06d8ac3Sxypron.glpk@gmx.de { 172b06d8ac3Sxypron.glpk@gmx.de efi_status_t ret = EFI_LOAD_ERROR; 173b06d8ac3Sxypron.glpk@gmx.de 174b06d8ac3Sxypron.glpk@gmx.de if (entry) 175b06d8ac3Sxypron.glpk@gmx.de ret = entry(image_handle, st); 176b06d8ac3Sxypron.glpk@gmx.de st->boottime->exit(image_handle, ret, 0, NULL); 177b06d8ac3Sxypron.glpk@gmx.de return ret; 178b06d8ac3Sxypron.glpk@gmx.de } 179b06d8ac3Sxypron.glpk@gmx.de 180ec6617c3SAlison Wang #ifdef CONFIG_ARM64 181c6fa5df6SAlexander Graf static efi_status_t efi_run_in_el2(EFIAPI efi_status_t (*entry)( 1822074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st), 1832074f700SHeinrich Schuchardt efi_handle_t image_handle, struct efi_system_table *st) 184ec6617c3SAlison Wang { 185ec6617c3SAlison Wang /* Enable caches again */ 186ec6617c3SAlison Wang dcache_enable(); 187ec6617c3SAlison Wang 188b06d8ac3Sxypron.glpk@gmx.de return efi_do_enter(image_handle, st, entry); 189ec6617c3SAlison Wang } 190ec6617c3SAlison Wang #endif 191ec6617c3SAlison Wang 192806d2fa8SAlexander Graf /* Carve out DT reserved memory ranges */ 193806d2fa8SAlexander Graf static efi_status_t efi_carve_out_dt_rsv(void *fdt) 194806d2fa8SAlexander Graf { 195806d2fa8SAlexander Graf int nr_rsv, i; 196806d2fa8SAlexander Graf uint64_t addr, size, pages; 197806d2fa8SAlexander Graf 198806d2fa8SAlexander Graf nr_rsv = fdt_num_mem_rsv(fdt); 199806d2fa8SAlexander Graf 200806d2fa8SAlexander Graf /* Look for an existing entry and add it to the efi mem map. */ 201806d2fa8SAlexander Graf for (i = 0; i < nr_rsv; i++) { 202806d2fa8SAlexander Graf if (fdt_get_mem_rsv(fdt, i, &addr, &size) != 0) 203806d2fa8SAlexander Graf continue; 204806d2fa8SAlexander Graf 205806d2fa8SAlexander Graf pages = ALIGN(size, EFI_PAGE_SIZE) >> EFI_PAGE_SHIFT; 206806d2fa8SAlexander Graf efi_add_memory_map(addr, pages, EFI_RESERVED_MEMORY_TYPE, 207806d2fa8SAlexander Graf false); 208806d2fa8SAlexander Graf } 209806d2fa8SAlexander Graf 210806d2fa8SAlexander Graf return EFI_SUCCESS; 211806d2fa8SAlexander Graf } 212806d2fa8SAlexander Graf 213bc4f9133SHeinrich Schuchardt static efi_status_t efi_install_fdt(void *fdt) 214bc4f9133SHeinrich Schuchardt { 215bc4f9133SHeinrich Schuchardt bootm_headers_t img = { 0 }; 216bc4f9133SHeinrich Schuchardt ulong fdt_pages, fdt_size, fdt_start, fdt_end; 217bc4f9133SHeinrich Schuchardt efi_status_t ret; 218bc4f9133SHeinrich Schuchardt 219bc4f9133SHeinrich Schuchardt if (fdt_check_header(fdt)) { 220bc4f9133SHeinrich Schuchardt printf("ERROR: invalid device tree\n"); 221bc4f9133SHeinrich Schuchardt return EFI_INVALID_PARAMETER; 222bc4f9133SHeinrich Schuchardt } 223bc4f9133SHeinrich Schuchardt 224bc4f9133SHeinrich Schuchardt /* Prepare fdt for payload */ 225bc4f9133SHeinrich Schuchardt fdt = copy_fdt(fdt); 226bc4f9133SHeinrich Schuchardt if (!fdt) 227bc4f9133SHeinrich Schuchardt return EFI_OUT_OF_RESOURCES; 228bc4f9133SHeinrich Schuchardt 229bc4f9133SHeinrich Schuchardt if (image_setup_libfdt(&img, fdt, 0, NULL)) { 230bc4f9133SHeinrich Schuchardt printf("ERROR: failed to process device tree\n"); 231bc4f9133SHeinrich Schuchardt return EFI_LOAD_ERROR; 232bc4f9133SHeinrich Schuchardt } 233bc4f9133SHeinrich Schuchardt 234806d2fa8SAlexander Graf if (efi_carve_out_dt_rsv(fdt) != EFI_SUCCESS) { 235806d2fa8SAlexander Graf printf("ERROR: failed to carve out memory\n"); 236806d2fa8SAlexander Graf return EFI_LOAD_ERROR; 237806d2fa8SAlexander Graf } 238806d2fa8SAlexander Graf 239bc4f9133SHeinrich Schuchardt /* Link to it in the efi tables */ 240bc4f9133SHeinrich Schuchardt ret = efi_install_configuration_table(&efi_guid_fdt, fdt); 241bc4f9133SHeinrich Schuchardt if (ret != EFI_SUCCESS) 242bc4f9133SHeinrich Schuchardt return EFI_OUT_OF_RESOURCES; 243bc4f9133SHeinrich Schuchardt 244bc4f9133SHeinrich Schuchardt /* And reserve the space in the memory map */ 245bc4f9133SHeinrich Schuchardt fdt_start = ((ulong)fdt) & ~EFI_PAGE_MASK; 246bc4f9133SHeinrich Schuchardt fdt_end = ((ulong)fdt) + fdt_totalsize(fdt); 247bc4f9133SHeinrich Schuchardt fdt_size = (fdt_end - fdt_start) + EFI_PAGE_MASK; 248bc4f9133SHeinrich Schuchardt fdt_pages = fdt_size >> EFI_PAGE_SHIFT; 249bc4f9133SHeinrich Schuchardt /* Give a bootloader the chance to modify the device tree */ 250bc4f9133SHeinrich Schuchardt fdt_pages += 2; 251bc4f9133SHeinrich Schuchardt ret = efi_add_memory_map(fdt_start, fdt_pages, 252bc4f9133SHeinrich Schuchardt EFI_BOOT_SERVICES_DATA, true); 253bc4f9133SHeinrich Schuchardt return ret; 254bc4f9133SHeinrich Schuchardt } 255bc4f9133SHeinrich Schuchardt 256b9939336SAlexander Graf /* 257b9939336SAlexander Graf * Load an EFI payload into a newly allocated piece of memory, register all 258b9939336SAlexander Graf * EFI objects it would want to access and jump to it. 259b9939336SAlexander Graf */ 260bc4f9133SHeinrich Schuchardt static efi_status_t do_bootefi_exec(void *efi, 26195c5553eSRob Clark struct efi_device_path *device_path, 26295c5553eSRob Clark struct efi_device_path *image_path) 263b9939336SAlexander Graf { 26495c5553eSRob Clark struct efi_loaded_image loaded_image_info = {}; 26595c5553eSRob Clark struct efi_object loaded_image_info_obj = {}; 266bf19273eSRob Clark struct efi_device_path *memdp = NULL; 26745204b10SHeinrich Schuchardt efi_status_t ret; 26895c5553eSRob Clark 269c6fa5df6SAlexander Graf EFIAPI efi_status_t (*entry)(efi_handle_t image_handle, 270c6fa5df6SAlexander Graf struct efi_system_table *st); 271b9939336SAlexander Graf 272bf19273eSRob Clark /* 273bf19273eSRob Clark * Special case for efi payload not loaded from disk, such as 274bf19273eSRob Clark * 'bootefi hello' or for example payload loaded directly into 275bf19273eSRob Clark * memory via jtag/etc: 276bf19273eSRob Clark */ 277bf19273eSRob Clark if (!device_path && !image_path) { 278bf19273eSRob Clark printf("WARNING: using memory device/image path, this may confuse some payloads!\n"); 279bf19273eSRob Clark /* actual addresses filled in after efi_load_pe() */ 280bf19273eSRob Clark memdp = efi_dp_from_mem(0, 0, 0); 281bf19273eSRob Clark device_path = image_path = memdp; 282bf19273eSRob Clark } else { 283bf19273eSRob Clark assert(device_path && image_path); 284bf19273eSRob Clark } 285bf19273eSRob Clark 28695c5553eSRob Clark efi_setup_loaded_image(&loaded_image_info, &loaded_image_info_obj, 28795c5553eSRob Clark device_path, image_path); 28895c5553eSRob Clark 289b9939336SAlexander Graf /* 290b9939336SAlexander Graf * gd lives in a fixed register which may get clobbered while we execute 291b9939336SAlexander Graf * the payload. So save it here and restore it on every callback entry 292b9939336SAlexander Graf */ 293b9939336SAlexander Graf efi_save_gd(); 294b9939336SAlexander Graf 295b57f48a8SHeinrich Schuchardt /* Transfer environment variable bootargs as load options */ 296b57f48a8SHeinrich Schuchardt set_load_options(&loaded_image_info, "bootargs"); 297b9939336SAlexander Graf /* Load the EFI payload */ 298b9939336SAlexander Graf entry = efi_load_pe(efi, &loaded_image_info); 29995c5553eSRob Clark if (!entry) { 30045204b10SHeinrich Schuchardt ret = EFI_LOAD_ERROR; 30195c5553eSRob Clark goto exit; 30295c5553eSRob Clark } 30380a4800eSAlexander Graf 304bf19273eSRob Clark if (memdp) { 305bf19273eSRob Clark struct efi_device_path_memory *mdp = (void *)memdp; 306bf19273eSRob Clark mdp->memory_type = loaded_image_info.image_code_type; 307bf19273eSRob Clark mdp->start_address = (uintptr_t)loaded_image_info.image_base; 308bf19273eSRob Clark mdp->end_address = mdp->start_address + 309bf19273eSRob Clark loaded_image_info.image_size; 310bf19273eSRob Clark } 311bf19273eSRob Clark 312ad644e7cSRob Clark /* we don't support much: */ 313ad644e7cSRob Clark env_set("efi_8be4df61-93ca-11d2-aa0d-00e098032b8c_OsIndicationsSupported", 314ad644e7cSRob Clark "{ro,boot}(blob)0000000000000000"); 315ad644e7cSRob Clark 316b9939336SAlexander Graf /* Call our payload! */ 317edcef3baSAlexander Graf debug("%s:%d Jumping to 0x%lx\n", __func__, __LINE__, (long)entry); 318a86aeaf2SAlexander Graf 319a86aeaf2SAlexander Graf if (setjmp(&loaded_image_info.exit_jmp)) { 32095c5553eSRob Clark ret = loaded_image_info.exit_status; 32195c5553eSRob Clark goto exit; 322a86aeaf2SAlexander Graf } 323a86aeaf2SAlexander Graf 32469bd459dSAlexander Graf #ifdef CONFIG_ARM64 32569bd459dSAlexander Graf /* On AArch64 we need to make sure we call our payload in < EL3 */ 32669bd459dSAlexander Graf if (current_el() == 3) { 32769bd459dSAlexander Graf smp_kick_all_cpus(); 32869bd459dSAlexander Graf dcache_disable(); /* flush cache before switch to EL2 */ 329ec6617c3SAlison Wang 330ec6617c3SAlison Wang /* Move into EL2 and keep running there */ 331ea54ad59SHeinrich Schuchardt armv8_switch_to_el2((ulong)entry, 332ea54ad59SHeinrich Schuchardt (ulong)&loaded_image_info_obj.handle, 3337c5e1febSAlison Wang (ulong)&systab, 0, (ulong)efi_run_in_el2, 334ec6617c3SAlison Wang ES_TO_AARCH64); 335ec6617c3SAlison Wang 336ec6617c3SAlison Wang /* Should never reach here, efi exits with longjmp */ 337ec6617c3SAlison Wang while (1) { } 33869bd459dSAlexander Graf } 33969bd459dSAlexander Graf #endif 34069bd459dSAlexander Graf 341ea54ad59SHeinrich Schuchardt ret = efi_do_enter(loaded_image_info_obj.handle, &systab, entry); 34295c5553eSRob Clark 34395c5553eSRob Clark exit: 34495c5553eSRob Clark /* image has returned, loaded-image obj goes *poof*: */ 34595c5553eSRob Clark list_del(&loaded_image_info_obj.link); 34695c5553eSRob Clark 34795c5553eSRob Clark return ret; 348b9939336SAlexander Graf } 349b9939336SAlexander Graf 350bc4f9133SHeinrich Schuchardt static int do_bootefi_bootmgr_exec(void) 3519975fe96SRob Clark { 3529975fe96SRob Clark struct efi_device_path *device_path, *file_path; 3539975fe96SRob Clark void *addr; 3549975fe96SRob Clark efi_status_t r; 3559975fe96SRob Clark 3569975fe96SRob Clark /* 3579975fe96SRob Clark * gd lives in a fixed register which may get clobbered while we execute 3589975fe96SRob Clark * the payload. So save it here and restore it on every callback entry 3599975fe96SRob Clark */ 3609975fe96SRob Clark efi_save_gd(); 3619975fe96SRob Clark 3629975fe96SRob Clark addr = efi_bootmgr_load(&device_path, &file_path); 3639975fe96SRob Clark if (!addr) 3649975fe96SRob Clark return 1; 3659975fe96SRob Clark 3669975fe96SRob Clark printf("## Starting EFI application at %p ...\n", addr); 367bc4f9133SHeinrich Schuchardt r = do_bootefi_exec(addr, device_path, file_path); 3689975fe96SRob Clark printf("## Application terminated, r = %lu\n", 3699975fe96SRob Clark r & ~EFI_ERROR_MASK); 3709975fe96SRob Clark 3719975fe96SRob Clark if (r != EFI_SUCCESS) 3729975fe96SRob Clark return 1; 3739975fe96SRob Clark 3749975fe96SRob Clark return 0; 3759975fe96SRob Clark } 3769975fe96SRob Clark 377b9939336SAlexander Graf /* Interpreter command to boot an arbitrary EFI image from memory */ 378b9939336SAlexander Graf static int do_bootefi(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 379b9939336SAlexander Graf { 380bc4f9133SHeinrich Schuchardt unsigned long addr; 381bc4f9133SHeinrich Schuchardt char *saddr; 3823eb0841bSHeinrich Schuchardt efi_status_t r; 383bc4f9133SHeinrich Schuchardt void *fdt_addr; 384b9939336SAlexander Graf 385c3b11deaSHeinrich Schuchardt /* Allow unaligned memory access */ 386c3b11deaSHeinrich Schuchardt allow_unaligned(); 387c3b11deaSHeinrich Schuchardt 388fc225e60SHeinrich Schuchardt /* Initialize EFI drivers */ 389fc225e60SHeinrich Schuchardt r = efi_init_obj_list(); 390fc225e60SHeinrich Schuchardt if (r != EFI_SUCCESS) { 391fc225e60SHeinrich Schuchardt printf("Error: Cannot set up EFI drivers, r = %lu\n", 392fc225e60SHeinrich Schuchardt r & ~EFI_ERROR_MASK); 393fc225e60SHeinrich Schuchardt return CMD_RET_FAILURE; 394fc225e60SHeinrich Schuchardt } 395fc225e60SHeinrich Schuchardt 396b9939336SAlexander Graf if (argc < 2) 3973c1dcef6SBin Meng return CMD_RET_USAGE; 398bc4f9133SHeinrich Schuchardt 399bc4f9133SHeinrich Schuchardt if (argc > 2) { 400bc4f9133SHeinrich Schuchardt fdt_addr = (void *)simple_strtoul(argv[2], NULL, 16); 401bc4f9133SHeinrich Schuchardt if (!fdt_addr && *argv[2] != '0') 402bc4f9133SHeinrich Schuchardt return CMD_RET_USAGE; 403bc4f9133SHeinrich Schuchardt /* Install device tree */ 404bc4f9133SHeinrich Schuchardt r = efi_install_fdt(fdt_addr); 405bc4f9133SHeinrich Schuchardt if (r != EFI_SUCCESS) { 406bc4f9133SHeinrich Schuchardt printf("ERROR: failed to install device tree\n"); 407bc4f9133SHeinrich Schuchardt return CMD_RET_FAILURE; 408bc4f9133SHeinrich Schuchardt } 409bc4f9133SHeinrich Schuchardt } else { 410bc4f9133SHeinrich Schuchardt /* Remove device tree. EFI_NOT_FOUND can be ignored here */ 411bc4f9133SHeinrich Schuchardt efi_install_configuration_table(&efi_guid_fdt, NULL); 412bc4f9133SHeinrich Schuchardt printf("WARNING: booting without device tree\n"); 413bc4f9133SHeinrich Schuchardt } 414c7ae3dfdSSimon Glass #ifdef CONFIG_CMD_BOOTEFI_HELLO 415c7ae3dfdSSimon Glass if (!strcmp(argv[1], "hello")) { 4165e44489bSHeinrich Schuchardt ulong size = __efi_helloworld_end - __efi_helloworld_begin; 417c7ae3dfdSSimon Glass 41851c533fdSHeinrich Schuchardt saddr = env_get("loadaddr"); 41951c533fdSHeinrich Schuchardt if (saddr) 42051c533fdSHeinrich Schuchardt addr = simple_strtoul(saddr, NULL, 16); 42151c533fdSHeinrich Schuchardt else 422c7ae3dfdSSimon Glass addr = CONFIG_SYS_LOAD_ADDR; 4235e44489bSHeinrich Schuchardt memcpy((char *)addr, __efi_helloworld_begin, size); 424c7ae3dfdSSimon Glass } else 425c7ae3dfdSSimon Glass #endif 426623b3a57SHeinrich Schuchardt #ifdef CONFIG_CMD_BOOTEFI_SELFTEST 427623b3a57SHeinrich Schuchardt if (!strcmp(argv[1], "selftest")) { 4287aca68caSHeinrich Schuchardt struct efi_loaded_image loaded_image_info = {}; 4297aca68caSHeinrich Schuchardt struct efi_object loaded_image_info_obj = {}; 4307aca68caSHeinrich Schuchardt 431f972dc14SHeinrich Schuchardt /* Construct a dummy device path. */ 432f972dc14SHeinrich Schuchardt bootefi_device_path = efi_dp_from_mem(EFI_RESERVED_MEMORY_TYPE, 433f972dc14SHeinrich Schuchardt (uintptr_t)&efi_selftest, 434f972dc14SHeinrich Schuchardt (uintptr_t)&efi_selftest); 435f972dc14SHeinrich Schuchardt bootefi_image_path = efi_dp_from_file(NULL, 0, "\\selftest"); 436f972dc14SHeinrich Schuchardt 4377aca68caSHeinrich Schuchardt efi_setup_loaded_image(&loaded_image_info, 4387aca68caSHeinrich Schuchardt &loaded_image_info_obj, 4397aca68caSHeinrich Schuchardt bootefi_device_path, bootefi_image_path); 440623b3a57SHeinrich Schuchardt /* 441623b3a57SHeinrich Schuchardt * gd lives in a fixed register which may get clobbered while we 442623b3a57SHeinrich Schuchardt * execute the payload. So save it here and restore it on every 443623b3a57SHeinrich Schuchardt * callback entry 444623b3a57SHeinrich Schuchardt */ 445623b3a57SHeinrich Schuchardt efi_save_gd(); 446d78e40d6SHeinrich Schuchardt /* Transfer environment variable efi_selftest as load options */ 447d78e40d6SHeinrich Schuchardt set_load_options(&loaded_image_info, "efi_selftest"); 448d78e40d6SHeinrich Schuchardt /* Execute the test */ 449ea54ad59SHeinrich Schuchardt r = efi_selftest(loaded_image_info_obj.handle, &systab); 450c2b53902SHeinrich Schuchardt efi_restore_gd(); 451d78e40d6SHeinrich Schuchardt free(loaded_image_info.load_options); 452c2b53902SHeinrich Schuchardt list_del(&loaded_image_info_obj.link); 453c2b53902SHeinrich Schuchardt return r != EFI_SUCCESS; 454623b3a57SHeinrich Schuchardt } else 455623b3a57SHeinrich Schuchardt #endif 4569975fe96SRob Clark if (!strcmp(argv[1], "bootmgr")) { 457bc4f9133SHeinrich Schuchardt return do_bootefi_bootmgr_exec(); 4589975fe96SRob Clark } else { 459b9939336SAlexander Graf saddr = argv[1]; 460b9939336SAlexander Graf 461b9939336SAlexander Graf addr = simple_strtoul(saddr, NULL, 16); 46249db1cb8SHeinrich Schuchardt /* Check that a numeric value was passed */ 46349db1cb8SHeinrich Schuchardt if (!addr && *saddr != '0') 46449db1cb8SHeinrich Schuchardt return CMD_RET_USAGE; 465b9939336SAlexander Graf 466c7ae3dfdSSimon Glass } 4671c39809bSAlexander Graf 4685ee31bafSSimon Glass printf("## Starting EFI application at %08lx ...\n", addr); 469bc4f9133SHeinrich Schuchardt r = do_bootefi_exec((void *)addr, bootefi_device_path, 470bc4f9133SHeinrich Schuchardt bootefi_image_path); 4711da1bac4Sxypron.glpk@gmx.de printf("## Application terminated, r = %lu\n", 4721da1bac4Sxypron.glpk@gmx.de r & ~EFI_ERROR_MASK); 473b9939336SAlexander Graf 4741da1bac4Sxypron.glpk@gmx.de if (r != EFI_SUCCESS) 4751da1bac4Sxypron.glpk@gmx.de return 1; 4761da1bac4Sxypron.glpk@gmx.de else 4771da1bac4Sxypron.glpk@gmx.de return 0; 478b9939336SAlexander Graf } 479b9939336SAlexander Graf 480b9939336SAlexander Graf #ifdef CONFIG_SYS_LONGHELP 481b9939336SAlexander Graf static char bootefi_help_text[] = 4821c39809bSAlexander Graf "<image address> [fdt address]\n" 4831c39809bSAlexander Graf " - boot EFI payload stored at address <image address>.\n" 4841c39809bSAlexander Graf " If specified, the device tree located at <fdt address> gets\n" 485c7ae3dfdSSimon Glass " exposed as EFI configuration table.\n" 486c7ae3dfdSSimon Glass #ifdef CONFIG_CMD_BOOTEFI_HELLO 487623b3a57SHeinrich Schuchardt "bootefi hello\n" 488623b3a57SHeinrich Schuchardt " - boot a sample Hello World application stored within U-Boot\n" 489623b3a57SHeinrich Schuchardt #endif 490623b3a57SHeinrich Schuchardt #ifdef CONFIG_CMD_BOOTEFI_SELFTEST 491bc4f9133SHeinrich Schuchardt "bootefi selftest [fdt address]\n" 492623b3a57SHeinrich Schuchardt " - boot an EFI selftest application stored within U-Boot\n" 493d78e40d6SHeinrich Schuchardt " Use environment variable efi_selftest to select a single test.\n" 494d78e40d6SHeinrich Schuchardt " Use 'setenv efi_selftest list' to enumerate all tests.\n" 495c7ae3dfdSSimon Glass #endif 496f623e07fSHeinrich Schuchardt "bootefi bootmgr [fdt addr]\n" 4979975fe96SRob Clark " - load and boot EFI payload based on BootOrder/BootXXXX variables.\n" 4989975fe96SRob Clark "\n" 4999975fe96SRob Clark " If specified, the device tree located at <fdt address> gets\n" 5009975fe96SRob Clark " exposed as EFI configuration table.\n"; 501b9939336SAlexander Graf #endif 502b9939336SAlexander Graf 503b9939336SAlexander Graf U_BOOT_CMD( 5041c39809bSAlexander Graf bootefi, 3, 0, do_bootefi, 50592dfd922SSergey Kubushyn "Boots an EFI payload from memory", 506b9939336SAlexander Graf bootefi_help_text 507b9939336SAlexander Graf ); 5080f4060ebSAlexander Graf 509c07ad7c0SAlexander Graf void efi_set_bootdev(const char *dev, const char *devnr, const char *path) 5100f4060ebSAlexander Graf { 51195c5553eSRob Clark char filename[32] = { 0 }; /* dp->str is u16[32] long */ 51295c5553eSRob Clark char *s; 5130f4060ebSAlexander Graf 51495c5553eSRob Clark if (strcmp(dev, "Net")) { 51595c5553eSRob Clark struct blk_desc *desc; 5162db1eba1SHeinrich Schuchardt disk_partition_t fs_partition; 51795c5553eSRob Clark int part; 51895c5553eSRob Clark 5192db1eba1SHeinrich Schuchardt part = blk_get_device_part_str(dev, devnr, &desc, &fs_partition, 5202db1eba1SHeinrich Schuchardt 1); 5212db1eba1SHeinrich Schuchardt if (part < 0) 5228300be61SStefan Roese return; 523f9d334bdSAlexander Graf 52495c5553eSRob Clark bootefi_device_path = efi_dp_from_part(desc, part); 52595c5553eSRob Clark } else { 526092f2f35SJoe Hershberger #ifdef CONFIG_NET 52795c5553eSRob Clark bootefi_device_path = efi_dp_from_eth(); 528f9d334bdSAlexander Graf #endif 529f9d334bdSAlexander Graf } 530f9d334bdSAlexander Graf 5319975fe96SRob Clark if (!path) 5329975fe96SRob Clark return; 5339975fe96SRob Clark 53449271666SAlexander Graf if (strcmp(dev, "Net")) { 53549271666SAlexander Graf /* Add leading / to fs paths, because they're absolute */ 53695c5553eSRob Clark snprintf(filename, sizeof(filename), "/%s", path); 53749271666SAlexander Graf } else { 53895c5553eSRob Clark snprintf(filename, sizeof(filename), "%s", path); 53949271666SAlexander Graf } 5403e433e96SRob Clark /* DOS style file path: */ 54195c5553eSRob Clark s = filename; 5423e433e96SRob Clark while ((s = strchr(s, '/'))) 5433e433e96SRob Clark *s++ = '\\'; 54495c5553eSRob Clark bootefi_image_path = efi_dp_from_file(NULL, 0, filename); 5450f4060ebSAlexander Graf } 546