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