1/*- 2 * Copyright (c) 2004, 2006 Marcel Moolenaar 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD$"); 29 30#include <stand.h> 31 32#include <efi.h> 33#include <efilib.h> 34 35#include <libia64.h> 36 37#define EFI_INTEL_FPSWA \ 38 {0xc41b6531,0x97b9,0x11d3,{0x9a,0x29,0x00,0x90,0x27,0x3f,0xc1,0x4d}} 39 40static EFI_GUID fpswa_guid = EFI_INTEL_FPSWA; 41 42/* DIG64 Headless Console & Debug Port Table. */ 43#define HCDP_TABLE_GUID \ 44 {0xf951938d,0x620b,0x42ef,{0x82,0x79,0xa8,0x4b,0x79,0x61,0x78,0x98}} 45 46static EFI_GUID hcdp_guid = HCDP_TABLE_GUID; 47 48static EFI_MEMORY_DESCRIPTOR *memmap; 49static UINTN memmapsz; 50static UINTN mapkey; 51static UINTN descsz; 52static UINT32 descver; 53 54#define IA64_EFI_CHUNK_SIZE (32 * 1048576) 55static vm_paddr_t ia64_efi_chunk; 56 57#define IA64_EFI_PGTBLSZ_MAX 1048576 58static vm_paddr_t ia64_efi_pgtbl; 59static vm_size_t ia64_efi_pgtblsz; 60 61/* Don't allocate memory below the boundary */ 62#define IA64_EFI_ALLOC_BOUNDARY 1048576 63 64static int 65ia64_efi_memmap_update(void) 66{ 67 EFI_STATUS status; 68 69 if (memmap != NULL) { 70 free(memmap); 71 memmap = NULL; 72 } 73 74 memmapsz = 0; 75 BS->GetMemoryMap(&memmapsz, NULL, &mapkey, &descsz, &descver); 76 if (memmapsz == 0) 77 return (FALSE); 78 memmap = malloc(memmapsz); 79 if (memmap == NULL) 80 return (FALSE); 81 82 status = BS->GetMemoryMap(&memmapsz, memmap, &mapkey, &descsz, 83 &descver); 84 if (EFI_ERROR(status)) { 85 free(memmap); 86 memmap = NULL; 87 return (FALSE); 88 } 89 90 return (TRUE); 91} 92 93/* 94 * Returns 0 on failure. Successful allocations return an address 95 * larger or equal to IA64_EFI_ALLOC_BOUNDARY. 96 */ 97static vm_paddr_t 98ia64_efi_alloc(vm_size_t sz) 99{ 100 EFI_PHYSICAL_ADDRESS pa; 101 EFI_MEMORY_DESCRIPTOR *mm; 102 uint8_t *mmiter, *mmiterend; 103 vm_size_t memsz; 104 UINTN npgs; 105 EFI_STATUS status; 106 107 /* We can't allocate less than a page */ 108 if (sz < EFI_PAGE_SIZE) 109 return (0); 110 111 /* The size must be a power of 2. */ 112 if (sz & (sz - 1)) 113 return (0); 114 115 if (!ia64_efi_memmap_update()) 116 return (0); 117 118 mmiter = (void *)memmap; 119 mmiterend = mmiter + memmapsz; 120 for (; mmiter < mmiterend; mmiter += descsz) { 121 mm = (void *)mmiter; 122 if (mm->Type != EfiConventionalMemory) 123 continue; 124 memsz = mm->NumberOfPages * EFI_PAGE_SIZE; 125 if (mm->PhysicalStart + memsz <= IA64_EFI_ALLOC_BOUNDARY) 126 continue; 127 /* 128 * XXX We really should make sure the memory is local to the 129 * BSP. 130 */ 131 pa = (mm->PhysicalStart < IA64_EFI_ALLOC_BOUNDARY) ? 132 IA64_EFI_ALLOC_BOUNDARY : mm->PhysicalStart; 133 pa = (pa + sz - 1) & ~(sz - 1); 134 if (pa + sz > mm->PhysicalStart + memsz) 135 continue; 136 137 npgs = EFI_SIZE_TO_PAGES(sz); 138 status = BS->AllocatePages(AllocateAddress, EfiLoaderData, 139 npgs, &pa); 140 if (!EFI_ERROR(status)) 141 return (pa); 142 } 143 144 printf("%s: unable to allocate %lx bytes\n", __func__, sz); 145 return (0); 146} 147 148vm_paddr_t 149ia64_platform_alloc(vm_offset_t va, vm_size_t sz) 150{ 151 vm_paddr_t pa; 152 153 if (va == 0) { 154 /* Page table itself. */ 155 if (sz > IA64_EFI_PGTBLSZ_MAX) 156 return (~0UL); 157 if (ia64_efi_pgtbl == 0) 158 ia64_efi_pgtbl = ia64_efi_alloc(IA64_EFI_PGTBLSZ_MAX); 159 if (ia64_efi_pgtbl != 0) 160 ia64_efi_pgtblsz = sz; 161 return (ia64_efi_pgtbl); 162 } else if (va < IA64_PBVM_BASE) { 163 /* Should not happen. */ 164 return (~0UL); 165 } 166 167 /* Loader virtual memory page. */ 168 va -= IA64_PBVM_BASE; 169 170 /* Allocate a big chunk that can be wired with a single PTE. */ 171 if (ia64_efi_chunk == 0) 172 ia64_efi_chunk = ia64_efi_alloc(IA64_EFI_CHUNK_SIZE); 173 if (va < IA64_EFI_CHUNK_SIZE) 174 return (ia64_efi_chunk + va); 175 176 /* Allocate a page at a time when we go beyond the chunk. */ 177 pa = ia64_efi_alloc(sz); 178 return ((pa == 0) ? ~0UL : pa); 179} 180 181void 182ia64_platform_free(vm_offset_t va, vm_paddr_t pa, vm_size_t sz) 183{ 184 185 BS->FreePages(pa, sz >> EFI_PAGE_SHIFT); 186} 187 188int 189ia64_platform_bootinfo(struct bootinfo *bi, struct bootinfo **res) 190{ 191 VOID *fpswa; 192 EFI_HANDLE handle; 193 EFI_STATUS status; 194 UINTN sz; 195 196 bi->bi_systab = (uint64_t)ST; 197 bi->bi_hcdp = (uint64_t)efi_get_table(&hcdp_guid); 198 199 sz = sizeof(EFI_HANDLE); 200 status = BS->LocateHandle(ByProtocol, &fpswa_guid, 0, &sz, &handle); 201 if (status == 0) 202 status = BS->HandleProtocol(handle, &fpswa_guid, &fpswa); 203 bi->bi_fpswa = (status == 0) ? (uint64_t)fpswa : 0; 204 205 if (!ia64_efi_memmap_update()) 206 return (ENOMEM); 207 208 bi->bi_memmap = (uint64_t)memmap; 209 bi->bi_memmap_size = memmapsz; 210 bi->bi_memdesc_size = descsz; 211 bi->bi_memdesc_version = descver; 212 213 if (IS_LEGACY_KERNEL()) 214 *res = malloc(sizeof(**res)); 215 216 return (0); 217} 218 219int 220ia64_platform_enter(const char *kernel) 221{ 222 EFI_STATUS status; 223 224 status = BS->ExitBootServices(IH, mapkey); 225 if (EFI_ERROR(status)) { 226 printf("%s: ExitBootServices() returned 0x%lx\n", __func__, 227 (long)status); 228 return (EINVAL); 229 } 230 231 return (0); 232} 233 234COMMAND_SET(pbvm, "pbvm", "show PBVM details", command_pbvm); 235 236static int 237command_pbvm(int argc, char *argv[]) 238{ 239 uint64_t limit, pg, start; 240 u_int idx; 241 242 printf("Page table @ %p, size %x\n", ia64_pgtbl, ia64_pgtblsz); 243 244 if (ia64_pgtbl == NULL) 245 return (0); 246 247 limit = ~0; 248 start = ~0; 249 idx = 0; 250 while (ia64_pgtbl[idx] != 0) { 251 pg = ia64_pgtbl[idx]; 252 if (pg != limit) { 253 if (start != ~0) 254 printf("%#lx-%#lx\n", start, limit); 255 start = pg; 256 } 257 limit = pg + IA64_PBVM_PAGE_SIZE; 258 idx++; 259 } 260 if (start != ~0) 261 printf("%#lx-%#lx\n", start, limit); 262 263 return (0); 264} 265