Home | History | Annotate | Line # | Download | only in efiboot
efiboot.c revision 1.13
      1 /* $NetBSD: efiboot.c,v 1.13 2019/03/30 12:47:53 jmcneill Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2018 Jared McNeill <jmcneill (at) invisible.ca>
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 #include "efiboot.h"
     30 #include "efifile.h"
     31 #include "efiblock.h"
     32 #include "efifdt.h"
     33 #include "efiacpi.h"
     34 
     35 #include <sys/reboot.h>
     36 
     37 #include <libfdt.h>
     38 
     39 EFI_HANDLE IH;
     40 EFI_DEVICE_PATH *efi_bootdp;
     41 EFI_LOADED_IMAGE *efi_li;
     42 
     43 int howto = 0;
     44 
     45 static EFI_PHYSICAL_ADDRESS heap_start;
     46 static UINTN heap_size = 8 * 1024 * 1024;
     47 static EFI_EVENT delay_ev = 0;
     48 
     49 EFI_STATUS EFIAPI efi_main(EFI_HANDLE, EFI_SYSTEM_TABLE *);
     50 
     51 EFI_STATUS EFIAPI
     52 efi_main(EFI_HANDLE imageHandle, EFI_SYSTEM_TABLE *systemTable)
     53 {
     54 	EFI_STATUS status;
     55 	u_int sz = EFI_SIZE_TO_PAGES(heap_size);
     56 
     57 	IH = imageHandle;
     58 
     59 	InitializeLib(imageHandle, systemTable);
     60 
     61 	(void)uefi_call_wrapper(ST->ConOut->Reset, 2, ST->ConOut, FALSE);
     62 	if (ST->ConOut->ClearScreen)
     63 		(void)uefi_call_wrapper(ST->ConOut->ClearScreen, 1, ST->ConOut);
     64 
     65 	status = uefi_call_wrapper(BS->AllocatePages, 4, AllocateAnyPages, EfiLoaderData, sz, &heap_start);
     66 	if (EFI_ERROR(status))
     67 		return status;
     68 	setheap((void *)(uintptr_t)heap_start, (void *)(uintptr_t)(heap_start + heap_size));
     69 
     70 	status = uefi_call_wrapper(BS->HandleProtocol, 3, imageHandle, &LoadedImageProtocol, (void **)&efi_li);
     71 	if (EFI_ERROR(status))
     72 		return status;
     73 	status = uefi_call_wrapper(BS->HandleProtocol, 3, efi_li->DeviceHandle, &DevicePathProtocol, (void **)&efi_bootdp);
     74 	if (EFI_ERROR(status))
     75 		efi_bootdp = NULL;
     76 
     77 #ifdef EFIBOOT_DEBUG
     78 	Print(L"Loaded image      : 0x%lX\n", efi_li);
     79 	Print(L"FilePath          : 0x%lX\n", efi_li->FilePath);
     80 	Print(L"ImageBase         : 0x%lX\n", efi_li->ImageBase);
     81 	Print(L"ImageSize         : 0x%lX\n", efi_li->ImageSize);
     82 	Print(L"Image file        : %s\n", DevicePathToStr(efi_li->FilePath));
     83 #endif
     84 
     85 	efi_acpi_probe();
     86 	efi_fdt_probe();
     87 	efi_pxe_probe();
     88 	efi_net_probe();
     89 	efi_file_system_probe();
     90 	efi_block_probe();
     91 
     92 	boot();
     93 
     94 	return EFI_SUCCESS;
     95 }
     96 
     97 #ifdef EFIBOOT_RUNTIME_ADDRESS
     98 static uint64_t
     99 efi_runtime_alloc_va(uint64_t npages)
    100 {
    101 	static uint64_t va = EFIBOOT_RUNTIME_ADDRESS;
    102 	static uint64_t sz = EFIBOOT_RUNTIME_SIZE;
    103 	uint64_t nva;
    104 
    105 	if (sz < (npages * EFI_PAGE_SIZE))
    106 		panic("efi_acpi_alloc_va: couldn't allocate %" PRIu64 " pages", npages);
    107 
    108 	nva = va;
    109 	va += (npages * EFI_PAGE_SIZE);
    110 	sz -= (npages * EFI_PAGE_SIZE);
    111 
    112 	return nva;
    113 }
    114 #endif
    115 
    116 #ifdef EFIBOOT_RUNTIME_ADDRESS
    117 static void
    118 efi_set_virtual_address_map(EFI_MEMORY_DESCRIPTOR *memmap, UINTN nentries, UINTN mapkey, UINTN descsize, UINT32 descver)
    119 {
    120 	EFI_MEMORY_DESCRIPTOR *md, *vmd, *vmemmap;
    121 	EFI_STATUS status;
    122 	int n, nrt;
    123 	void *fdt;
    124 
    125 	fdt = efi_fdt_data();
    126 
    127 	vmemmap = alloc(nentries * descsize);
    128 	if (vmemmap == NULL)
    129 		panic("FATAL: couldn't allocate virtual memory map");
    130 
    131 	for (n = 0, nrt = 0, vmd = vmemmap, md = memmap; n < nentries; n++, md = NextMemoryDescriptor(md, descsize)) {
    132 		if ((md->Attribute & EFI_MEMORY_RUNTIME) == 0)
    133 			continue;
    134 		md->VirtualStart = efi_runtime_alloc_va(md->NumberOfPages);
    135 
    136 		switch (md->Type) {
    137 		case EfiRuntimeServicesCode:
    138 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-code", md->PhysicalStart);
    139 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-code", md->VirtualStart);
    140 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-code", md->NumberOfPages * EFI_PAGE_SIZE);
    141 			break;
    142 		case EfiRuntimeServicesData:
    143 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-data", md->PhysicalStart);
    144 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-data", md->VirtualStart);
    145 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-data", md->NumberOfPages * EFI_PAGE_SIZE);
    146 			break;
    147 		case EfiMemoryMappedIO:
    148 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-mmio", md->PhysicalStart);
    149 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-mmio", md->VirtualStart);
    150 			fdt_appendprop_u64(fdt, fdt_path_offset(fdt, "/chosen"), "netbsd,uefi-runtime-mmio", md->NumberOfPages * EFI_PAGE_SIZE);
    151 			break;
    152 		default:
    153 			break;
    154 		}
    155 
    156 		*vmd = *md;
    157 		vmd = NextMemoryDescriptor(vmd, descsize);
    158 		++nrt;
    159 	}
    160 
    161 	status = uefi_call_wrapper(RT->SetVirtualAddressMap, 4, nrt * descsize, descsize, descver, vmemmap);
    162 	if (EFI_ERROR(status)) {
    163 		printf("WARNING: SetVirtualAddressMap failed\n");
    164 		return;
    165 	}
    166 }
    167 #endif
    168 
    169 void
    170 efi_cleanup(void)
    171 {
    172 	EFI_STATUS status;
    173 	EFI_MEMORY_DESCRIPTOR *memmap;
    174 	UINTN nentries, mapkey, descsize;
    175 	UINT32 descver;
    176 
    177 	memmap = LibMemoryMap(&nentries, &mapkey, &descsize, &descver);
    178 
    179 	status = uefi_call_wrapper(BS->ExitBootServices, 2, IH, mapkey);
    180 	if (EFI_ERROR(status)) {
    181 		printf("WARNING: ExitBootServices failed\n");
    182 		return;
    183 	}
    184 
    185 #ifdef EFIBOOT_RUNTIME_ADDRESS
    186 	efi_set_virtual_address_map(memmap, nentries, mapkey, descsize, descver);
    187 #endif
    188 }
    189 
    190 void
    191 efi_exit(void)
    192 {
    193 	EFI_STATUS status;
    194 
    195 	status = uefi_call_wrapper(BS->Exit, 4, IH, EFI_ABORTED, 0, NULL);
    196 	if (EFI_ERROR(status))
    197 		printf("WARNING: Exit failed\n");
    198 }
    199 
    200 void
    201 efi_reboot(void)
    202 {
    203 	uefi_call_wrapper(RT->ResetSystem, 4, EfiResetCold, EFI_SUCCESS, 0, NULL);
    204 
    205 	printf("WARNING: Reset failed\n");
    206 }
    207 
    208 void
    209 efi_delay(int us)
    210 {
    211 	EFI_STATUS status;
    212 	UINTN val;
    213 
    214 	if (delay_ev == 0) {
    215 		status = uefi_call_wrapper(BS->CreateEvent, 5, EVT_TIMER, TPL_APPLICATION, 0, 0, &delay_ev);
    216 		if (EFI_ERROR(status))
    217 			return;
    218 	}
    219 
    220 	uefi_call_wrapper(BS->SetTimer, 3, delay_ev, TimerRelative, us * 10);
    221 	uefi_call_wrapper(BS->WaitForEvent, 3, 1, &delay_ev, &val);
    222 }
    223 
    224 void
    225 efi_progress(const char *fmt, ...)
    226 {
    227 	va_list ap;
    228 
    229 	if ((howto & AB_SILENT) != 0)
    230 		return;
    231 
    232 	va_start(ap, fmt);
    233 	vprintf(fmt, ap);
    234 	va_end(ap);
    235 }
    236