exec_multiboot2.c revision 1.2.2.2
1 1.2.2.2 martin /* $NetBSD: exec_multiboot2.c,v 1.2.2.2 2019/09/17 19:32:00 martin Exp $ */ 2 1.2.2.2 martin 3 1.2.2.2 martin /* 4 1.2.2.2 martin * Copyright (c) 2019 The NetBSD Foundation, Inc. 5 1.2.2.2 martin * All rights reserved. 6 1.2.2.2 martin * 7 1.2.2.2 martin * Redistribution and use in source and binary forms, with or without 8 1.2.2.2 martin * modification, are permitted provided that the following conditions 9 1.2.2.2 martin * are met: 10 1.2.2.2 martin * 1. Redistributions of source code must retain the above copyright 11 1.2.2.2 martin * notice, this list of conditions and the following disclaimer. 12 1.2.2.2 martin * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.2.2 martin * notice, this list of conditions and the following disclaimer in the 14 1.2.2.2 martin * documentation and/or other materials provided with the distribution. 15 1.2.2.2 martin * 16 1.2.2.2 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.2.2.2 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.2.2.2 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.2.2.2 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.2.2.2 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.2.2.2 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.2.2.2 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.2.2.2 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.2.2.2 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.2.2.2 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.2.2.2 martin * POSSIBILITY OF SUCH DAMAGE. 27 1.2.2.2 martin */ 28 1.2.2.2 martin 29 1.2.2.2 martin #include <sys/param.h> 30 1.2.2.2 martin #include <sys/reboot.h> 31 1.2.2.2 martin #include <sys/types.h> 32 1.2.2.2 martin 33 1.2.2.2 martin #include <i386/multiboot2.h> 34 1.2.2.2 martin 35 1.2.2.2 martin #include <dev/acpi/acpica.h> 36 1.2.2.2 martin #include <x86/acpi_machdep.h> 37 1.2.2.2 martin #include <x86/smbiosvar.h> 38 1.2.2.2 martin 39 1.2.2.2 martin #include <lib/libsa/stand.h> 40 1.2.2.2 martin #include <lib/libkern/libkern.h> 41 1.2.2.2 martin 42 1.2.2.2 martin 43 1.2.2.2 martin #include "loadfile.h" 44 1.2.2.2 martin #include "libi386.h" 45 1.2.2.2 martin #include "biosdisk.h" 46 1.2.2.2 martin #include "bootinfo.h" 47 1.2.2.2 martin #include "bootmod.h" 48 1.2.2.2 martin #include "vbe.h" 49 1.2.2.2 martin #ifdef EFIBOOT 50 1.2.2.2 martin #include "efiboot.h" 51 1.2.2.2 martin #endif 52 1.2.2.2 martin 53 1.2.2.2 martin #define CGA_BUF 0xb8000 /* From isa_machdep.h */ 54 1.2.2.2 martin 55 1.2.2.2 martin extern const char bootprog_name[], bootprog_rev[], bootprog_kernrev[]; 56 1.2.2.2 martin extern const uint8_t rasops_cmap[]; 57 1.2.2.2 martin extern struct btinfo_framebuffer btinfo_framebuffer; 58 1.2.2.2 martin extern struct btinfo_modulelist *btinfo_modulelist; 59 1.2.2.2 martin #ifdef EFIBOOT 60 1.2.2.2 martin extern struct btinfo_efimemmap *btinfo_efimemmap; 61 1.2.2.2 martin #else 62 1.2.2.2 martin extern struct btinfo_memmap *btinfo_memmap; 63 1.2.2.2 martin #endif 64 1.2.2.2 martin 65 1.2.2.2 martin 66 1.2.2.2 martin struct multiboot_package_priv { 67 1.2.2.2 martin struct multiboot_tag *mpp_mbi; 68 1.2.2.2 martin size_t mpp_mbi_len; 69 1.2.2.2 martin struct multiboot_header_tag_information_request*mpp_info_req; 70 1.2.2.2 martin struct multiboot_header_tag_address *mpp_address; 71 1.2.2.2 martin struct multiboot_header_tag_entry_address *mpp_entry; 72 1.2.2.2 martin struct multiboot_header_tag_console_flags *mpp_console; 73 1.2.2.2 martin struct multiboot_header_tag_framebuffer *mpp_framebuffer; 74 1.2.2.2 martin struct multiboot_header_tag *mpp_module_align; 75 1.2.2.2 martin struct multiboot_header_tag *mpp_efi_bs; 76 1.2.2.2 martin struct multiboot_header_tag_entry_address *mpp_entry_elf32; 77 1.2.2.2 martin struct multiboot_header_tag_entry_address *mpp_entry_elf64; 78 1.2.2.2 martin struct multiboot_header_tag_relocatable *mpp_relocatable; 79 1.2.2.2 martin }; 80 1.2.2.2 martin 81 1.2.2.2 martin #ifndef NO_MULTIBOOT2 82 1.2.2.2 martin 83 1.2.2.2 martin #ifdef MULTIBOOT2_DEBUG 84 1.2.2.2 martin static void 85 1.2.2.2 martin mbi_hexdump(char *addr, size_t len) 86 1.2.2.2 martin { 87 1.2.2.2 martin int i,j; 88 1.2.2.2 martin 89 1.2.2.2 martin for (i = 0; i < len; i += 16) { 90 1.2.2.2 martin printf(" %p ", addr + i); 91 1.2.2.2 martin for (j = 0; j < 16 && i + j < len; j++) { 92 1.2.2.2 martin char *cp = addr + i + j; 93 1.2.2.2 martin printf("%s%s%x", 94 1.2.2.2 martin (i+j) % 4 ? "" : " ", 95 1.2.2.2 martin (unsigned char)*cp < 0x10 ? "0" : "", 96 1.2.2.2 martin (unsigned char)*cp); 97 1.2.2.2 martin } 98 1.2.2.2 martin printf("\n"); 99 1.2.2.2 martin } 100 1.2.2.2 martin 101 1.2.2.2 martin return; 102 1.2.2.2 martin } 103 1.2.2.2 martin 104 1.2.2.2 martin static const char * 105 1.2.2.2 martin mbi_tag_name(uint32_t type) 106 1.2.2.2 martin { 107 1.2.2.2 martin const char *tag_name; 108 1.2.2.2 martin 109 1.2.2.2 martin switch (type) { 110 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_END: 111 1.2.2.2 martin tag_name = "END"; break; 112 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_CMDLINE: 113 1.2.2.2 martin tag_name = "CMDLINE"; break; 114 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME: 115 1.2.2.2 martin tag_name = "BOOT_LOADER_NAME"; break; 116 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MODULE: 117 1.2.2.2 martin tag_name = "MODULE"; break; 118 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO: 119 1.2.2.2 martin tag_name = "BASIC_MEMINFO"; break; 120 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOTDEV: 121 1.2.2.2 martin tag_name = "BOOTDEV"; break; 122 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MMAP: 123 1.2.2.2 martin tag_name = "MMAP"; break; 124 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_VBE: 125 1.2.2.2 martin tag_name = "VBE"; break; 126 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_FRAMEBUFFER: 127 1.2.2.2 martin tag_name = "FRAMEBUFFER"; break; 128 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ELF_SECTIONS: 129 1.2.2.2 martin tag_name = "ELF_SECTIONS"; break; 130 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_APM: 131 1.2.2.2 martin tag_name = "APM"; break; 132 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32: 133 1.2.2.2 martin tag_name = "EFI32"; break; 134 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64: 135 1.2.2.2 martin tag_name = "EFI64"; break; 136 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_SMBIOS: 137 1.2.2.2 martin tag_name = "SMBIOS"; break; 138 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_OLD: 139 1.2.2.2 martin tag_name = "ACPI_OLD"; break; 140 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_NEW: 141 1.2.2.2 martin tag_name = "ACPI_NEW"; break; 142 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_NETWORK: 143 1.2.2.2 martin tag_name = "NETWORK"; break; 144 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_MMAP: 145 1.2.2.2 martin tag_name = "EFI_MMAP"; break; 146 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_BS: 147 1.2.2.2 martin tag_name = "EFI_BS"; break; 148 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32_IH: 149 1.2.2.2 martin tag_name = "EFI32_IH"; break; 150 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64_IH: 151 1.2.2.2 martin tag_name = "EFI64_IH"; break; 152 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR: 153 1.2.2.2 martin tag_name = "LOAD_BASE_ADDR"; break; 154 1.2.2.2 martin default: 155 1.2.2.2 martin tag_name = "unknown"; break; 156 1.2.2.2 martin } 157 1.2.2.2 martin 158 1.2.2.2 martin return tag_name; 159 1.2.2.2 martin } 160 1.2.2.2 martin 161 1.2.2.2 martin static void 162 1.2.2.2 martin multiboot2_info_dump(uint32_t magic, char *mbi) 163 1.2.2.2 martin { 164 1.2.2.2 martin struct multiboot_tag *mbt; 165 1.2.2.2 martin char *cp; 166 1.2.2.2 martin uint32_t total_size; 167 1.2.2.2 martin uint32_t actual_size; 168 1.2.2.2 martin uint32_t reserved; 169 1.2.2.2 martin int i = 0; 170 1.2.2.2 martin 171 1.2.2.2 martin printf("=== multiboot2 info dump start ===\n"); 172 1.2.2.2 martin 173 1.2.2.2 martin if (magic != MULTIBOOT2_BOOTLOADER_MAGIC) { 174 1.2.2.2 martin printf("Unexpected multiboot2 magic number: 0x%x\n", magic); 175 1.2.2.2 martin goto out; 176 1.2.2.2 martin } 177 1.2.2.2 martin 178 1.2.2.2 martin if (mbi != (char *)rounddown((vaddr_t)mbi, MULTIBOOT_TAG_ALIGN)) { 179 1.2.2.2 martin printf("mbi at %p is not properly aligned\n", mbi); 180 1.2.2.2 martin goto out; 181 1.2.2.2 martin } 182 1.2.2.2 martin 183 1.2.2.2 martin total_size = *(uint32_t *)mbi; 184 1.2.2.2 martin reserved = *(uint32_t *)mbi + 1; 185 1.2.2.2 martin mbt = (struct multiboot_tag *)(uint32_t *)mbi + 2; 186 1.2.2.2 martin actual_size = (char *)mbt - mbi; 187 1.2.2.2 martin printf("mbi.total_size = %d\n", total_size); 188 1.2.2.2 martin printf("mbi.reserved = %d\n", reserved); 189 1.2.2.2 martin 190 1.2.2.2 martin for (cp = mbi + sizeof(total_size) + sizeof(reserved); 191 1.2.2.2 martin cp - mbi < total_size; 192 1.2.2.2 martin cp = cp + roundup(mbt->size, MULTIBOOT_TAG_ALIGN)) { 193 1.2.2.2 martin mbt = (struct multiboot_tag *)cp; 194 1.2.2.2 martin actual_size += roundup(mbt->size, MULTIBOOT_TAG_ALIGN); 195 1.2.2.2 martin 196 1.2.2.2 martin printf("mbi[%d].type = %d(%s), .size = %d ", 197 1.2.2.2 martin i++, mbt->type, mbi_tag_name(mbt->type), mbt->size); 198 1.2.2.2 martin 199 1.2.2.2 martin switch (mbt->type) { 200 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_CMDLINE: 201 1.2.2.2 martin printf(".string = \"%s\"\n", 202 1.2.2.2 martin ((struct multiboot_tag_string *)mbt)->string); 203 1.2.2.2 martin break; 204 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME: 205 1.2.2.2 martin printf(".string = \"%s\"\n", 206 1.2.2.2 martin ((struct multiboot_tag_string *)mbt)->string); 207 1.2.2.2 martin break; 208 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MODULE: 209 1.2.2.2 martin printf(".mod_start = 0x%x, mod_end = 0x%x, " 210 1.2.2.2 martin "string = \"%s\"\n", 211 1.2.2.2 martin ((struct multiboot_tag_module *)mbt)->mod_start, 212 1.2.2.2 martin ((struct multiboot_tag_module *)mbt)->mod_end, 213 1.2.2.2 martin ((struct multiboot_tag_module *)mbt)->cmdline); 214 1.2.2.2 martin break; 215 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO: { 216 1.2.2.2 martin struct multiboot_tag_basic_meminfo *meminfo; 217 1.2.2.2 martin 218 1.2.2.2 martin meminfo = (struct multiboot_tag_basic_meminfo *)mbt; 219 1.2.2.2 martin printf(".mem_lower = %uKB, .mem_upper = %uKB\n", 220 1.2.2.2 martin meminfo->mem_lower, meminfo->mem_upper); 221 1.2.2.2 martin break; 222 1.2.2.2 martin } 223 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOTDEV: 224 1.2.2.2 martin printf (".biosdev = 0x%x, .slice = %d, .part = %d\n", 225 1.2.2.2 martin ((struct multiboot_tag_bootdev *)mbt)->biosdev, 226 1.2.2.2 martin ((struct multiboot_tag_bootdev *)mbt)->slice, 227 1.2.2.2 martin ((struct multiboot_tag_bootdev *)mbt)->part); 228 1.2.2.2 martin break; 229 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MMAP: { 230 1.2.2.2 martin struct multiboot_tag_mmap *memmap; 231 1.2.2.2 martin multiboot_memory_map_t *mmap; 232 1.2.2.2 martin uint32_t entry_size; 233 1.2.2.2 martin uint32_t entry_version; 234 1.2.2.2 martin int j = 0; 235 1.2.2.2 martin 236 1.2.2.2 martin memmap = (struct multiboot_tag_mmap *)mbt; 237 1.2.2.2 martin entry_size = memmap->entry_size; 238 1.2.2.2 martin entry_version = memmap->entry_version; 239 1.2.2.2 martin printf (".entry_size = %d, .entry_version = %d\n", 240 1.2.2.2 martin entry_size, entry_version); 241 1.2.2.2 martin 242 1.2.2.2 martin for (mmap = ((struct multiboot_tag_mmap *)mbt)->entries; 243 1.2.2.2 martin (char *)mmap - (char *)mbt < mbt->size; 244 1.2.2.2 martin mmap = (void *)((char *)mmap + entry_size)) 245 1.2.2.2 martin printf(" entry[%d].addr = 0x%"PRIx64",\t" 246 1.2.2.2 martin ".len = 0x%"PRIx64",\t.type = 0x%x\n", 247 1.2.2.2 martin j++, (uint64_t)mmap->addr, 248 1.2.2.2 martin (uint64_t)mmap->len, 249 1.2.2.2 martin mmap->type); 250 1.2.2.2 martin break; 251 1.2.2.2 martin } 252 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_FRAMEBUFFER: { 253 1.2.2.2 martin struct multiboot_tag_framebuffer *fb = (void *)mbt; 254 1.2.2.2 martin 255 1.2.2.2 martin printf ("%dx%dx%d at 0x%"PRIx64"\n", 256 1.2.2.2 martin fb->common.framebuffer_width, 257 1.2.2.2 martin fb->common.framebuffer_height, 258 1.2.2.2 martin fb->common.framebuffer_bpp, 259 1.2.2.2 martin (uint64_t)fb->common.framebuffer_addr); 260 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 261 1.2.2.2 martin break; 262 1.2.2.2 martin } 263 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ELF_SECTIONS: 264 1.2.2.2 martin printf(".num = %d, .entsize = %d, .shndx = %d\n", 265 1.2.2.2 martin ((struct multiboot_tag_elf_sections *)mbt)->num, 266 1.2.2.2 martin ((struct multiboot_tag_elf_sections *)mbt)->entsize, 267 1.2.2.2 martin ((struct multiboot_tag_elf_sections *)mbt)->shndx); 268 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 269 1.2.2.2 martin break; 270 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_APM: 271 1.2.2.2 martin printf(".version = %d, .cseg = 0x%x, .offset = 0x%x, " 272 1.2.2.2 martin ".cseg_16 = 0x%x, .dseg = 0x%x, .flags = 0x%x, " 273 1.2.2.2 martin ".cseg_len = %d, .cseg_16_len = %d, " 274 1.2.2.2 martin ".dseg_len = %d\n", 275 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->version, 276 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->cseg, 277 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->offset, 278 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->cseg_16, 279 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->dseg, 280 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->flags, 281 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->cseg_len, 282 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->cseg_16_len, 283 1.2.2.2 martin ((struct multiboot_tag_apm *)mbt)->dseg_len); 284 1.2.2.2 martin break; 285 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32: 286 1.2.2.2 martin printf(".pointer = 0x%x\n", 287 1.2.2.2 martin ((struct multiboot_tag_efi32 *)mbt)->pointer); 288 1.2.2.2 martin break; 289 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64: 290 1.2.2.2 martin printf(".pointer = 0x%"PRIx64"\n", (uint64_t) 291 1.2.2.2 martin ((struct multiboot_tag_efi64 *)mbt)->pointer); 292 1.2.2.2 martin break; 293 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_SMBIOS: 294 1.2.2.2 martin printf(".major = %d, .minor = %d\n", 295 1.2.2.2 martin ((struct multiboot_tag_smbios *)mbt)->major, 296 1.2.2.2 martin ((struct multiboot_tag_smbios *)mbt)->minor); 297 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 298 1.2.2.2 martin break; 299 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_OLD: 300 1.2.2.2 martin printf("\n"); 301 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 302 1.2.2.2 martin break; 303 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_NEW: 304 1.2.2.2 martin printf("\n"); 305 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 306 1.2.2.2 martin break; 307 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_NETWORK: 308 1.2.2.2 martin printf("\n"); 309 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 310 1.2.2.2 martin break; 311 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_MMAP: 312 1.2.2.2 martin printf("\n"); 313 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 314 1.2.2.2 martin break; 315 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_BS: 316 1.2.2.2 martin printf("\n"); 317 1.2.2.2 martin break; 318 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32_IH: 319 1.2.2.2 martin printf(".pointer = 0x%"PRIx32"\n", 320 1.2.2.2 martin ((struct multiboot_tag_efi32_ih *)mbt)->pointer); 321 1.2.2.2 martin break; 322 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64_IH: 323 1.2.2.2 martin printf(".pointer = 0x%"PRIx64"\n", (uint64_t) 324 1.2.2.2 martin ((struct multiboot_tag_efi64_ih *)mbt)->pointer); 325 1.2.2.2 martin break; 326 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR: { 327 1.2.2.2 martin struct multiboot_tag_load_base_addr *ld = (void *)mbt; 328 1.2.2.2 martin printf(".load_base_addr = 0x%x\n", ld->load_base_addr); 329 1.2.2.2 martin break; 330 1.2.2.2 martin } 331 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_END: 332 1.2.2.2 martin break; 333 1.2.2.2 martin default: 334 1.2.2.2 martin printf("\n"); 335 1.2.2.2 martin mbi_hexdump((char *)mbt, mbt->size); 336 1.2.2.2 martin break; 337 1.2.2.2 martin } 338 1.2.2.2 martin } 339 1.2.2.2 martin 340 1.2.2.2 martin if (total_size != actual_size) 341 1.2.2.2 martin printf("Size mismatch: announded %d, actual %d\n", 342 1.2.2.2 martin total_size, actual_size); 343 1.2.2.2 martin 344 1.2.2.2 martin out: 345 1.2.2.2 martin printf("=== multiboot2 info dump start ===\n"); 346 1.2.2.2 martin return; 347 1.2.2.2 martin } 348 1.2.2.2 martin 349 1.2.2.2 martin #define MPP_OPT(flags) \ 350 1.2.2.2 martin (flags & MULTIBOOT_HEADER_TAG_OPTIONAL) ? " (opt)" : " (req)" 351 1.2.2.2 martin 352 1.2.2.2 martin static 353 1.2.2.2 martin void multiboot2_header_dump(struct multiboot_package *mbp) 354 1.2.2.2 martin { 355 1.2.2.2 martin struct multiboot_package_priv *mpp = mbp->mbp_priv; 356 1.2.2.2 martin 357 1.2.2.2 martin printf("=== multiboot2 header dump start ===\n"); 358 1.2.2.2 martin if (mpp->mpp_info_req) { 359 1.2.2.2 martin struct multiboot_header_tag_information_request *info_req; 360 1.2.2.2 martin size_t nreq; 361 1.2.2.2 martin int i; 362 1.2.2.2 martin 363 1.2.2.2 martin info_req = mpp->mpp_info_req; 364 1.2.2.2 martin 365 1.2.2.2 martin nreq = (info_req->size - sizeof(*info_req)) 366 1.2.2.2 martin / sizeof(info_req->requests[0]); 367 1.2.2.2 martin 368 1.2.2.2 martin printf("Information tag request%s: ", 369 1.2.2.2 martin MPP_OPT(info_req->flags)); 370 1.2.2.2 martin for (i = 0; i < nreq; i++) 371 1.2.2.2 martin printf("%d(%s) ", 372 1.2.2.2 martin info_req->requests[i], 373 1.2.2.2 martin mbi_tag_name(info_req->requests[i])); 374 1.2.2.2 martin printf("\n"); 375 1.2.2.2 martin } 376 1.2.2.2 martin 377 1.2.2.2 martin if (mpp->mpp_address) 378 1.2.2.2 martin printf("Addresses%s: header = %"PRIx32", load = %"PRIx32", " 379 1.2.2.2 martin "end = %"PRIx32", bss = %"PRIx32"\n", 380 1.2.2.2 martin MPP_OPT(mpp->mpp_address->flags), 381 1.2.2.2 martin mpp->mpp_address->header_addr, 382 1.2.2.2 martin mpp->mpp_address->load_addr, 383 1.2.2.2 martin mpp->mpp_address->load_end_addr, 384 1.2.2.2 martin mpp->mpp_address->bss_end_addr); 385 1.2.2.2 martin 386 1.2.2.2 martin if (mpp->mpp_entry) 387 1.2.2.2 martin printf("Entry point%s: %"PRIx32"\n", 388 1.2.2.2 martin MPP_OPT(mpp->mpp_entry->flags), 389 1.2.2.2 martin mpp->mpp_entry->entry_addr); 390 1.2.2.2 martin 391 1.2.2.2 martin if (mpp->mpp_console) { 392 1.2.2.2 martin int flags = mpp->mpp_console->console_flags; 393 1.2.2.2 martin char *req_flag = ""; 394 1.2.2.2 martin char *ega_flag = ""; 395 1.2.2.2 martin 396 1.2.2.2 martin if (flags & MULTIBOOT_CONSOLE_FLAGS_EGA_TEXT_SUPPORTED) 397 1.2.2.2 martin ega_flag = " EGA"; 398 1.2.2.2 martin if (flags & MULTIBOOT_CONSOLE_FLAGS_CONSOLE_REQUIRED) 399 1.2.2.2 martin req_flag = " required"; 400 1.2.2.2 martin 401 1.2.2.2 martin printf("Console flags%s: %s %s\n", 402 1.2.2.2 martin MPP_OPT(mpp->mpp_console->flags), 403 1.2.2.2 martin ega_flag, req_flag); 404 1.2.2.2 martin } 405 1.2.2.2 martin 406 1.2.2.2 martin if (mpp->mpp_framebuffer) 407 1.2.2.2 martin printf("Framebuffer%s: width = %d, height = %d, depth = %d\n", 408 1.2.2.2 martin MPP_OPT(mpp->mpp_framebuffer->flags), 409 1.2.2.2 martin mpp->mpp_framebuffer->width, 410 1.2.2.2 martin mpp->mpp_framebuffer->height, 411 1.2.2.2 martin mpp->mpp_framebuffer->depth); 412 1.2.2.2 martin 413 1.2.2.2 martin if (mpp->mpp_module_align) 414 1.2.2.2 martin printf("Module alignmenet%s\n", 415 1.2.2.2 martin MPP_OPT(mpp->mpp_module_align->flags)); 416 1.2.2.2 martin 417 1.2.2.2 martin if (mpp->mpp_efi_bs) 418 1.2.2.2 martin printf("Do not call EFI Boot service exit%s\n", 419 1.2.2.2 martin MPP_OPT(mpp->mpp_efi_bs->flags)); 420 1.2.2.2 martin 421 1.2.2.2 martin if (mpp->mpp_entry_elf32) 422 1.2.2.2 martin printf("EFI32 entry point%s: %"PRIx32"\n", 423 1.2.2.2 martin MPP_OPT(mpp->mpp_entry_elf32->flags), 424 1.2.2.2 martin mpp->mpp_entry_elf32->entry_addr); 425 1.2.2.2 martin 426 1.2.2.2 martin if (mpp->mpp_entry_elf64) 427 1.2.2.2 martin printf("EFI64 entry point%s: %"PRIx32"\n", 428 1.2.2.2 martin MPP_OPT(mpp->mpp_entry_elf64->flags), 429 1.2.2.2 martin mpp->mpp_entry_elf64->entry_addr); 430 1.2.2.2 martin 431 1.2.2.2 martin if (mpp->mpp_relocatable) { 432 1.2.2.2 martin char *pref; 433 1.2.2.2 martin 434 1.2.2.2 martin switch (mpp->mpp_relocatable->preference) { 435 1.2.2.2 martin case MULTIBOOT_LOAD_PREFERENCE_NONE: pref = "none"; break; 436 1.2.2.2 martin case MULTIBOOT_LOAD_PREFERENCE_LOW: pref = "low"; break; 437 1.2.2.2 martin case MULTIBOOT_LOAD_PREFERENCE_HIGH: pref = "high"; break; 438 1.2.2.2 martin default: 439 1.2.2.2 martin pref = "(unknown)"; break; 440 1.2.2.2 martin } 441 1.2.2.2 martin printf("Relocatable%s: min_addr = %"PRIx32", " 442 1.2.2.2 martin "max_addr = %"PRIx32", align = %"PRIx32", pref %s\n", 443 1.2.2.2 martin MPP_OPT(mpp->mpp_relocatable->flags), 444 1.2.2.2 martin mpp->mpp_relocatable->min_addr, 445 1.2.2.2 martin mpp->mpp_relocatable->max_addr, 446 1.2.2.2 martin mpp->mpp_relocatable->align, pref); 447 1.2.2.2 martin } 448 1.2.2.2 martin 449 1.2.2.2 martin printf("=== multiboot2 header dump end ===\n"); 450 1.2.2.2 martin return; 451 1.2.2.2 martin } 452 1.2.2.2 martin #endif /* MULTIBOOT2_DEBUG */ 453 1.2.2.2 martin 454 1.2.2.2 martin static size_t 455 1.2.2.2 martin mbi_cmdline(struct multiboot_package *mbp, void *buf) 456 1.2.2.2 martin { 457 1.2.2.2 martin struct multiboot_tag_string *mbt = buf; 458 1.2.2.2 martin size_t cmdlen; 459 1.2.2.2 martin size_t len; 460 1.2.2.2 martin const char fmt[] = "%s %s"; 461 1.2.2.2 martin 462 1.2.2.2 martin /* +1 for trailing \0 */ 463 1.2.2.2 martin cmdlen = snprintf(NULL, SIZE_T_MAX, fmt, mbp->mbp_file, mbp->mbp_args) 464 1.2.2.2 martin + 1; 465 1.2.2.2 martin len = sizeof(*mbt) + cmdlen; 466 1.2.2.2 martin 467 1.2.2.2 martin if (mbt) { 468 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_CMDLINE; 469 1.2.2.2 martin mbt->size = len; 470 1.2.2.2 martin (void)snprintf(mbt->string, cmdlen, fmt, 471 1.2.2.2 martin mbp->mbp_file, mbp->mbp_args); 472 1.2.2.2 martin } 473 1.2.2.2 martin 474 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 475 1.2.2.2 martin } 476 1.2.2.2 martin 477 1.2.2.2 martin static size_t 478 1.2.2.2 martin mbi_boot_loader_name(struct multiboot_package *mbp, void *buf) 479 1.2.2.2 martin { 480 1.2.2.2 martin struct multiboot_tag_string *mbt = buf; 481 1.2.2.2 martin size_t len; 482 1.2.2.2 martin size_t strlen; 483 1.2.2.2 martin const char fmt[] = "%s, Revision %s (from NetBSD %s)"; 484 1.2.2.2 martin 485 1.2.2.2 martin 486 1.2.2.2 martin /* +1 for trailing \0 */ 487 1.2.2.2 martin strlen = snprintf(NULL, SIZE_T_MAX, fmt, 488 1.2.2.2 martin bootprog_name, bootprog_rev, bootprog_kernrev) 489 1.2.2.2 martin + 1; 490 1.2.2.2 martin len = sizeof(*mbt) + strlen; 491 1.2.2.2 martin 492 1.2.2.2 martin if (mbt) { 493 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME; 494 1.2.2.2 martin mbt->size = len; 495 1.2.2.2 martin (void)snprintf(mbt->string, strlen, fmt, bootprog_name, 496 1.2.2.2 martin bootprog_rev, bootprog_kernrev); 497 1.2.2.2 martin } 498 1.2.2.2 martin 499 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 500 1.2.2.2 martin } 501 1.2.2.2 martin 502 1.2.2.2 martin static size_t 503 1.2.2.2 martin mbi_modules(struct multiboot_package *mbp, void *buf) 504 1.2.2.2 martin { 505 1.2.2.2 martin struct multiboot_tag_module *mbt = buf; 506 1.2.2.2 martin struct bi_modulelist_entry *bim; 507 1.2.2.2 martin size_t len; 508 1.2.2.2 martin int i; 509 1.2.2.2 martin 510 1.2.2.2 martin if (btinfo_modulelist == NULL) 511 1.2.2.2 martin return 0; 512 1.2.2.2 martin 513 1.2.2.2 martin len = 0; 514 1.2.2.2 martin 515 1.2.2.2 martin bim = (struct bi_modulelist_entry *)(btinfo_modulelist + 1); 516 1.2.2.2 martin for (i = 0; i < btinfo_modulelist->num; i++) { 517 1.2.2.2 martin size_t pathlen = strlen(bim->path) + 1; 518 1.2.2.2 martin size_t mbt_len = sizeof(*mbt) + pathlen; 519 1.2.2.2 martin size_t mbt_len_align = roundup(mbt_len, MULTIBOOT_TAG_ALIGN); 520 1.2.2.2 martin len += mbt_len_align; 521 1.2.2.2 martin 522 1.2.2.2 martin if (mbt) { 523 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_MODULE; 524 1.2.2.2 martin mbt->size = mbt_len; 525 1.2.2.2 martin mbt->mod_start = bim->base; 526 1.2.2.2 martin mbt->mod_end = bim->base + bim->len; 527 1.2.2.2 martin strncpy(mbt->cmdline, bim->path, pathlen); 528 1.2.2.2 martin 529 1.2.2.2 martin mbt = (struct multiboot_tag_module *) 530 1.2.2.2 martin ((char *)mbt + mbt_len_align); 531 1.2.2.2 martin } 532 1.2.2.2 martin } 533 1.2.2.2 martin 534 1.2.2.2 martin return len; 535 1.2.2.2 martin } 536 1.2.2.2 martin 537 1.2.2.2 martin static size_t 538 1.2.2.2 martin mbi_basic_meminfo(struct multiboot_package *mbp, void *buf) 539 1.2.2.2 martin { 540 1.2.2.2 martin struct multiboot_tag_basic_meminfo *mbt = buf; 541 1.2.2.2 martin size_t len; 542 1.2.2.2 martin 543 1.2.2.2 martin len = sizeof(*mbt); 544 1.2.2.2 martin 545 1.2.2.2 martin if (mbt) { 546 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_BASIC_MEMINFO; 547 1.2.2.2 martin mbt->size = len; 548 1.2.2.2 martin mbt->mem_lower = mbp->mbp_basemem; 549 1.2.2.2 martin mbt->mem_upper = mbp->mbp_extmem; 550 1.2.2.2 martin } 551 1.2.2.2 martin 552 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 553 1.2.2.2 martin } 554 1.2.2.2 martin 555 1.2.2.2 martin static size_t 556 1.2.2.2 martin mbi_bootdev(struct multiboot_package *mbp, void *buf) 557 1.2.2.2 martin { 558 1.2.2.2 martin struct multiboot_tag_bootdev *mbt = buf; 559 1.2.2.2 martin size_t len; 560 1.2.2.2 martin 561 1.2.2.2 martin len = sizeof(*mbt); 562 1.2.2.2 martin 563 1.2.2.2 martin /* 564 1.2.2.2 martin * According to the specification: 565 1.2.2.2 martin * - sub_partition is used for BSD disklabel. 566 1.2.2.2 martin * - Extendded MBR partitions are counted from 4 and increasing, 567 1.2.2.2 martin * with no subpartition. 568 1.2.2.2 martin */ 569 1.2.2.2 martin if (mbt) { 570 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_BOOTDEV; 571 1.2.2.2 martin mbt->size = len; 572 1.2.2.2 martin mbt->biosdev = bi_disk.biosdev; 573 1.2.2.2 martin mbt->slice = bi_disk.partition; 574 1.2.2.2 martin mbt->part = 0xFFFFFFFF; /* aka sub_partition, for disklabel */ 575 1.2.2.2 martin } 576 1.2.2.2 martin 577 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 578 1.2.2.2 martin return 0; 579 1.2.2.2 martin } 580 1.2.2.2 martin 581 1.2.2.2 martin static size_t 582 1.2.2.2 martin mbi_mmap(struct multiboot_package *mbp, void *buf) 583 1.2.2.2 martin { 584 1.2.2.2 martin size_t len = 0; 585 1.2.2.2 martin struct multiboot_tag_mmap *mbt = buf; 586 1.2.2.2 martin struct bi_memmap_entry *memmap; 587 1.2.2.2 martin size_t num; 588 1.2.2.2 martin 589 1.2.2.2 martin #ifndef EFIBOOT 590 1.2.2.2 martin bi_getmemmap(); 591 1.2.2.2 martin 592 1.2.2.2 martin if (btinfo_memmap == NULL) 593 1.2.2.2 martin goto out; 594 1.2.2.2 martin 595 1.2.2.2 martin memmap = btinfo_memmap->entry; 596 1.2.2.2 martin num = btinfo_memmap->num; 597 1.2.2.2 martin #else 598 1.2.2.2 martin if (efi_memory_get_memmap(&memmap, &num) != 0) 599 1.2.2.2 martin goto out; 600 1.2.2.2 martin #endif 601 1.2.2.2 martin 602 1.2.2.2 martin len = sizeof(*mbt) + num * sizeof(mbt->entries[0]); 603 1.2.2.2 martin 604 1.2.2.2 martin if (mbt) { 605 1.2.2.2 martin int i; 606 1.2.2.2 martin struct multiboot_mmap_entry *mbte; 607 1.2.2.2 martin 608 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_MMAP; 609 1.2.2.2 martin mbt->size = len; 610 1.2.2.2 martin mbt->entry_size = sizeof(mbt->entries[0]); 611 1.2.2.2 martin mbt->entry_version = 0; 612 1.2.2.2 martin 613 1.2.2.2 martin mbte = (struct multiboot_mmap_entry *)(mbt + 1); 614 1.2.2.2 martin for (i = 0; i < num; i++) { 615 1.2.2.2 martin mbte[i].addr = memmap[i].addr; 616 1.2.2.2 martin mbte[i].len = memmap[i].size; 617 1.2.2.2 martin switch(memmap[i].type) { 618 1.2.2.2 martin case BIM_Memory: 619 1.2.2.2 martin mbte[i].type = MULTIBOOT_MEMORY_AVAILABLE; 620 1.2.2.2 martin break; 621 1.2.2.2 martin case BIM_Reserved: 622 1.2.2.2 martin mbte[i].type = MULTIBOOT_MEMORY_RESERVED; 623 1.2.2.2 martin break; 624 1.2.2.2 martin case BIM_ACPI: 625 1.2.2.2 martin mbte[i].type = 626 1.2.2.2 martin MULTIBOOT_MEMORY_ACPI_RECLAIMABLE; 627 1.2.2.2 martin break; 628 1.2.2.2 martin case BIM_NVS: 629 1.2.2.2 martin mbte[i].type = MULTIBOOT_MEMORY_NVS; 630 1.2.2.2 martin break; 631 1.2.2.2 martin case BIM_Unusable: 632 1.2.2.2 martin mbte[i].type = MULTIBOOT_MEMORY_BADRAM; 633 1.2.2.2 martin break; 634 1.2.2.2 martin default: 635 1.2.2.2 martin mbte[i].type = MULTIBOOT_MEMORY_RESERVED; 636 1.2.2.2 martin break; 637 1.2.2.2 martin } 638 1.2.2.2 martin mbte[i].zero = 0; 639 1.2.2.2 martin } 640 1.2.2.2 martin } 641 1.2.2.2 martin #ifdef EFIBOOT 642 1.2.2.2 martin dealloc(memmap, num * sizeof(memmap)); 643 1.2.2.2 martin #endif 644 1.2.2.2 martin out: 645 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 646 1.2.2.2 martin } 647 1.2.2.2 martin 648 1.2.2.2 martin static size_t 649 1.2.2.2 martin mbi_vbe(struct multiboot_package *mbp, void *buf) 650 1.2.2.2 martin { 651 1.2.2.2 martin size_t len = 0; 652 1.2.2.2 martin 653 1.2.2.2 martin #ifndef EFIBOOT 654 1.2.2.2 martin struct multiboot_tag_vbe *mbt = buf; 655 1.2.2.2 martin 656 1.2.2.2 martin len = sizeof(*mbt); 657 1.2.2.2 martin 658 1.2.2.2 martin if (mbt) { 659 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_VBE; 660 1.2.2.2 martin mbt->size = len; 661 1.2.2.2 martin mbt->vbe_mode = btinfo_framebuffer.vbemode; 662 1.2.2.2 martin mbt->vbe_interface_seg = 0; 663 1.2.2.2 martin mbt->vbe_interface_off = 0; 664 1.2.2.2 martin mbt->vbe_interface_len = 0; 665 1.2.2.2 martin biosvbe_info((struct vbeinfoblock *)&mbt->vbe_control_info); 666 1.2.2.2 martin biosvbe_get_mode_info(mbt->vbe_mode, 667 1.2.2.2 martin (struct modeinfoblock *)&mbt->vbe_mode_info); 668 1.2.2.2 martin } 669 1.2.2.2 martin #endif 670 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 671 1.2.2.2 martin } 672 1.2.2.2 martin 673 1.2.2.2 martin static size_t 674 1.2.2.2 martin mbi_framebuffer(struct multiboot_package *mbp, void *buf) 675 1.2.2.2 martin { 676 1.2.2.2 martin size_t len = 0; 677 1.2.2.2 martin struct multiboot_tag_framebuffer *mbt = buf; 678 1.2.2.2 martin struct btinfo_framebuffer *fb = &btinfo_framebuffer; 679 1.2.2.2 martin 680 1.2.2.2 martin #ifndef EFIBOOT 681 1.2.2.2 martin struct modeinfoblock mi; 682 1.2.2.2 martin 683 1.2.2.2 martin if (fb->physaddr != 0) { 684 1.2.2.2 martin int ret; 685 1.2.2.2 martin 686 1.2.2.2 martin ret = biosvbe_get_mode_info(fb->vbemode, &mi); 687 1.2.2.2 martin if (ret != 0x004f) 688 1.2.2.2 martin return 0; 689 1.2.2.2 martin } 690 1.2.2.2 martin #endif 691 1.2.2.2 martin 692 1.2.2.2 martin len = sizeof(*mbt); 693 1.2.2.2 martin 694 1.2.2.2 martin if (mbt) { 695 1.2.2.2 martin mbt->common.type = MULTIBOOT_TAG_TYPE_FRAMEBUFFER; 696 1.2.2.2 martin mbt->common.size = len; 697 1.2.2.2 martin mbt->common.reserved = 0; 698 1.2.2.2 martin 699 1.2.2.2 martin /* 700 1.2.2.2 martin * No framebuffer, default to 80x25 console 701 1.2.2.2 martin */ 702 1.2.2.2 martin if (fb->physaddr == 0) { 703 1.2.2.2 martin int width = 80; 704 1.2.2.2 martin int height = 25; 705 1.2.2.2 martin int charlen = 2; 706 1.2.2.2 martin mbt->common.framebuffer_addr = CGA_BUF; 707 1.2.2.2 martin mbt->common.framebuffer_width = width; 708 1.2.2.2 martin mbt->common.framebuffer_height = height; 709 1.2.2.2 martin mbt->common.framebuffer_bpp = charlen * 8; 710 1.2.2.2 martin mbt->common.framebuffer_pitch = width * charlen; 711 1.2.2.2 martin mbt->common.framebuffer_type = 712 1.2.2.2 martin MULTIBOOT_FRAMEBUFFER_TYPE_EGA_TEXT; 713 1.2.2.2 martin } else { 714 1.2.2.2 martin mbt->common.framebuffer_addr = fb->physaddr; 715 1.2.2.2 martin mbt->common.framebuffer_pitch = fb->stride; 716 1.2.2.2 martin mbt->common.framebuffer_width = fb->width; 717 1.2.2.2 martin mbt->common.framebuffer_height = fb->height; 718 1.2.2.2 martin mbt->common.framebuffer_bpp = fb->depth; 719 1.2.2.2 martin mbt->common.framebuffer_type = 720 1.2.2.2 martin MULTIBOOT_FRAMEBUFFER_TYPE_RGB; 721 1.2.2.2 martin #ifndef EFIBOOT 722 1.2.2.2 martin if (mi.MemoryModel == 0x04) 723 1.2.2.2 martin mbt->common.framebuffer_type = 724 1.2.2.2 martin MULTIBOOT_FRAMEBUFFER_TYPE_INDEXED; 725 1.2.2.2 martin #endif 726 1.2.2.2 martin } 727 1.2.2.2 martin 728 1.2.2.2 martin switch (mbt->common.framebuffer_type) { 729 1.2.2.2 martin #ifndef EFIBOOT 730 1.2.2.2 martin case MULTIBOOT_FRAMEBUFFER_TYPE_INDEXED: 731 1.2.2.2 martin mbt->framebuffer_palette_num_colors = 256; 732 1.2.2.2 martin 733 1.2.2.2 martin for (int i = 0; i < 256; i++) { 734 1.2.2.2 martin mbt->framebuffer_palette[i].red = 735 1.2.2.2 martin rasops_cmap[3 * i]; 736 1.2.2.2 martin mbt->framebuffer_palette[i].green = 737 1.2.2.2 martin rasops_cmap[(3 * i) + 1]; 738 1.2.2.2 martin mbt->framebuffer_palette[i].blue = 739 1.2.2.2 martin rasops_cmap[(3 * i) + 2]; 740 1.2.2.2 martin } 741 1.2.2.2 martin break; 742 1.2.2.2 martin #endif 743 1.2.2.2 martin case MULTIBOOT_FRAMEBUFFER_TYPE_RGB: 744 1.2.2.2 martin mbt->framebuffer_red_field_position = fb->rpos; 745 1.2.2.2 martin mbt->framebuffer_red_mask_size = fb->rnum; 746 1.2.2.2 martin mbt->framebuffer_green_field_position = fb->gpos; 747 1.2.2.2 martin mbt->framebuffer_green_mask_size = fb->gnum; 748 1.2.2.2 martin mbt->framebuffer_blue_field_position = fb->bpos; 749 1.2.2.2 martin mbt->framebuffer_blue_mask_size = fb->bnum; 750 1.2.2.2 martin break; 751 1.2.2.2 martin default: 752 1.2.2.2 martin break; 753 1.2.2.2 martin } 754 1.2.2.2 martin } 755 1.2.2.2 martin 756 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 757 1.2.2.2 martin } 758 1.2.2.2 martin 759 1.2.2.2 martin static size_t 760 1.2.2.2 martin mbi_acpi_old(struct multiboot_package *mbp, void *buf) 761 1.2.2.2 martin { 762 1.2.2.2 martin size_t len = 0; 763 1.2.2.2 martin struct multiboot_tag_old_acpi *mbt = buf; 764 1.2.2.2 martin ACPI_PHYSICAL_ADDRESS rsdp_phys = -1; 765 1.2.2.2 martin ACPI_RSDP_COMMON rsdp; 766 1.2.2.2 martin #ifdef EFIBOOT 767 1.2.2.2 martin const EFI_GUID acpi_table_guid = ACPI_TABLE_GUID; 768 1.2.2.2 martin int i; 769 1.2.2.2 martin 770 1.2.2.2 martin if (ST == NULL) 771 1.2.2.2 martin goto out; 772 1.2.2.2 martin 773 1.2.2.2 martin for (i = 0; i < ST->NumberOfTableEntries; i++) { 774 1.2.2.2 martin if (memcmp(&ST->ConfigurationTable[i].VendorGuid, 775 1.2.2.2 martin &acpi_table_guid, sizeof(acpi_table_guid)) == 0) { 776 1.2.2.2 martin rsdp_phys = (ACPI_PHYSICAL_ADDRESS) 777 1.2.2.2 martin ST->ConfigurationTable[i].VendorTable; 778 1.2.2.2 martin break; 779 1.2.2.2 martin } 780 1.2.2.2 martin } 781 1.2.2.2 martin #else 782 1.2.2.2 martin #ifdef notyet 783 1.2.2.2 martin rsdp_phys = acpi_md_OsGetRootPointer(); 784 1.2.2.2 martin pvbcopy((void *)(vaddr_t)rsdp_phys, &rsdp, sizeof(rsdp)); 785 1.2.2.2 martin 786 1.2.2.2 martin /* Check ACPI 1.0 */ 787 1.2.2.2 martin if (rsdp.Revision != 0) 788 1.2.2.2 martin rsdp_phys = -1; 789 1.2.2.2 martin #endif 790 1.2.2.2 martin #endif 791 1.2.2.2 martin 792 1.2.2.2 martin if (rsdp_phys == -1) 793 1.2.2.2 martin goto out; 794 1.2.2.2 martin 795 1.2.2.2 martin len = sizeof(*mbt) + sizeof(rsdp); 796 1.2.2.2 martin if (mbt) { 797 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_ACPI_OLD; 798 1.2.2.2 martin mbt->size = len; 799 1.2.2.2 martin pvbcopy((void *)(vaddr_t)rsdp_phys, mbt->rsdp, sizeof(rsdp)); 800 1.2.2.2 martin } 801 1.2.2.2 martin out: 802 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 803 1.2.2.2 martin } 804 1.2.2.2 martin 805 1.2.2.2 martin static size_t 806 1.2.2.2 martin mbi_acpi_new(struct multiboot_package *mbp, void *buf) 807 1.2.2.2 martin { 808 1.2.2.2 martin size_t len = 0; 809 1.2.2.2 martin struct multiboot_tag_new_acpi *mbt = buf; 810 1.2.2.2 martin ACPI_PHYSICAL_ADDRESS rsdp_phys = -1; 811 1.2.2.2 martin ACPI_TABLE_RSDP rsdp; 812 1.2.2.2 martin #ifdef EFIBOOT 813 1.2.2.2 martin const EFI_GUID acpi_20_table_guid = ACPI_20_TABLE_GUID; 814 1.2.2.2 martin int i; 815 1.2.2.2 martin 816 1.2.2.2 martin if (ST == NULL) 817 1.2.2.2 martin goto out; 818 1.2.2.2 martin 819 1.2.2.2 martin for (i = 0; i < ST->NumberOfTableEntries; i++) { 820 1.2.2.2 martin if (memcmp(&ST->ConfigurationTable[i].VendorGuid, 821 1.2.2.2 martin &acpi_20_table_guid, sizeof(acpi_20_table_guid)) == 0) { 822 1.2.2.2 martin rsdp_phys = (ACPI_PHYSICAL_ADDRESS) 823 1.2.2.2 martin ST->ConfigurationTable[i].VendorTable; 824 1.2.2.2 martin break; 825 1.2.2.2 martin } 826 1.2.2.2 martin } 827 1.2.2.2 martin #else 828 1.2.2.2 martin #ifdef notyet 829 1.2.2.2 martin rsdp_phys = acpi_md_OsGetRootPointer(); 830 1.2.2.2 martin pvbcopy((void *)(vaddr_t)rsdp_phys, &rsdp, sizeof(rsdp)); 831 1.2.2.2 martin 832 1.2.2.2 martin /* Check ACPI 2.0 */ 833 1.2.2.2 martin if (rsdp.Revision != 2) 834 1.2.2.2 martin rsdp_phys = -1; 835 1.2.2.2 martin #endif 836 1.2.2.2 martin #endif 837 1.2.2.2 martin if (rsdp_phys == -1) 838 1.2.2.2 martin goto out; 839 1.2.2.2 martin 840 1.2.2.2 martin len = sizeof(*mbt) + sizeof(rsdp); 841 1.2.2.2 martin if (mbt) { 842 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_ACPI_NEW; 843 1.2.2.2 martin mbt->size = len; 844 1.2.2.2 martin pvbcopy((void *)(vaddr_t)rsdp_phys, mbt->rsdp, sizeof(rsdp)); 845 1.2.2.2 martin } 846 1.2.2.2 martin out: 847 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 848 1.2.2.2 martin } 849 1.2.2.2 martin 850 1.2.2.2 martin static size_t 851 1.2.2.2 martin mbi_apm(struct multiboot_package *mbp, void *buf) 852 1.2.2.2 martin { 853 1.2.2.2 martin size_t len = 0; 854 1.2.2.2 martin #ifdef notyet 855 1.2.2.2 martin struct multiboot_tag_apm *mbt = buf; 856 1.2.2.2 martin 857 1.2.2.2 martin len = sizeof(*mbt): 858 1.2.2.2 martin 859 1.2.2.2 martin if (mbt) { 860 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_A; 861 1.2.2.2 martin mbt->size = len; 862 1.2.2.2 martin mbt->version = 0; 863 1.2.2.2 martin mbt->cseg = 0; 864 1.2.2.2 martin mbt->offset = 0; 865 1.2.2.2 martin mbt->cseg_16 = 0; 866 1.2.2.2 martin mbt->dseg = 0;; 867 1.2.2.2 martin mbt->flags = 0; 868 1.2.2.2 martin mbt->cseg_len = 0; 869 1.2.2.2 martin mbt->cseg_16_len = 0; 870 1.2.2.2 martin mbt->dseg_len = 0; 871 1.2.2.2 martin } 872 1.2.2.2 martin out: 873 1.2.2.2 martin #endif 874 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 875 1.2.2.2 martin } 876 1.2.2.2 martin 877 1.2.2.2 martin static size_t 878 1.2.2.2 martin mbi_smbios(struct multiboot_package *mbp, void *buf) 879 1.2.2.2 martin { 880 1.2.2.2 martin size_t len = 0; 881 1.2.2.2 martin struct multiboot_tag_smbios *mbt = buf; 882 1.2.2.2 martin void *smbios_phys; 883 1.2.2.2 martin struct smb3hdr *smbios3_phys = NULL; 884 1.2.2.2 martin struct smb3hdr smbios3; 885 1.2.2.2 martin struct smbhdr *smbios21_phys = NULL; 886 1.2.2.2 martin struct smbhdr smbios21; 887 1.2.2.2 martin size_t smbios_len; 888 1.2.2.2 martin int major; 889 1.2.2.2 martin int minor; 890 1.2.2.2 martin #ifdef EFIBOOT 891 1.2.2.2 martin const EFI_GUID smbios3_guid = SMBIOS3_TABLE_GUID; 892 1.2.2.2 martin const EFI_GUID smbios21_guid = SMBIOS_TABLE_GUID; 893 1.2.2.2 martin int i; 894 1.2.2.2 martin 895 1.2.2.2 martin if (ST == NULL) 896 1.2.2.2 martin goto out; 897 1.2.2.2 martin 898 1.2.2.2 martin for (i = 0; i < ST->NumberOfTableEntries; i++) { 899 1.2.2.2 martin if (memcmp(&ST->ConfigurationTable[i].VendorGuid, 900 1.2.2.2 martin &smbios3_guid, sizeof(smbios3_guid)) == 0) 901 1.2.2.2 martin smbios3_phys = ST->ConfigurationTable[i].VendorTable; 902 1.2.2.2 martin 903 1.2.2.2 martin if (memcmp(&ST->ConfigurationTable[i].VendorGuid, 904 1.2.2.2 martin &smbios21_guid, sizeof(smbios21_guid)) == 0) 905 1.2.2.2 martin smbios21_phys = ST->ConfigurationTable[i].VendorTable; 906 1.2.2.2 martin } 907 1.2.2.2 martin #else 908 1.2.2.2 martin char *cp; 909 1.2.2.2 martin char line[16]; 910 1.2.2.2 martin const char *smbios21_anchor = "_SM_"; 911 1.2.2.2 martin const char *smbios3_anchor = "_SM3_"; 912 1.2.2.2 martin 913 1.2.2.2 martin for (cp = (char *)SMBIOS_START; 914 1.2.2.2 martin cp < (char *)SMBIOS_END; 915 1.2.2.2 martin cp += sizeof(buf)) { 916 1.2.2.2 martin pvbcopy(cp, line, sizeof(line)); 917 1.2.2.2 martin if (memcmp(line, smbios3_anchor, strlen(smbios3_anchor)) == 0) 918 1.2.2.2 martin smbios3_phys = (struct smb3hdr *)cp; 919 1.2.2.2 martin if (memcmp(line, smbios21_anchor, strlen(smbios21_anchor)) == 0) 920 1.2.2.2 martin smbios21_phys = (struct smbhdr *)cp; 921 1.2.2.2 martin } 922 1.2.2.2 martin #endif 923 1.2.2.2 martin if (smbios3_phys != NULL) { 924 1.2.2.2 martin pvbcopy(smbios3_phys, &smbios3, sizeof(smbios3)); 925 1.2.2.2 martin smbios_len = smbios3.len; 926 1.2.2.2 martin major = smbios3.majrev; 927 1.2.2.2 martin minor = smbios3.minrev; 928 1.2.2.2 martin smbios_phys = smbios3_phys; 929 1.2.2.2 martin } else if (smbios21_phys != NULL) { 930 1.2.2.2 martin pvbcopy(smbios21_phys, &smbios21, sizeof(smbios21)); 931 1.2.2.2 martin smbios_len = smbios21.len; 932 1.2.2.2 martin major = smbios21.majrev; 933 1.2.2.2 martin minor = smbios21.minrev; 934 1.2.2.2 martin smbios_phys = smbios21_phys; 935 1.2.2.2 martin } else { 936 1.2.2.2 martin goto out; 937 1.2.2.2 martin } 938 1.2.2.2 martin 939 1.2.2.2 martin len = sizeof(*mbt) + smbios_len; 940 1.2.2.2 martin if (mbt) { 941 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_SMBIOS; 942 1.2.2.2 martin mbt->size = len; 943 1.2.2.2 martin mbt->major = major; 944 1.2.2.2 martin mbt->minor = minor; 945 1.2.2.2 martin pvbcopy(smbios_phys, mbt->tables, smbios_len); 946 1.2.2.2 martin } 947 1.2.2.2 martin out: 948 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 949 1.2.2.2 martin } 950 1.2.2.2 martin 951 1.2.2.2 martin static size_t 952 1.2.2.2 martin mbi_network(struct multiboot_package *mbp, void *buf) 953 1.2.2.2 martin { 954 1.2.2.2 martin size_t len = 0; 955 1.2.2.2 martin #ifdef notyet 956 1.2.2.2 martin struct multiboot_tag_network *mbt = buf; 957 1.2.2.2 martin 958 1.2.2.2 martin if (saved_dhcpack == NULL || saved_dhcpack_len == 0) 959 1.2.2.2 martin goto out; 960 1.2.2.2 martin 961 1.2.2.2 martin len = sizeof(*mbt) + saved_dhcpack_len; 962 1.2.2.2 martin 963 1.2.2.2 martin if (mbt) { 964 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_NETWORK; 965 1.2.2.2 martin mbt->size = len; 966 1.2.2.2 martin memcpy(mbt->dhcpack, saved_dhcpack, saved_dhcpack_len); 967 1.2.2.2 martin } 968 1.2.2.2 martin out: 969 1.2.2.2 martin #endif 970 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 971 1.2.2.2 martin } 972 1.2.2.2 martin 973 1.2.2.2 martin static size_t 974 1.2.2.2 martin mbi_elf_sections(struct multiboot_package *mbp, void *buf) 975 1.2.2.2 martin { 976 1.2.2.2 martin size_t len = 0; 977 1.2.2.2 martin struct multiboot_tag_elf_sections *mbt = buf; 978 1.2.2.2 martin Elf_Ehdr ehdr; 979 1.2.2.2 martin Elf32_Ehdr *ehdr32 = NULL; 980 1.2.2.2 martin Elf64_Ehdr *ehdr64 = NULL; 981 1.2.2.2 martin uint32_t shnum, shentsize, shstrndx, shoff; 982 1.2.2.2 martin size_t shdr_len; 983 1.2.2.2 martin 984 1.2.2.2 martin if (mbp->mbp_marks[MARK_SYM] == 0) 985 1.2.2.2 martin goto out; 986 1.2.2.2 martin 987 1.2.2.2 martin pvbcopy((void *)mbp->mbp_marks[MARK_SYM], &ehdr, sizeof(ehdr)); 988 1.2.2.2 martin 989 1.2.2.2 martin /* 990 1.2.2.2 martin * Check this is a ELF header 991 1.2.2.2 martin */ 992 1.2.2.2 martin if (memcmp(&ehdr.e_ident, ELFMAG, SELFMAG) != 0) 993 1.2.2.2 martin goto out; 994 1.2.2.2 martin 995 1.2.2.2 martin switch (ehdr.e_ident[EI_CLASS]) { 996 1.2.2.2 martin case ELFCLASS32: 997 1.2.2.2 martin ehdr32 = (Elf32_Ehdr *)&ehdr; 998 1.2.2.2 martin shnum = ehdr32->e_shnum; 999 1.2.2.2 martin shentsize = ehdr32->e_shentsize; 1000 1.2.2.2 martin shstrndx = ehdr32->e_shstrndx; 1001 1.2.2.2 martin shoff = ehdr32->e_shoff; 1002 1.2.2.2 martin break; 1003 1.2.2.2 martin case ELFCLASS64: 1004 1.2.2.2 martin ehdr64 = (Elf64_Ehdr *)&ehdr; 1005 1.2.2.2 martin shnum = ehdr64->e_shnum; 1006 1.2.2.2 martin shentsize = ehdr64->e_shentsize; 1007 1.2.2.2 martin shstrndx = ehdr64->e_shstrndx; 1008 1.2.2.2 martin shoff = ehdr64->e_shoff; 1009 1.2.2.2 martin break; 1010 1.2.2.2 martin default: 1011 1.2.2.2 martin goto out; 1012 1.2.2.2 martin } 1013 1.2.2.2 martin 1014 1.2.2.2 martin shdr_len = shnum * shentsize; 1015 1.2.2.2 martin if (shdr_len == 0) 1016 1.2.2.2 martin goto out; 1017 1.2.2.2 martin 1018 1.2.2.2 martin len = sizeof(*mbt) + shdr_len; 1019 1.2.2.2 martin if (mbt) { 1020 1.2.2.2 martin int fd = -1; 1021 1.2.2.2 martin int ret = -1; 1022 1.2.2.2 martin 1023 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_ELF_SECTIONS; 1024 1.2.2.2 martin mbt->size = len; 1025 1.2.2.2 martin mbt->num = shnum; 1026 1.2.2.2 martin mbt->entsize = shentsize; 1027 1.2.2.2 martin mbt->shndx = shstrndx; 1028 1.2.2.2 martin 1029 1.2.2.2 martin if ((fd = open(mbp->mbp_file, 0)) == -1) 1030 1.2.2.2 martin goto out_read; 1031 1.2.2.2 martin 1032 1.2.2.2 martin if (lseek(fd, shoff, SEEK_SET) != shoff) 1033 1.2.2.2 martin goto out_read; 1034 1.2.2.2 martin 1035 1.2.2.2 martin if (read(fd, mbt + 1, shdr_len) != shdr_len) 1036 1.2.2.2 martin goto out_read; 1037 1.2.2.2 martin 1038 1.2.2.2 martin ret = 0; 1039 1.2.2.2 martin out_read: 1040 1.2.2.2 martin if (fd != -1) 1041 1.2.2.2 martin close(fd); 1042 1.2.2.2 martin 1043 1.2.2.2 martin if (ret != 0) { 1044 1.2.2.2 martin printf("Error reading ELF sections from %s\n", 1045 1.2.2.2 martin mbp->mbp_file); 1046 1.2.2.2 martin len = 0; 1047 1.2.2.2 martin } 1048 1.2.2.2 martin } 1049 1.2.2.2 martin out: 1050 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1051 1.2.2.2 martin } 1052 1.2.2.2 martin 1053 1.2.2.2 martin static size_t 1054 1.2.2.2 martin mbi_end(struct multiboot_package *mbp, void *buf) 1055 1.2.2.2 martin { 1056 1.2.2.2 martin struct multiboot_tag *mbt = buf; 1057 1.2.2.2 martin size_t len = sizeof(*mbt); 1058 1.2.2.2 martin 1059 1.2.2.2 martin if (mbt) { 1060 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_END; 1061 1.2.2.2 martin mbt->size = len; 1062 1.2.2.2 martin } 1063 1.2.2.2 martin 1064 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1065 1.2.2.2 martin } 1066 1.2.2.2 martin 1067 1.2.2.2 martin static size_t 1068 1.2.2.2 martin mbi_load_base_addr(struct multiboot_package *mbp, void *buf) 1069 1.2.2.2 martin { 1070 1.2.2.2 martin size_t len = 0; 1071 1.2.2.2 martin struct multiboot_tag_load_base_addr *mbt = buf; 1072 1.2.2.2 martin 1073 1.2.2.2 martin len = sizeof(*mbt); 1074 1.2.2.2 martin 1075 1.2.2.2 martin if (mbt) { 1076 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR; 1077 1.2.2.2 martin mbt->size = len; 1078 1.2.2.2 martin mbt->load_base_addr = mbp->mbp_marks[MARK_START]; 1079 1.2.2.2 martin } 1080 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1081 1.2.2.2 martin } 1082 1.2.2.2 martin 1083 1.2.2.2 martin #ifdef EFIBOOT 1084 1.2.2.2 martin /* Set if EFI ExitBootServices was not called */ 1085 1.2.2.2 martin static size_t 1086 1.2.2.2 martin mbi_efi_bs(struct multiboot_package *mbp, void *buf) 1087 1.2.2.2 martin { 1088 1.2.2.2 martin size_t len = 0; 1089 1.2.2.2 martin struct multiboot_tag *mbt = buf; 1090 1.2.2.2 martin 1091 1.2.2.2 martin if (mbp->mbp_priv->mpp_efi_bs == NULL) 1092 1.2.2.2 martin goto out; 1093 1.2.2.2 martin 1094 1.2.2.2 martin len = sizeof(*mbt); 1095 1.2.2.2 martin 1096 1.2.2.2 martin if (mbt) { 1097 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI_BS; 1098 1.2.2.2 martin mbt->size = len; 1099 1.2.2.2 martin } 1100 1.2.2.2 martin 1101 1.2.2.2 martin out: 1102 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1103 1.2.2.2 martin } 1104 1.2.2.2 martin 1105 1.2.2.2 martin 1106 1.2.2.2 martin static size_t 1107 1.2.2.2 martin mbi_efi_mmap(struct multiboot_package *mbp, void *buf) 1108 1.2.2.2 martin { 1109 1.2.2.2 martin size_t len = 0; 1110 1.2.2.2 martin struct multiboot_tag_efi_mmap *mbt = buf; 1111 1.2.2.2 martin size_t memmap_len; 1112 1.2.2.2 martin 1113 1.2.2.2 martin if (btinfo_efimemmap == NULL) 1114 1.2.2.2 martin goto out; 1115 1.2.2.2 martin 1116 1.2.2.2 martin memmap_len = btinfo_efimemmap->num * btinfo_efimemmap->size; 1117 1.2.2.2 martin len = sizeof(*mbt) + memmap_len; 1118 1.2.2.2 martin 1119 1.2.2.2 martin if (mbt) { 1120 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI_MMAP; 1121 1.2.2.2 martin mbt->size = len; 1122 1.2.2.2 martin mbt->descr_size = btinfo_efimemmap->size; 1123 1.2.2.2 martin mbt->descr_vers = btinfo_efimemmap->version; 1124 1.2.2.2 martin memcpy(mbt + 1, btinfo_efimemmap->memmap, memmap_len); 1125 1.2.2.2 martin } 1126 1.2.2.2 martin 1127 1.2.2.2 martin out: 1128 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1129 1.2.2.2 martin } 1130 1.2.2.2 martin 1131 1.2.2.2 martin 1132 1.2.2.2 martin 1133 1.2.2.2 martin #ifndef __LP64__ 1134 1.2.2.2 martin static size_t 1135 1.2.2.2 martin mbi_efi32_ih(struct multiboot_package *mbp, void *buf) 1136 1.2.2.2 martin { 1137 1.2.2.2 martin size_t len = 0; 1138 1.2.2.2 martin struct multiboot_tag_efi32_ih *mbt = buf; 1139 1.2.2.2 martin 1140 1.2.2.2 martin len = sizeof(*mbt); 1141 1.2.2.2 martin 1142 1.2.2.2 martin if (mbt) { 1143 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI32_IH; 1144 1.2.2.2 martin mbt->size = len; 1145 1.2.2.2 martin mbt->pointer = (multiboot_uint32_t)IH; 1146 1.2.2.2 martin } 1147 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1148 1.2.2.2 martin } 1149 1.2.2.2 martin 1150 1.2.2.2 martin static size_t 1151 1.2.2.2 martin mbi_efi32(struct multiboot_package *mbp, void *buf) 1152 1.2.2.2 martin { 1153 1.2.2.2 martin size_t len = 0; 1154 1.2.2.2 martin struct multiboot_tag_efi32 *mbt = buf; 1155 1.2.2.2 martin 1156 1.2.2.2 martin len = sizeof(*mbt); 1157 1.2.2.2 martin 1158 1.2.2.2 martin if (mbt) { 1159 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI32; 1160 1.2.2.2 martin mbt->size = len; 1161 1.2.2.2 martin mbt->pointer = (multiboot_uint32_t)ST; 1162 1.2.2.2 martin } 1163 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1164 1.2.2.2 martin } 1165 1.2.2.2 martin #endif 1166 1.2.2.2 martin 1167 1.2.2.2 martin #ifdef __LP64__ 1168 1.2.2.2 martin static size_t 1169 1.2.2.2 martin mbi_efi64_ih(struct multiboot_package *mbp, void *buf) 1170 1.2.2.2 martin { 1171 1.2.2.2 martin size_t len = 0; 1172 1.2.2.2 martin struct multiboot_tag_efi64_ih *mbt = buf; 1173 1.2.2.2 martin 1174 1.2.2.2 martin len = sizeof(*mbt); 1175 1.2.2.2 martin 1176 1.2.2.2 martin if (mbt) { 1177 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI64_IH; 1178 1.2.2.2 martin mbt->size = len; 1179 1.2.2.2 martin mbt->pointer = (multiboot_uint64_t)IH; 1180 1.2.2.2 martin } 1181 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1182 1.2.2.2 martin } 1183 1.2.2.2 martin 1184 1.2.2.2 martin static size_t 1185 1.2.2.2 martin mbi_efi64(struct multiboot_package *mbp, void *buf) 1186 1.2.2.2 martin { 1187 1.2.2.2 martin size_t len = 0; 1188 1.2.2.2 martin struct multiboot_tag_efi64 *mbt = buf; 1189 1.2.2.2 martin 1190 1.2.2.2 martin len = sizeof(*mbt); 1191 1.2.2.2 martin 1192 1.2.2.2 martin if (mbt) { 1193 1.2.2.2 martin mbt->type = MULTIBOOT_TAG_TYPE_EFI64; 1194 1.2.2.2 martin mbt->size = len; 1195 1.2.2.2 martin mbt->pointer = (multiboot_uint64_t)ST; 1196 1.2.2.2 martin } 1197 1.2.2.2 martin return roundup(len, MULTIBOOT_TAG_ALIGN); 1198 1.2.2.2 martin } 1199 1.2.2.2 martin #endif /* __LP64__ */ 1200 1.2.2.2 martin #endif /* EFIBOOT */ 1201 1.2.2.2 martin 1202 1.2.2.2 martin static bool 1203 1.2.2.2 martin is_tag_required(struct multiboot_package *mbp, uint16_t tag) 1204 1.2.2.2 martin { 1205 1.2.2.2 martin bool ret = false; 1206 1.2.2.2 martin int i; 1207 1.2.2.2 martin struct multiboot_header_tag_information_request *info_req; 1208 1.2.2.2 martin size_t nreq; 1209 1.2.2.2 martin 1210 1.2.2.2 martin info_req = mbp->mbp_priv->mpp_info_req; 1211 1.2.2.2 martin 1212 1.2.2.2 martin if (info_req == NULL) 1213 1.2.2.2 martin goto out; 1214 1.2.2.2 martin 1215 1.2.2.2 martin if (info_req->flags & MULTIBOOT_HEADER_TAG_OPTIONAL) 1216 1.2.2.2 martin goto out; 1217 1.2.2.2 martin 1218 1.2.2.2 martin nreq = (info_req->size - sizeof(*info_req)) 1219 1.2.2.2 martin / sizeof(info_req->requests[0]); 1220 1.2.2.2 martin 1221 1.2.2.2 martin for (i = 0; i < nreq; i++) { 1222 1.2.2.2 martin if (info_req->requests[i] == tag) { 1223 1.2.2.2 martin ret = true; 1224 1.2.2.2 martin break; 1225 1.2.2.2 martin } 1226 1.2.2.2 martin } 1227 1.2.2.2 martin 1228 1.2.2.2 martin out: 1229 1.2.2.2 martin return ret; 1230 1.2.2.2 martin } 1231 1.2.2.2 martin 1232 1.2.2.2 martin static int 1233 1.2.2.2 martin mbi_dispatch(struct multiboot_package *mbp, uint16_t type, 1234 1.2.2.2 martin char *bp, size_t *total_len) 1235 1.2.2.2 martin { 1236 1.2.2.2 martin int ret = 0; 1237 1.2.2.2 martin size_t len = 0; 1238 1.2.2.2 martin 1239 1.2.2.2 martin switch (type) { 1240 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_END: 1241 1.2.2.2 martin len = mbi_end(mbp, bp); 1242 1.2.2.2 martin break; 1243 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_CMDLINE: 1244 1.2.2.2 martin len = mbi_cmdline(mbp, bp); 1245 1.2.2.2 martin break; 1246 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME: 1247 1.2.2.2 martin len = mbi_boot_loader_name(mbp, bp); 1248 1.2.2.2 martin break; 1249 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MODULE: 1250 1.2.2.2 martin len = mbi_modules(mbp, bp); 1251 1.2.2.2 martin break; 1252 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO: 1253 1.2.2.2 martin len = mbi_basic_meminfo(mbp, bp); 1254 1.2.2.2 martin break; 1255 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_BOOTDEV: 1256 1.2.2.2 martin len = mbi_bootdev(mbp, bp); 1257 1.2.2.2 martin break; 1258 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_MMAP: 1259 1.2.2.2 martin len = mbi_mmap(mbp, bp); 1260 1.2.2.2 martin break; 1261 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_VBE: 1262 1.2.2.2 martin len = mbi_vbe(mbp, bp); 1263 1.2.2.2 martin break; 1264 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_FRAMEBUFFER: 1265 1.2.2.2 martin len = mbi_framebuffer(mbp, bp); 1266 1.2.2.2 martin break; 1267 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_OLD: 1268 1.2.2.2 martin len = mbi_acpi_old(mbp, bp); 1269 1.2.2.2 martin break; 1270 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ACPI_NEW: 1271 1.2.2.2 martin len = mbi_acpi_new(mbp, bp); 1272 1.2.2.2 martin break; 1273 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_ELF_SECTIONS: 1274 1.2.2.2 martin len = mbi_elf_sections(mbp, bp); 1275 1.2.2.2 martin break; 1276 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_APM: 1277 1.2.2.2 martin len = mbi_apm(mbp, bp); 1278 1.2.2.2 martin break; 1279 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_SMBIOS: 1280 1.2.2.2 martin len = mbi_smbios(mbp, bp); 1281 1.2.2.2 martin break; 1282 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_NETWORK: 1283 1.2.2.2 martin len = mbi_network(mbp, bp); 1284 1.2.2.2 martin break; 1285 1.2.2.2 martin #ifdef EFIBOOT 1286 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_MMAP: 1287 1.2.2.2 martin len = mbi_efi_mmap(mbp, bp); 1288 1.2.2.2 martin break; 1289 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI_BS: 1290 1.2.2.2 martin len = mbi_efi_bs(mbp, bp); 1291 1.2.2.2 martin break; 1292 1.2.2.2 martin #ifndef __LP64__ 1293 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32_IH: 1294 1.2.2.2 martin len = mbi_efi32_ih(mbp, bp); 1295 1.2.2.2 martin break; 1296 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI32: 1297 1.2.2.2 martin len = mbi_efi32(mbp, bp); 1298 1.2.2.2 martin break; 1299 1.2.2.2 martin #else /* __LP64__ */ 1300 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64_IH: 1301 1.2.2.2 martin len = mbi_efi64_ih(mbp, bp); 1302 1.2.2.2 martin break; 1303 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_EFI64: 1304 1.2.2.2 martin len = mbi_efi64(mbp, bp); 1305 1.2.2.2 martin break; 1306 1.2.2.2 martin #endif /* __LP64__ */ 1307 1.2.2.2 martin #endif /* EFIBOOT */ 1308 1.2.2.2 martin case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR: 1309 1.2.2.2 martin len = mbi_load_base_addr(mbp, bp); 1310 1.2.2.2 martin break; 1311 1.2.2.2 martin default: 1312 1.2.2.2 martin len = 0; 1313 1.2.2.2 martin break; 1314 1.2.2.2 martin } 1315 1.2.2.2 martin 1316 1.2.2.2 martin if (len == 0 && is_tag_required(mbp, type)) 1317 1.2.2.2 martin ret = -1; 1318 1.2.2.2 martin 1319 1.2.2.2 martin *total_len += len; 1320 1.2.2.2 martin return ret; 1321 1.2.2.2 martin } 1322 1.2.2.2 martin 1323 1.2.2.2 martin static int 1324 1.2.2.2 martin exec_multiboot2(struct multiboot_package *mbp) 1325 1.2.2.2 martin { 1326 1.2.2.2 martin size_t len, alen; 1327 1.2.2.2 martin char *mbi = NULL; 1328 1.2.2.2 martin struct multiboot_package_priv *mpp = mbp->mbp_priv; 1329 1.2.2.2 martin uint16_t tags[] = { 1330 1.2.2.2 martin MULTIBOOT_TAG_TYPE_CMDLINE, 1331 1.2.2.2 martin MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME, 1332 1.2.2.2 martin MULTIBOOT_TAG_TYPE_MODULE, 1333 1.2.2.2 martin MULTIBOOT_TAG_TYPE_BASIC_MEMINFO, 1334 1.2.2.2 martin MULTIBOOT_TAG_TYPE_BOOTDEV, 1335 1.2.2.2 martin MULTIBOOT_TAG_TYPE_VBE, 1336 1.2.2.2 martin MULTIBOOT_TAG_TYPE_FRAMEBUFFER, 1337 1.2.2.2 martin MULTIBOOT_TAG_TYPE_ELF_SECTIONS, 1338 1.2.2.2 martin MULTIBOOT_TAG_TYPE_APM, 1339 1.2.2.2 martin MULTIBOOT_TAG_TYPE_SMBIOS, 1340 1.2.2.2 martin MULTIBOOT_TAG_TYPE_ACPI_OLD, 1341 1.2.2.2 martin MULTIBOOT_TAG_TYPE_ACPI_NEW, 1342 1.2.2.2 martin MULTIBOOT_TAG_TYPE_NETWORK, 1343 1.2.2.2 martin MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR, 1344 1.2.2.2 martin #ifdef EFIBOOT 1345 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI_BS, 1346 1.2.2.2 martin #ifndef __LP64__ 1347 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI32, 1348 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI32_IH, 1349 1.2.2.2 martin #else 1350 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI64, 1351 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI64_IH, 1352 1.2.2.2 martin #endif /* __LP64__ */ 1353 1.2.2.2 martin /* 1354 1.2.2.2 martin * EFI_MMAP and MMAP at the end so that they 1355 1.2.2.2 martin * catch page allocation made for other tags. 1356 1.2.2.2 martin */ 1357 1.2.2.2 martin MULTIBOOT_TAG_TYPE_EFI_MMAP, 1358 1.2.2.2 martin #endif /* EFIGOOT */ 1359 1.2.2.2 martin MULTIBOOT_TAG_TYPE_MMAP, 1360 1.2.2.2 martin MULTIBOOT_TAG_TYPE_END, /* Must be last */ 1361 1.2.2.2 martin }; 1362 1.2.2.2 martin physaddr_t entry; 1363 1.2.2.2 martin int i; 1364 1.2.2.2 martin 1365 1.2.2.2 martin BI_ALLOC(BTINFO_MAX); 1366 1.2.2.2 martin 1367 1.2.2.2 martin /* set new video mode if text mode was not requested */ 1368 1.2.2.2 martin if (mpp->mpp_framebuffer == NULL || 1369 1.2.2.2 martin mpp->mpp_framebuffer->depth != 0) 1370 1.2.2.2 martin vbe_commit(); 1371 1.2.2.2 martin 1372 1.2.2.2 martin len = 2 * sizeof(multiboot_uint32_t); 1373 1.2.2.2 martin for (i = 0; i < sizeof(tags) / sizeof(*tags); i++) { 1374 1.2.2.2 martin if (mbi_dispatch(mbp, tags[i], NULL, &len) != 0) 1375 1.2.2.2 martin goto fail; 1376 1.2.2.2 martin } 1377 1.2.2.2 martin 1378 1.2.2.2 martin mpp->mpp_mbi_len = len + MULTIBOOT_TAG_ALIGN; 1379 1.2.2.2 martin mpp->mpp_mbi = alloc(mpp->mpp_mbi_len); 1380 1.2.2.2 martin mbi = (char *)roundup((vaddr_t)mpp->mpp_mbi, MULTIBOOT_TAG_ALIGN); 1381 1.2.2.2 martin 1382 1.2.2.2 martin alen = 2 * sizeof(multiboot_uint32_t); 1383 1.2.2.2 martin for (i = 0; i < sizeof(tags) / sizeof(*tags); i++) { 1384 1.2.2.2 martin if (mbi_dispatch(mbp, tags[i], mbi + alen, &alen) != 0) 1385 1.2.2.2 martin goto fail; 1386 1.2.2.2 martin 1387 1.2.2.2 martin /* 1388 1.2.2.2 martin * It may shrink because of failure when filling 1389 1.2.2.2 martin * structures, but it should not grow. 1390 1.2.2.2 martin */ 1391 1.2.2.2 martin if (alen > len) 1392 1.2.2.2 martin panic("multiboot2 info size mismatch"); 1393 1.2.2.2 martin } 1394 1.2.2.2 martin 1395 1.2.2.2 martin 1396 1.2.2.2 martin ((multiboot_uint32_t *)mbi)[0] = alen; /* total size */ 1397 1.2.2.2 martin ((multiboot_uint32_t *)mbi)[1] = 0; /* reserved */ 1398 1.2.2.2 martin 1399 1.2.2.2 martin #if 0 1400 1.2.2.2 martin for (i = 0; i < len; i += 16) { 1401 1.2.2.2 martin printf("%p ", mbi + i); 1402 1.2.2.2 martin for (int j = 0; j < 16; j++) 1403 1.2.2.2 martin printf("%s%s%x", 1404 1.2.2.2 martin (i+j) % 4 ? "" : " ", 1405 1.2.2.2 martin (unsigned char)mbi[i+j] < 0x10 ? "0" : "", 1406 1.2.2.2 martin (unsigned char)(mbi[i+j])); 1407 1.2.2.2 martin printf("\n"); 1408 1.2.2.2 martin } 1409 1.2.2.2 martin #endif 1410 1.2.2.2 martin 1411 1.2.2.2 martin printf("Start @ 0x%lx [%ld=0x%lx-0x%lx]...\n", 1412 1.2.2.2 martin mbp->mbp_marks[MARK_ENTRY], 1413 1.2.2.2 martin mbp->mbp_marks[MARK_NSYM], 1414 1.2.2.2 martin mbp->mbp_marks[MARK_SYM], 1415 1.2.2.2 martin mbp->mbp_marks[MARK_END]); 1416 1.2.2.2 martin 1417 1.2.2.2 martin #ifdef MULTIBOOT2_DEBUG 1418 1.2.2.2 martin multiboot2_info_dump(MULTIBOOT2_BOOTLOADER_MAGIC, mbi); 1419 1.2.2.2 martin #endif /* MULTIBOOT2_DEBUG */ 1420 1.2.2.2 martin 1421 1.2.2.2 martin entry = mbp->mbp_marks[MARK_ENTRY]; 1422 1.2.2.2 martin 1423 1.2.2.2 martin if (mpp->mpp_entry) 1424 1.2.2.2 martin entry = mpp->mpp_entry->entry_addr; 1425 1.2.2.2 martin #ifdef EFIBOOT 1426 1.2.2.2 martin #ifdef __LP64__ 1427 1.2.2.2 martin if (mpp->mpp_entry_elf64) 1428 1.2.2.2 martin entry = mpp->mpp_entry_elf64->entry_addr 1429 1.2.2.2 martin + efi_loadaddr; 1430 1.2.2.2 martin #else 1431 1.2.2.2 martin if (mpp->mpp_entry_elf32) 1432 1.2.2.2 martin entry = mpp->mpp_entry_elf32->entry_addr 1433 1.2.2.2 martin + efi_loadaddr; 1434 1.2.2.2 martin #endif /* __LP64__ */ 1435 1.2.2.2 martin if (mpp->mpp_efi_bs == NULL) 1436 1.2.2.2 martin efi_cleanup(); 1437 1.2.2.2 martin #endif /* EFIBOOT */ 1438 1.2.2.2 martin 1439 1.2.2.2 martin /* Does not return */ 1440 1.2.2.2 martin multiboot(entry, vtophys(mbi), 1441 1.2.2.2 martin x86_trunc_page(mbp->mbp_basemem * 1024), 1442 1.2.2.2 martin MULTIBOOT2_BOOTLOADER_MAGIC); 1443 1.2.2.2 martin fail: 1444 1.2.2.2 martin return -1; 1445 1.2.2.2 martin } 1446 1.2.2.2 martin 1447 1.2.2.2 martin static void 1448 1.2.2.2 martin cleanup_multiboot2(struct multiboot_package *mbp) 1449 1.2.2.2 martin { 1450 1.2.2.2 martin if (mbp->mbp_header) 1451 1.2.2.2 martin dealloc(mbp->mbp_header, mbp->mbp_header->header_length); 1452 1.2.2.2 martin if (mbp->mbp_priv && mbp->mbp_priv->mpp_mbi) 1453 1.2.2.2 martin dealloc(mbp->mbp_priv->mpp_mbi, mbp->mbp_priv->mpp_mbi_len); 1454 1.2.2.2 martin if (mbp->mbp_priv) 1455 1.2.2.2 martin dealloc(mbp->mbp_priv, sizeof(*mbp->mbp_priv)); 1456 1.2.2.2 martin 1457 1.2.2.2 martin dealloc(mbp, sizeof(*mbp)); 1458 1.2.2.2 martin 1459 1.2.2.2 martin return; 1460 1.2.2.2 martin } 1461 1.2.2.2 martin 1462 1.2.2.2 martin static bool 1463 1.2.2.2 martin is_header_required(struct multiboot_header_tag *mbt) 1464 1.2.2.2 martin { 1465 1.2.2.2 martin bool ret = false; 1466 1.2.2.2 martin 1467 1.2.2.2 martin if (mbt == NULL) 1468 1.2.2.2 martin goto out; 1469 1.2.2.2 martin 1470 1.2.2.2 martin if (mbt->flags & MULTIBOOT_HEADER_TAG_OPTIONAL) 1471 1.2.2.2 martin goto out; 1472 1.2.2.2 martin 1473 1.2.2.2 martin ret = true; 1474 1.2.2.2 martin out: 1475 1.2.2.2 martin return ret; 1476 1.2.2.2 martin } 1477 1.2.2.2 martin 1478 1.2.2.2 martin #define NEXT_HEADER(mbt) ((struct multiboot_header_tag *) \ 1479 1.2.2.2 martin ((char *)mbt + roundup(mbt->size, MULTIBOOT_HEADER_ALIGN))) 1480 1.2.2.2 martin 1481 1.2.2.2 martin struct multiboot_package * 1482 1.2.2.2 martin probe_multiboot2(const char *path) 1483 1.2.2.2 martin { 1484 1.2.2.2 martin int fd = -1; 1485 1.2.2.2 martin size_t i; 1486 1.2.2.2 martin char buf[MULTIBOOT_SEARCH + sizeof(struct multiboot_header)]; 1487 1.2.2.2 martin ssize_t readen; 1488 1.2.2.2 martin struct multiboot_package *mbp = NULL; 1489 1.2.2.2 martin struct multiboot_header *mbh; 1490 1.2.2.2 martin struct multiboot_header_tag *mbt; 1491 1.2.2.2 martin size_t mbh_len = 0; 1492 1.2.2.2 martin 1493 1.2.2.2 martin if ((fd = open(path, 0)) == -1) 1494 1.2.2.2 martin goto out; 1495 1.2.2.2 martin 1496 1.2.2.2 martin readen = read(fd, buf, sizeof(buf)); 1497 1.2.2.2 martin if (readen < sizeof(struct multiboot_header)) 1498 1.2.2.2 martin goto out; 1499 1.2.2.2 martin 1500 1.2.2.2 martin for (i = 0; i < readen; i += MULTIBOOT_HEADER_ALIGN) { 1501 1.2.2.2 martin mbh = (struct multiboot_header *)(buf + i); 1502 1.2.2.2 martin 1503 1.2.2.2 martin if (mbh->magic != MULTIBOOT2_HEADER_MAGIC) 1504 1.2.2.2 martin continue; 1505 1.2.2.2 martin 1506 1.2.2.2 martin if (mbh->architecture != MULTIBOOT_ARCHITECTURE_I386) 1507 1.2.2.2 martin continue; 1508 1.2.2.2 martin 1509 1.2.2.2 martin if (mbh->magic + mbh->architecture + 1510 1.2.2.2 martin mbh->header_length + mbh->checksum) 1511 1.2.2.2 martin continue; 1512 1.2.2.2 martin mbh_len = mbh->header_length; 1513 1.2.2.2 martin 1514 1.2.2.2 martin mbp = alloc(sizeof(*mbp)); 1515 1.2.2.2 martin mbp->mbp_version = 2; 1516 1.2.2.2 martin mbp->mbp_file = path; 1517 1.2.2.2 martin mbp->mbp_header = alloc(mbh_len); 1518 1.2.2.2 martin mbp->mbp_priv = alloc(sizeof(*mbp->mbp_priv)); 1519 1.2.2.2 martin memset(mbp->mbp_priv, 0, sizeof (*mbp->mbp_priv)); 1520 1.2.2.2 martin mbp->mbp_probe = *probe_multiboot2; 1521 1.2.2.2 martin mbp->mbp_exec = *exec_multiboot2; 1522 1.2.2.2 martin mbp->mbp_cleanup = *cleanup_multiboot2; 1523 1.2.2.2 martin 1524 1.2.2.2 martin break; 1525 1.2.2.2 martin } 1526 1.2.2.2 martin 1527 1.2.2.2 martin if (mbp == NULL) 1528 1.2.2.2 martin goto out; 1529 1.2.2.2 martin 1530 1.2.2.2 martin if (lseek(fd, i, SEEK_SET) != i) { 1531 1.2.2.2 martin printf("lseek failed"); 1532 1.2.2.2 martin mbp->mbp_cleanup(mbp); 1533 1.2.2.2 martin mbp = NULL; 1534 1.2.2.2 martin goto out; 1535 1.2.2.2 martin } 1536 1.2.2.2 martin 1537 1.2.2.2 martin mbh = mbp->mbp_header; 1538 1.2.2.2 martin if (read(fd, mbh, mbh_len) != mbh_len) { 1539 1.2.2.2 martin printf("read failed"); 1540 1.2.2.2 martin mbp->mbp_cleanup(mbp); 1541 1.2.2.2 martin mbp = NULL; 1542 1.2.2.2 martin goto out; 1543 1.2.2.2 martin } 1544 1.2.2.2 martin 1545 1.2.2.2 martin for (mbt = (struct multiboot_header_tag *)(mbh + 1); 1546 1.2.2.2 martin (char *)mbt - (char *)mbh < mbh_len; 1547 1.2.2.2 martin mbt = NEXT_HEADER(mbt)) { 1548 1.2.2.2 martin 1549 1.2.2.2 martin switch(mbt->type) { 1550 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_INFORMATION_REQUEST: 1551 1.2.2.2 martin mbp->mbp_priv->mpp_info_req = (void *)mbt; 1552 1.2.2.2 martin break; 1553 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_ADDRESS: 1554 1.2.2.2 martin mbp->mbp_priv->mpp_address = (void *)mbt; 1555 1.2.2.2 martin break; 1556 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS: 1557 1.2.2.2 martin mbp->mbp_priv->mpp_entry = (void *)mbt; 1558 1.2.2.2 martin break; 1559 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_CONSOLE_FLAGS: 1560 1.2.2.2 martin mbp->mbp_priv->mpp_console = (void *)mbt; 1561 1.2.2.2 martin 1562 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_FRAMEBUFFER: 1563 1.2.2.2 martin mbp->mbp_priv->mpp_framebuffer = (void *)mbt; 1564 1.2.2.2 martin break; 1565 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_MODULE_ALIGN: 1566 1.2.2.2 martin mbp->mbp_priv->mpp_module_align = (void *)mbt; 1567 1.2.2.2 martin break; 1568 1.2.2.2 martin #ifdef EFIBOOT 1569 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_EFI_BS: 1570 1.2.2.2 martin mbp->mbp_priv->mpp_efi_bs = (void *)mbt; 1571 1.2.2.2 martin break; 1572 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI32: 1573 1.2.2.2 martin mbp->mbp_priv->mpp_entry_elf32 = (void *)mbt; 1574 1.2.2.2 martin break; 1575 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI64: 1576 1.2.2.2 martin mbp->mbp_priv->mpp_entry_elf64 = (void *)mbt; 1577 1.2.2.2 martin break; 1578 1.2.2.2 martin #endif 1579 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_RELOCATABLE: 1580 1.2.2.2 martin mbp->mbp_priv->mpp_relocatable = (void *)mbt; 1581 1.2.2.2 martin break; 1582 1.2.2.2 martin case MULTIBOOT_HEADER_TAG_END: /* FALLTHROUGH */ 1583 1.2.2.2 martin default: 1584 1.2.2.2 martin break; 1585 1.2.2.2 martin } 1586 1.2.2.2 martin } 1587 1.2.2.2 martin 1588 1.2.2.2 martin #ifdef MULTIBOOT2_DEBUG 1589 1.2.2.2 martin multiboot2_header_dump(mbp); 1590 1.2.2.2 martin #endif /* MULTIBOOT2_DEBUG */ 1591 1.2.2.2 martin 1592 1.2.2.2 martin /* 1593 1.2.2.2 martin * multiboot header fully supported 1594 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_INFORMATION_REQUEST 1595 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS 1596 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_MODULE_ALIGN (we always load as page aligned) 1597 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_EFI_BS 1598 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI32 1599 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI64 1600 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_CONSOLE_FLAGS (we always have a console) 1601 1.2.2.2 martin * 1602 1.2.2.2 martin * Not supported: 1603 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_ADDRESS 1604 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_FRAMEBUFFER (but spec says it is onty a hint) 1605 1.2.2.2 martin * MULTIBOOT_HEADER_TAG_RELOCATABLE 1606 1.2.2.2 martin */ 1607 1.2.2.2 martin 1608 1.2.2.2 martin if (is_header_required((void *)mbp->mbp_priv->mpp_address)) { 1609 1.2.2.2 martin printf("Unsupported multiboot address header\n"); 1610 1.2.2.2 martin mbp->mbp_cleanup(mbp); 1611 1.2.2.2 martin mbp = NULL; 1612 1.2.2.2 martin goto out; 1613 1.2.2.2 martin } 1614 1.2.2.2 martin 1615 1.2.2.2 martin #ifdef EFIBOOT 1616 1.2.2.2 martin /* 1617 1.2.2.2 martin * We do not fully support the relocatable header, but 1618 1.2.2.2 martin * at least we honour the alignment request. Xen requires 1619 1.2.2.2 martin * that to boot. 1620 1.2.2.2 martin */ 1621 1.2.2.2 martin struct multiboot_header_tag_relocatable *reloc = 1622 1.2.2.2 martin mbp->mbp_priv->mpp_relocatable; 1623 1.2.2.2 martin if (reloc) 1624 1.2.2.2 martin efi_loadaddr = roundup(efi_loadaddr, reloc->align); 1625 1.2.2.2 martin #endif 1626 1.2.2.2 martin 1627 1.2.2.2 martin if (is_header_required((void *)mbp->mbp_priv->mpp_relocatable)) { 1628 1.2.2.2 martin printf("Unsupported multiboot relocatable header\n"); 1629 1.2.2.2 martin mbp->mbp_cleanup(mbp); 1630 1.2.2.2 martin mbp = NULL; 1631 1.2.2.2 martin goto out; 1632 1.2.2.2 martin } 1633 1.2.2.2 martin 1634 1.2.2.2 martin out: 1635 1.2.2.2 martin 1636 1.2.2.2 martin if (fd != -1) 1637 1.2.2.2 martin close(fd); 1638 1.2.2.2 martin 1639 1.2.2.2 martin return mbp; 1640 1.2.2.2 martin } 1641 1.2.2.2 martin 1642 1.2.2.2 martin #endif /* NO_MULTIBOOT2 */ 1643
Indexes created Thu Oct 02 01:09:59 GMT 2025