xref: /netbsd-src/sys/arch/i386/stand/lib/exec_multiboot2.c (revision 6cf5ca46b9ece5167b080dc86ba4f5b58bc6b9ea)
1*6cf5ca46Srin /* $NetBSD: exec_multiboot2.c,v 1.6 2023/08/04 07:21:57 rin Exp $ */
25e073c03Smanu 
35e073c03Smanu /*
45e073c03Smanu  * Copyright (c) 2019 The NetBSD Foundation, Inc.
55e073c03Smanu  * All rights reserved.
65e073c03Smanu  *
75e073c03Smanu  * Redistribution and use in source and binary forms, with or without
85e073c03Smanu  * modification, are permitted provided that the following conditions
95e073c03Smanu  * are met:
105e073c03Smanu  * 1. Redistributions of source code must retain the above copyright
115e073c03Smanu  *    notice, this list of conditions and the following disclaimer.
125e073c03Smanu  * 2. Redistributions in binary form must reproduce the above copyright
135e073c03Smanu  *    notice, this list of conditions and the following disclaimer in the
145e073c03Smanu  *    documentation and/or other materials provided with the distribution.
155e073c03Smanu  *
165e073c03Smanu  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
175e073c03Smanu  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
185e073c03Smanu  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
195e073c03Smanu  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
205e073c03Smanu  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
215e073c03Smanu  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
225e073c03Smanu  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
235e073c03Smanu  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
245e073c03Smanu  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
255e073c03Smanu  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
265e073c03Smanu  * POSSIBILITY OF SUCH DAMAGE.
275e073c03Smanu  */
285e073c03Smanu 
295e073c03Smanu #include <sys/param.h>
305e073c03Smanu #include <sys/reboot.h>
315e073c03Smanu #include <sys/types.h>
325e073c03Smanu 
335e073c03Smanu #include <i386/multiboot2.h>
345e073c03Smanu 
355e073c03Smanu #include <dev/acpi/acpica.h>
365e073c03Smanu #include <x86/acpi_machdep.h>
37b2c90ce3Sjmcneill #include <dev/smbiosvar.h>
38b2c90ce3Sjmcneill #include <x86/smbios_machdep.h>
395e073c03Smanu 
405e073c03Smanu #include <lib/libsa/stand.h>
415e073c03Smanu #include <lib/libkern/libkern.h>
425e073c03Smanu 
435e073c03Smanu 
445e073c03Smanu #include "loadfile.h"
455e073c03Smanu #include "libi386.h"
465e073c03Smanu #include "biosdisk.h"
475e073c03Smanu #include "bootinfo.h"
485e073c03Smanu #include "bootmod.h"
495e073c03Smanu #include "vbe.h"
505e073c03Smanu #ifdef EFIBOOT
515e073c03Smanu #include "efiboot.h"
525e073c03Smanu #endif
535e073c03Smanu 
545e073c03Smanu #define CGA_BUF 0xb8000 /* From isa_machdep.h */
555e073c03Smanu 
565e073c03Smanu extern const char bootprog_name[], bootprog_rev[], bootprog_kernrev[];
575e073c03Smanu extern const uint8_t rasops_cmap[];
585e073c03Smanu extern struct btinfo_framebuffer btinfo_framebuffer;
595e073c03Smanu extern struct btinfo_modulelist *btinfo_modulelist;
605e073c03Smanu #ifdef EFIBOOT
615e073c03Smanu extern struct btinfo_efimemmap *btinfo_efimemmap;
625e073c03Smanu #else
635e073c03Smanu extern struct btinfo_memmap *btinfo_memmap;
645e073c03Smanu #endif
655e073c03Smanu 
665e073c03Smanu 
675e073c03Smanu struct multiboot_package_priv {
685e073c03Smanu 	struct multiboot_tag 			       *mpp_mbi;
695e073c03Smanu 	size_t						mpp_mbi_len;
705e073c03Smanu 	struct multiboot_header_tag_information_request*mpp_info_req;
715e073c03Smanu 	struct multiboot_header_tag_address		*mpp_address;
725e073c03Smanu 	struct multiboot_header_tag_entry_address	*mpp_entry;
735e073c03Smanu 	struct multiboot_header_tag_console_flags	*mpp_console;
745e073c03Smanu 	struct multiboot_header_tag_framebuffer		*mpp_framebuffer;
755e073c03Smanu 	struct multiboot_header_tag			*mpp_module_align;
765e073c03Smanu 	struct multiboot_header_tag			*mpp_efi_bs;
775e073c03Smanu 	struct multiboot_header_tag_entry_address	*mpp_entry_elf32;
785e073c03Smanu 	struct multiboot_header_tag_entry_address	*mpp_entry_elf64;
795e073c03Smanu 	struct multiboot_header_tag_relocatable		*mpp_relocatable;
805e073c03Smanu };
815e073c03Smanu 
825e073c03Smanu #ifndef NO_MULTIBOOT2
835e073c03Smanu 
845e073c03Smanu #ifdef MULTIBOOT2_DEBUG
855e073c03Smanu static void
mbi_hexdump(char * addr,size_t len)865e073c03Smanu mbi_hexdump(char *addr, size_t len)
875e073c03Smanu {
885e073c03Smanu 	int i,j;
895e073c03Smanu 
905e073c03Smanu 	for (i = 0; i < len; i += 16) {
915e073c03Smanu 		printf("  %p ", addr + i);
925e073c03Smanu 		for (j = 0; j < 16 && i + j < len; j++) {
935e073c03Smanu 			char *cp = addr + i + j;
945e073c03Smanu 			printf("%s%s%x",
955e073c03Smanu 			       (i+j) % 4 ? "" : " ",
965e073c03Smanu 			       (unsigned char)*cp < 0x10 ? "0" : "",
975e073c03Smanu 			       (unsigned char)*cp);
985e073c03Smanu 		}
995e073c03Smanu 		printf("\n");
1005e073c03Smanu 	}
1015e073c03Smanu 
1025e073c03Smanu 	return;
1035e073c03Smanu }
1045e073c03Smanu 
1055e073c03Smanu static const char *
mbi_tag_name(uint32_t type)1065e073c03Smanu mbi_tag_name(uint32_t type)
1075e073c03Smanu {
1085e073c03Smanu 	const char *tag_name;
1095e073c03Smanu 
1105e073c03Smanu 	switch (type) {
1115e073c03Smanu 	case MULTIBOOT_TAG_TYPE_END:
1125e073c03Smanu 		tag_name = "END"; break;
1135e073c03Smanu 	case MULTIBOOT_TAG_TYPE_CMDLINE:
1145e073c03Smanu 		tag_name = "CMDLINE"; break;
1155e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME:
1165e073c03Smanu 		tag_name = "BOOT_LOADER_NAME"; break;
1175e073c03Smanu 	case MULTIBOOT_TAG_TYPE_MODULE:
1185e073c03Smanu 		tag_name = "MODULE"; break;
1195e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO:
1205e073c03Smanu 		tag_name = "BASIC_MEMINFO"; break;
1215e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BOOTDEV:
1225e073c03Smanu 		tag_name = "BOOTDEV"; break;
1235e073c03Smanu 	case MULTIBOOT_TAG_TYPE_MMAP:
1245e073c03Smanu 		tag_name = "MMAP"; break;
1255e073c03Smanu 	case MULTIBOOT_TAG_TYPE_VBE:
1265e073c03Smanu 		tag_name = "VBE"; break;
1275e073c03Smanu 	case MULTIBOOT_TAG_TYPE_FRAMEBUFFER:
1285e073c03Smanu 		tag_name = "FRAMEBUFFER"; break;
1295e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ELF_SECTIONS:
1305e073c03Smanu 		tag_name = "ELF_SECTIONS"; break;
1315e073c03Smanu 	case MULTIBOOT_TAG_TYPE_APM:
1325e073c03Smanu 		tag_name = "APM"; break;
1335e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI32:
1345e073c03Smanu 		tag_name = "EFI32"; break;
1355e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI64:
1365e073c03Smanu 		tag_name = "EFI64"; break;
1375e073c03Smanu 	case MULTIBOOT_TAG_TYPE_SMBIOS:
1385e073c03Smanu 		tag_name = "SMBIOS"; break;
1395e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ACPI_OLD:
1405e073c03Smanu 		tag_name = "ACPI_OLD"; break;
1415e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ACPI_NEW:
1425e073c03Smanu 		tag_name = "ACPI_NEW"; break;
1435e073c03Smanu 	case MULTIBOOT_TAG_TYPE_NETWORK:
1445e073c03Smanu 		tag_name = "NETWORK"; break;
1455e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI_MMAP:
1465e073c03Smanu 		tag_name = "EFI_MMAP"; break;
1475e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI_BS:
1485e073c03Smanu 		tag_name = "EFI_BS"; break;
1495e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI32_IH:
1505e073c03Smanu 		tag_name = "EFI32_IH"; break;
1515e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI64_IH:
1525e073c03Smanu 		tag_name = "EFI64_IH"; break;
1535e073c03Smanu 	case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR:
1545e073c03Smanu 		tag_name = "LOAD_BASE_ADDR"; break;
1555e073c03Smanu 	default:
1565e073c03Smanu 		tag_name = "unknown"; break;
1575e073c03Smanu 	}
1585e073c03Smanu 
1595e073c03Smanu 	return tag_name;
1605e073c03Smanu }
1615e073c03Smanu 
1625e073c03Smanu static void
multiboot2_info_dump(uint32_t magic,char * mbi)1635e073c03Smanu multiboot2_info_dump(uint32_t magic, char *mbi)
1645e073c03Smanu {
1655e073c03Smanu 	struct multiboot_tag *mbt;
1665e073c03Smanu 	char *cp;
1675e073c03Smanu 	uint32_t total_size;
1685e073c03Smanu 	uint32_t actual_size;
1695e073c03Smanu 	uint32_t reserved;
1705e073c03Smanu 	int i = 0;
1715e073c03Smanu 
1725e073c03Smanu 	printf("=== multiboot2 info dump start  ===\n");
1735e073c03Smanu 
1745e073c03Smanu 	if (magic != MULTIBOOT2_BOOTLOADER_MAGIC) {
1755e073c03Smanu 		printf("Unexpected multiboot2 magic number: 0x%x\n", magic);
1765e073c03Smanu 		goto out;
1775e073c03Smanu 	}
1785e073c03Smanu 
1795e073c03Smanu 	if (mbi != (char *)rounddown((vaddr_t)mbi, MULTIBOOT_TAG_ALIGN)) {
1805e073c03Smanu 		printf("mbi at %p is not properly aligned\n", mbi);
1815e073c03Smanu 		goto out;
1825e073c03Smanu 	}
1835e073c03Smanu 
1845e073c03Smanu 	total_size = *(uint32_t *)mbi;
1855e073c03Smanu 	reserved = *(uint32_t *)mbi + 1;
1865e073c03Smanu 	mbt = (struct multiboot_tag *)(uint32_t *)mbi + 2;
1875e073c03Smanu 	actual_size = (char *)mbt - mbi;
1885e073c03Smanu 	printf("mbi.total_size = %d\n", total_size);
1895e073c03Smanu 	printf("mbi.reserved = %d\n", reserved);
1905e073c03Smanu 
1915e073c03Smanu 	for (cp = mbi + sizeof(total_size) + sizeof(reserved);
1925e073c03Smanu 	     cp - mbi < total_size;
1935e073c03Smanu 	     cp = cp + roundup(mbt->size, MULTIBOOT_TAG_ALIGN)) {
1945e073c03Smanu 		mbt = (struct multiboot_tag *)cp;
1955e073c03Smanu 		actual_size += roundup(mbt->size, MULTIBOOT_TAG_ALIGN);
1965e073c03Smanu 
1975e073c03Smanu 		printf("mbi[%d].type = %d(%s), .size = %d ",
1985e073c03Smanu 		    i++, mbt->type, mbi_tag_name(mbt->type), mbt->size);
1995e073c03Smanu 
2005e073c03Smanu 		switch (mbt->type) {
2015e073c03Smanu 		case MULTIBOOT_TAG_TYPE_CMDLINE:
2025e073c03Smanu 			printf(".string = \"%s\"\n",
2035e073c03Smanu 			    ((struct multiboot_tag_string *)mbt)->string);
2045e073c03Smanu 			break;
2055e073c03Smanu 		case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME:
2065e073c03Smanu 			printf(".string = \"%s\"\n",
2075e073c03Smanu 			    ((struct multiboot_tag_string *)mbt)->string);
2085e073c03Smanu 			break;
2095e073c03Smanu 		case MULTIBOOT_TAG_TYPE_MODULE:
2105e073c03Smanu 			printf(".mod_start = 0x%x, mod_end = 0x%x, "
2115e073c03Smanu 			    "string = \"%s\"\n",
2125e073c03Smanu 			    ((struct multiboot_tag_module *)mbt)->mod_start,
2135e073c03Smanu 			    ((struct multiboot_tag_module *)mbt)->mod_end,
2145e073c03Smanu 			    ((struct multiboot_tag_module *)mbt)->cmdline);
2155e073c03Smanu 			break;
2165e073c03Smanu 		case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO: {
2175e073c03Smanu 			struct multiboot_tag_basic_meminfo *meminfo;
2185e073c03Smanu 
2195e073c03Smanu 			meminfo = (struct multiboot_tag_basic_meminfo *)mbt;
2205e073c03Smanu 			printf(".mem_lower = %uKB, .mem_upper = %uKB\n",
2215e073c03Smanu 			    meminfo->mem_lower, meminfo->mem_upper);
2225e073c03Smanu 			break;
2235e073c03Smanu 		}
2245e073c03Smanu 		case MULTIBOOT_TAG_TYPE_BOOTDEV:
2255e073c03Smanu 			printf (".biosdev = 0x%x, .slice = %d, .part = %d\n",
2265e073c03Smanu 			    ((struct multiboot_tag_bootdev *)mbt)->biosdev,
2275e073c03Smanu 			    ((struct multiboot_tag_bootdev *)mbt)->slice,
2285e073c03Smanu 			    ((struct multiboot_tag_bootdev *)mbt)->part);
2295e073c03Smanu 			break;
2305e073c03Smanu 		case MULTIBOOT_TAG_TYPE_MMAP: {
2315e073c03Smanu 			struct multiboot_tag_mmap *memmap;
2325e073c03Smanu 			multiboot_memory_map_t *mmap;
2335e073c03Smanu 			uint32_t entry_size;
2345e073c03Smanu 			uint32_t entry_version;
2355e073c03Smanu 			int j = 0;
2365e073c03Smanu 
2375e073c03Smanu 			memmap = (struct multiboot_tag_mmap *)mbt;
2385e073c03Smanu 			entry_size = memmap->entry_size;
2395e073c03Smanu 			entry_version = memmap->entry_version;
2405e073c03Smanu 			printf (".entry_size = %d, .entry_version = %d\n",
2415e073c03Smanu 			    entry_size, entry_version);
2425e073c03Smanu 
2435e073c03Smanu 			for (mmap = ((struct multiboot_tag_mmap *)mbt)->entries;
2445e073c03Smanu 		 	    (char *)mmap - (char *)mbt < mbt->size;
2455e073c03Smanu 		 	    mmap = (void *)((char *)mmap + entry_size))
2465e073c03Smanu 				printf("  entry[%d].addr = 0x%"PRIx64",\t"
2475e073c03Smanu 				    ".len = 0x%"PRIx64",\t.type = 0x%x\n",
2485e073c03Smanu 				    j++, (uint64_t)mmap->addr,
2495e073c03Smanu 				    (uint64_t)mmap->len,
2505e073c03Smanu 				    mmap->type);
2515e073c03Smanu 			break;
2525e073c03Smanu 		}
2535e073c03Smanu 		case MULTIBOOT_TAG_TYPE_FRAMEBUFFER: {
2545e073c03Smanu 			struct multiboot_tag_framebuffer *fb = (void *)mbt;
2555e073c03Smanu 
2565e073c03Smanu 			printf ("%dx%dx%d at 0x%"PRIx64"\n",
2575e073c03Smanu 			    fb->common.framebuffer_width,
2585e073c03Smanu 			    fb->common.framebuffer_height,
2595e073c03Smanu 			    fb->common.framebuffer_bpp,
2605e073c03Smanu 			    (uint64_t)fb->common.framebuffer_addr);
2615e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
2625e073c03Smanu 			break;
2635e073c03Smanu 		}
2645e073c03Smanu 		case MULTIBOOT_TAG_TYPE_ELF_SECTIONS:
2655e073c03Smanu 			printf(".num = %d, .entsize = %d, .shndx = %d\n",
2665e073c03Smanu 			    ((struct multiboot_tag_elf_sections *)mbt)->num,
2675e073c03Smanu 			    ((struct multiboot_tag_elf_sections *)mbt)->entsize,
2685e073c03Smanu 			    ((struct multiboot_tag_elf_sections *)mbt)->shndx);
2695e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
2705e073c03Smanu 			break;
2715e073c03Smanu 		case MULTIBOOT_TAG_TYPE_APM:
2725e073c03Smanu 			printf(".version = %d, .cseg = 0x%x, .offset = 0x%x, "
2735e073c03Smanu 			    ".cseg_16 = 0x%x, .dseg = 0x%x, .flags = 0x%x, "
2745e073c03Smanu 			    ".cseg_len = %d, .cseg_16_len = %d, "
2755e073c03Smanu 			    ".dseg_len = %d\n",
2765e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->version,
2775e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->cseg,
2785e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->offset,
2795e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->cseg_16,
2805e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->dseg,
2815e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->flags,
2825e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->cseg_len,
2835e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->cseg_16_len,
2845e073c03Smanu 			    ((struct multiboot_tag_apm *)mbt)->dseg_len);
2855e073c03Smanu 			break;
2865e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI32:
2875e073c03Smanu 			printf(".pointer = 0x%x\n",
2885e073c03Smanu 			    ((struct multiboot_tag_efi32 *)mbt)->pointer);
2895e073c03Smanu 			break;
2905e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI64:
2915e073c03Smanu 			printf(".pointer = 0x%"PRIx64"\n", (uint64_t)
2925e073c03Smanu 			    ((struct multiboot_tag_efi64 *)mbt)->pointer);
2935e073c03Smanu 			break;
2945e073c03Smanu 		case MULTIBOOT_TAG_TYPE_SMBIOS:
2955e073c03Smanu 			printf(".major = %d, .minor = %d\n",
2965e073c03Smanu 			    ((struct multiboot_tag_smbios *)mbt)->major,
2975e073c03Smanu 		 	    ((struct multiboot_tag_smbios *)mbt)->minor);
2985e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
2995e073c03Smanu 			break;
3005e073c03Smanu 		case MULTIBOOT_TAG_TYPE_ACPI_OLD:
3015e073c03Smanu 			printf("\n");
3025e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
3035e073c03Smanu 			break;
3045e073c03Smanu 		case MULTIBOOT_TAG_TYPE_ACPI_NEW:
3055e073c03Smanu 			printf("\n");
3065e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
3075e073c03Smanu 			break;
3085e073c03Smanu 		case MULTIBOOT_TAG_TYPE_NETWORK:
3095e073c03Smanu 			printf("\n");
3105e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
3115e073c03Smanu 			break;
3125e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI_MMAP:
3135e073c03Smanu 			printf("\n");
3145e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
3155e073c03Smanu 			break;
3165e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI_BS:
3175e073c03Smanu 			printf("\n");
3185e073c03Smanu 			break;
3195e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI32_IH:
3205e073c03Smanu 			printf(".pointer = 0x%"PRIx32"\n",
3215e073c03Smanu 			    ((struct multiboot_tag_efi32_ih *)mbt)->pointer);
3225e073c03Smanu 			break;
3235e073c03Smanu 		case MULTIBOOT_TAG_TYPE_EFI64_IH:
3245e073c03Smanu 			printf(".pointer = 0x%"PRIx64"\n", (uint64_t)
3255e073c03Smanu 			    ((struct multiboot_tag_efi64_ih *)mbt)->pointer);
3265e073c03Smanu 			break;
3275e073c03Smanu 		case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR: {
3285e073c03Smanu 			struct multiboot_tag_load_base_addr *ld = (void *)mbt;
3295e073c03Smanu 			printf(".load_base_addr = 0x%x\n", ld->load_base_addr);
3305e073c03Smanu 			break;
3315e073c03Smanu 		}
3325e073c03Smanu 		case MULTIBOOT_TAG_TYPE_END:
3335e073c03Smanu 			break;
3345e073c03Smanu 		default:
3355e073c03Smanu 			printf("\n");
3365e073c03Smanu 			mbi_hexdump((char *)mbt, mbt->size);
3375e073c03Smanu 			break;
3385e073c03Smanu 		}
3395e073c03Smanu 	}
3405e073c03Smanu 
3415e073c03Smanu 	if (total_size != actual_size)
3425e073c03Smanu 		printf("Size mismatch: announded %d, actual %d\n",
3435e073c03Smanu 		    total_size, actual_size);
3445e073c03Smanu 
3455e073c03Smanu out:
3465e073c03Smanu 	printf("=== multiboot2 info dump start  ===\n");
3475e073c03Smanu 	return;
3485e073c03Smanu }
3495e073c03Smanu 
3505e073c03Smanu #define MPP_OPT(flags) \
3515e073c03Smanu     (flags & MULTIBOOT_HEADER_TAG_OPTIONAL) ? " (opt)" : " (req)"
3525e073c03Smanu 
3535e073c03Smanu static
multiboot2_header_dump(struct multiboot_package * mbp)3545e073c03Smanu void multiboot2_header_dump(struct multiboot_package *mbp)
3555e073c03Smanu {
3565e073c03Smanu 	struct multiboot_package_priv *mpp = mbp->mbp_priv;
3575e073c03Smanu 
3585e073c03Smanu 	printf("=== multiboot2 header dump start ===\n");
3595e073c03Smanu 	if (mpp->mpp_info_req) {
3605e073c03Smanu 		struct multiboot_header_tag_information_request *info_req;
3615e073c03Smanu 		size_t nreq;
3625e073c03Smanu 		int i;
3635e073c03Smanu 
3645e073c03Smanu 		info_req = mpp->mpp_info_req;
3655e073c03Smanu 
3665e073c03Smanu 		nreq = (info_req->size - sizeof(*info_req))
3675e073c03Smanu 		     / sizeof(info_req->requests[0]);
3685e073c03Smanu 
3695e073c03Smanu 		printf("Information tag request%s: ",
3705e073c03Smanu 		       MPP_OPT(info_req->flags));
3715e073c03Smanu 		for (i = 0; i < nreq; i++)
3725e073c03Smanu 			printf("%d(%s) ",
3735e073c03Smanu 			    info_req->requests[i],
3745e073c03Smanu 			    mbi_tag_name(info_req->requests[i]));
3755e073c03Smanu 		printf("\n");
3765e073c03Smanu 	}
3775e073c03Smanu 
3785e073c03Smanu 	if (mpp->mpp_address)
3795e073c03Smanu 		printf("Addresses%s: header = %"PRIx32", load = %"PRIx32", "
3805e073c03Smanu 		       "end = %"PRIx32", bss = %"PRIx32"\n",
3815e073c03Smanu 		       MPP_OPT(mpp->mpp_address->flags),
3825e073c03Smanu 		       mpp->mpp_address->header_addr,
3835e073c03Smanu 		       mpp->mpp_address->load_addr,
3845e073c03Smanu 		       mpp->mpp_address->load_end_addr,
3855e073c03Smanu 		       mpp->mpp_address->bss_end_addr);
3865e073c03Smanu 
3875e073c03Smanu 	if (mpp->mpp_entry)
3885e073c03Smanu 		printf("Entry point%s: %"PRIx32"\n",
3895e073c03Smanu 		       MPP_OPT(mpp->mpp_entry->flags),
3905e073c03Smanu 		       mpp->mpp_entry->entry_addr);
3915e073c03Smanu 
3925e073c03Smanu 	if (mpp->mpp_console) {
3935e073c03Smanu 		int flags = mpp->mpp_console->console_flags;
3945e073c03Smanu 		char *req_flag = "";
3955e073c03Smanu 		char *ega_flag = "";
3965e073c03Smanu 
3975e073c03Smanu 		if (flags & MULTIBOOT_CONSOLE_FLAGS_EGA_TEXT_SUPPORTED)
3985e073c03Smanu 			ega_flag = " EGA";
3995e073c03Smanu 		if (flags & MULTIBOOT_CONSOLE_FLAGS_CONSOLE_REQUIRED)
4005e073c03Smanu 			req_flag = " required";
4015e073c03Smanu 
4025e073c03Smanu 		printf("Console flags%s: %s %s\n",
4035e073c03Smanu 		       MPP_OPT(mpp->mpp_console->flags),
4045e073c03Smanu 		       ega_flag, req_flag);
4055e073c03Smanu 	}
4065e073c03Smanu 
4075e073c03Smanu 	if (mpp->mpp_framebuffer)
4085e073c03Smanu 		printf("Framebuffer%s: width = %d, height = %d, depth = %d\n",
4095e073c03Smanu 		       MPP_OPT(mpp->mpp_framebuffer->flags),
4105e073c03Smanu 		       mpp->mpp_framebuffer->width,
4115e073c03Smanu 		       mpp->mpp_framebuffer->height,
4125e073c03Smanu 		       mpp->mpp_framebuffer->depth);
4135e073c03Smanu 
4145e073c03Smanu 	if (mpp->mpp_module_align)
4155e073c03Smanu 		printf("Module alignmenet%s\n",
4165e073c03Smanu 		       MPP_OPT(mpp->mpp_module_align->flags));
4175e073c03Smanu 
4185e073c03Smanu 	if (mpp->mpp_efi_bs)
4195e073c03Smanu 		printf("Do not call EFI Boot service exit%s\n",
4205e073c03Smanu 		       MPP_OPT(mpp->mpp_efi_bs->flags));
4215e073c03Smanu 
4225e073c03Smanu 	if (mpp->mpp_entry_elf32)
4235e073c03Smanu 		printf("EFI32 entry point%s: %"PRIx32"\n",
4245e073c03Smanu 		       MPP_OPT(mpp->mpp_entry_elf32->flags),
4255e073c03Smanu 		       mpp->mpp_entry_elf32->entry_addr);
4265e073c03Smanu 
4275e073c03Smanu 	if (mpp->mpp_entry_elf64)
4285e073c03Smanu 		printf("EFI64 entry point%s: %"PRIx32"\n",
4295e073c03Smanu 		       MPP_OPT(mpp->mpp_entry_elf64->flags),
4305e073c03Smanu 		       mpp->mpp_entry_elf64->entry_addr);
4315e073c03Smanu 
4325e073c03Smanu 	if (mpp->mpp_relocatable) {
4335e073c03Smanu 		char *pref;
4345e073c03Smanu 
4355e073c03Smanu 		switch (mpp->mpp_relocatable->preference) {
4365e073c03Smanu 		case MULTIBOOT_LOAD_PREFERENCE_NONE: pref = "none"; break;
4375e073c03Smanu 		case MULTIBOOT_LOAD_PREFERENCE_LOW:  pref = "low"; break;
4385e073c03Smanu 		case MULTIBOOT_LOAD_PREFERENCE_HIGH: pref = "high"; break;
4395e073c03Smanu 		default:
4405e073c03Smanu 			pref = "(unknown)"; break;
4415e073c03Smanu 		}
4425e073c03Smanu 		printf("Relocatable%s: min_addr = %"PRIx32", "
4435e073c03Smanu 		       "max_addr = %"PRIx32", align = %"PRIx32", pref %s\n",
4445e073c03Smanu 		       MPP_OPT(mpp->mpp_relocatable->flags),
4455e073c03Smanu 		       mpp->mpp_relocatable->min_addr,
4465e073c03Smanu 		       mpp->mpp_relocatable->max_addr,
4475e073c03Smanu 		       mpp->mpp_relocatable->align, pref);
4485e073c03Smanu 	}
4495e073c03Smanu 
4505e073c03Smanu 	printf("=== multiboot2 header dump end  ===\n");
4515e073c03Smanu 	return;
4525e073c03Smanu }
4535e073c03Smanu #endif /* MULTIBOOT2_DEBUG */
4545e073c03Smanu 
4555e073c03Smanu static size_t
mbi_cmdline(struct multiboot_package * mbp,void * buf)4565e073c03Smanu mbi_cmdline(struct multiboot_package *mbp, void *buf)
4575e073c03Smanu {
4585e073c03Smanu 	struct multiboot_tag_string *mbt = buf;
4595e073c03Smanu 	size_t cmdlen;
4605e073c03Smanu 	size_t len;
4615e073c03Smanu 	const char fmt[] = "%s %s";
4625e073c03Smanu 
4635e073c03Smanu 	/* +1 for trailing \0 */
4645e073c03Smanu 	cmdlen = snprintf(NULL, SIZE_T_MAX, fmt, mbp->mbp_file, mbp->mbp_args)
4655e073c03Smanu 	       + 1;
4665e073c03Smanu 	len = sizeof(*mbt) + cmdlen;
4675e073c03Smanu 
4685e073c03Smanu 	if (mbt) {
4695e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_CMDLINE;
4705e073c03Smanu 		mbt->size = len;
4715e073c03Smanu 		(void)snprintf(mbt->string, cmdlen, fmt,
4725e073c03Smanu 			       mbp->mbp_file, mbp->mbp_args);
4735e073c03Smanu 	}
4745e073c03Smanu 
4755e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
4765e073c03Smanu }
4775e073c03Smanu 
4785e073c03Smanu static size_t
mbi_boot_loader_name(struct multiboot_package * mbp,void * buf)4795e073c03Smanu mbi_boot_loader_name(struct multiboot_package *mbp, void *buf)
4805e073c03Smanu {
4815e073c03Smanu 	struct multiboot_tag_string *mbt = buf;
4825e073c03Smanu 	size_t len;
4835e073c03Smanu 	size_t strlen;
4845e073c03Smanu 	const char fmt[] = "%s, Revision %s (from NetBSD %s)";
4855e073c03Smanu 
4865e073c03Smanu 
4875e073c03Smanu 	/* +1 for trailing \0 */
4885e073c03Smanu 	strlen = snprintf(NULL, SIZE_T_MAX, fmt,
4895e073c03Smanu 			  bootprog_name, bootprog_rev, bootprog_kernrev)
4905e073c03Smanu 	       + 1;
4915e073c03Smanu 	len = sizeof(*mbt) + strlen;
4925e073c03Smanu 
4935e073c03Smanu 	if (mbt) {
4945e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME;
4955e073c03Smanu 		mbt->size = len;
4965e073c03Smanu 	    	(void)snprintf(mbt->string, strlen, fmt, bootprog_name,
4975e073c03Smanu 			       bootprog_rev, bootprog_kernrev);
4985e073c03Smanu 	}
4995e073c03Smanu 
5005e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
5015e073c03Smanu }
5025e073c03Smanu 
5035e073c03Smanu static size_t
mbi_modules(struct multiboot_package * mbp,void * buf)5045e073c03Smanu mbi_modules(struct multiboot_package *mbp, void *buf)
5055e073c03Smanu {
5065e073c03Smanu 	struct multiboot_tag_module *mbt = buf;
5075e073c03Smanu 	struct bi_modulelist_entry *bim;
5085e073c03Smanu 	size_t len;
5095e073c03Smanu 	int i;
5105e073c03Smanu 
5115e073c03Smanu 	if (btinfo_modulelist == NULL)
5125e073c03Smanu 		return 0;
5135e073c03Smanu 
5145e073c03Smanu 	len = 0;
5155e073c03Smanu 
5165e073c03Smanu 	bim = (struct bi_modulelist_entry *)(btinfo_modulelist + 1);
5175e073c03Smanu 	for (i = 0; i < btinfo_modulelist->num; i++) {
5185e073c03Smanu 		size_t pathlen = strlen(bim->path) + 1;
5195e073c03Smanu 		size_t mbt_len = sizeof(*mbt) + pathlen;
5205e073c03Smanu 		size_t mbt_len_align = roundup(mbt_len, MULTIBOOT_TAG_ALIGN);
5215e073c03Smanu 		len += mbt_len_align;
5225e073c03Smanu 
5235e073c03Smanu 		if (mbt) {
5245e073c03Smanu 			mbt->type = MULTIBOOT_TAG_TYPE_MODULE;
5255e073c03Smanu 			mbt->size = mbt_len;
5265e073c03Smanu 			mbt->mod_start = bim->base;
5275e073c03Smanu 			mbt->mod_end = bim->base + bim->len;
5285e073c03Smanu 			strncpy(mbt->cmdline, bim->path, pathlen);
5295e073c03Smanu 
5305e073c03Smanu 			mbt = (struct multiboot_tag_module *)
5315e073c03Smanu 			    ((char *)mbt + mbt_len_align);
5325e073c03Smanu 		}
5335e073c03Smanu 	}
5345e073c03Smanu 
5355e073c03Smanu 	return len;
5365e073c03Smanu }
5375e073c03Smanu 
5385e073c03Smanu static size_t
mbi_basic_meminfo(struct multiboot_package * mbp,void * buf)5395e073c03Smanu mbi_basic_meminfo(struct multiboot_package *mbp, void *buf)
5405e073c03Smanu {
5415e073c03Smanu 	struct multiboot_tag_basic_meminfo *mbt = buf;
5425e073c03Smanu 	size_t len;
5435e073c03Smanu 
5445e073c03Smanu 	len = sizeof(*mbt);
5455e073c03Smanu 
5465e073c03Smanu 	if (mbt) {
5475e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_BASIC_MEMINFO;
5485e073c03Smanu 		mbt->size = len;
5495e073c03Smanu 		mbt->mem_lower = mbp->mbp_basemem;
5505e073c03Smanu 		mbt->mem_upper = mbp->mbp_extmem;
5515e073c03Smanu 	}
5525e073c03Smanu 
5535e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
5545e073c03Smanu }
5555e073c03Smanu 
5565e073c03Smanu static size_t
mbi_bootdev(struct multiboot_package * mbp,void * buf)5575e073c03Smanu mbi_bootdev(struct multiboot_package *mbp, void *buf)
5585e073c03Smanu {
5595e073c03Smanu 	struct multiboot_tag_bootdev *mbt = buf;
5605e073c03Smanu 	size_t len;
5615e073c03Smanu 
5625e073c03Smanu 	len = sizeof(*mbt);
5635e073c03Smanu 
5645e073c03Smanu 	/*
5655e073c03Smanu 	 * According to the specification:
5665e073c03Smanu 	 * - sub_partition is used for BSD disklabel.
5675e073c03Smanu 	 * - Extendded MBR partitions are counted from 4 and increasing,
5685e073c03Smanu 	 *   with no subpartition.
5695e073c03Smanu 	 */
5705e073c03Smanu 	if (mbt) {
5715e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_BOOTDEV;
5725e073c03Smanu 		mbt->size = len;
5735e073c03Smanu 		mbt->biosdev = bi_disk.biosdev;
5745e073c03Smanu 		mbt->slice = bi_disk.partition;
5755e073c03Smanu 		mbt->part = 0xFFFFFFFF;	/* aka sub_partition, for disklabel */
5765e073c03Smanu 	}
5775e073c03Smanu 
5785e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
5795e073c03Smanu 	return 0;
5805e073c03Smanu }
5815e073c03Smanu 
5825e073c03Smanu static size_t
mbi_mmap(struct multiboot_package * mbp,void * buf)5835e073c03Smanu mbi_mmap(struct multiboot_package *mbp, void *buf)
5845e073c03Smanu {
5855e073c03Smanu 	size_t len = 0;
5865e073c03Smanu 	struct multiboot_tag_mmap *mbt = buf;
5875e073c03Smanu 	struct bi_memmap_entry *memmap;
5885e073c03Smanu 	size_t num;
5895e073c03Smanu 
5905e073c03Smanu #ifndef EFIBOOT
5915e073c03Smanu 	bi_getmemmap();
5925e073c03Smanu 
5935e073c03Smanu 	if (btinfo_memmap == NULL)
5945e073c03Smanu 		goto out;
5955e073c03Smanu 
5965e073c03Smanu 	memmap = btinfo_memmap->entry;
5975e073c03Smanu 	num = btinfo_memmap->num;
5985e073c03Smanu #else
5995e073c03Smanu 	if (efi_memory_get_memmap(&memmap, &num) != 0)
6005e073c03Smanu 		goto out;
6015e073c03Smanu #endif
6025e073c03Smanu 
6035e073c03Smanu 	len = sizeof(*mbt) + num * sizeof(mbt->entries[0]);
6045e073c03Smanu 
6055e073c03Smanu 	if (mbt) {
6065e073c03Smanu 		int i;
6075e073c03Smanu 		struct multiboot_mmap_entry *mbte;
6085e073c03Smanu 
6095e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_MMAP;
6105e073c03Smanu 		mbt->size = len;
6115e073c03Smanu 		mbt->entry_size = sizeof(mbt->entries[0]);
6125e073c03Smanu 		mbt->entry_version = 0;
6135e073c03Smanu 
6145e073c03Smanu 		mbte = (struct multiboot_mmap_entry *)(mbt + 1);
6155e073c03Smanu 		for (i = 0; i < num; i++) {
6165e073c03Smanu 			mbte[i].addr = memmap[i].addr;
6175e073c03Smanu 			mbte[i].len = memmap[i].size;
6185e073c03Smanu 			switch(memmap[i].type) {
6195e073c03Smanu 			case BIM_Memory:
6205e073c03Smanu 				mbte[i].type = MULTIBOOT_MEMORY_AVAILABLE;
6215e073c03Smanu 				break;
6225e073c03Smanu 			case BIM_Reserved:
6235e073c03Smanu 				mbte[i].type = MULTIBOOT_MEMORY_RESERVED;
6245e073c03Smanu 				break;
6255e073c03Smanu 			case BIM_ACPI:
6265e073c03Smanu 				mbte[i].type =
6275e073c03Smanu 				    MULTIBOOT_MEMORY_ACPI_RECLAIMABLE;
6285e073c03Smanu 				break;
6295e073c03Smanu 			case BIM_NVS:
6305e073c03Smanu 				mbte[i].type = MULTIBOOT_MEMORY_NVS;
6315e073c03Smanu 				break;
6325e073c03Smanu 			case BIM_Unusable:
6335e073c03Smanu 				mbte[i].type = MULTIBOOT_MEMORY_BADRAM;
6345e073c03Smanu 				break;
6355e073c03Smanu 			default:
6365e073c03Smanu 				mbte[i].type = MULTIBOOT_MEMORY_RESERVED;
6375e073c03Smanu 				break;
6385e073c03Smanu 			}
6395e073c03Smanu 			mbte[i].zero = 0;
6405e073c03Smanu 		}
6415e073c03Smanu 	}
6425e073c03Smanu #ifdef EFIBOOT
6435e073c03Smanu 	dealloc(memmap, num * sizeof(memmap));
6445e073c03Smanu #endif
6455e073c03Smanu out:
6465e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
6475e073c03Smanu }
6485e073c03Smanu 
6495e073c03Smanu static size_t
mbi_vbe(struct multiboot_package * mbp,void * buf)6505e073c03Smanu mbi_vbe(struct multiboot_package *mbp, void *buf)
6515e073c03Smanu {
6525e073c03Smanu 	size_t len = 0;
6535e073c03Smanu 
6545e073c03Smanu #ifndef EFIBOOT
6555e073c03Smanu 	struct multiboot_tag_vbe *mbt = buf;
6565e073c03Smanu 
6575e073c03Smanu 	len = sizeof(*mbt);
6585e073c03Smanu 
6595e073c03Smanu 	if (mbt) {
6605e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_VBE;
6615e073c03Smanu 		mbt->size = len;
6625e073c03Smanu 		mbt->vbe_mode = btinfo_framebuffer.vbemode;
6635e073c03Smanu 		mbt->vbe_interface_seg = 0;
6645e073c03Smanu 		mbt->vbe_interface_off = 0;
6655e073c03Smanu 		mbt->vbe_interface_len = 0;
6665e073c03Smanu 		biosvbe_info((struct vbeinfoblock *)&mbt->vbe_control_info);
6675e073c03Smanu 		biosvbe_get_mode_info(mbt->vbe_mode,
6685e073c03Smanu 		    (struct modeinfoblock *)&mbt->vbe_mode_info);
6695e073c03Smanu 	}
6705e073c03Smanu #endif
6715e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
6725e073c03Smanu }
6735e073c03Smanu 
6745e073c03Smanu static size_t
mbi_framebuffer(struct multiboot_package * mbp,void * buf)6755e073c03Smanu mbi_framebuffer(struct multiboot_package *mbp, void *buf)
6765e073c03Smanu {
6775e073c03Smanu 	size_t len = 0;
6785e073c03Smanu 	struct multiboot_tag_framebuffer *mbt = buf;
6795e073c03Smanu 	struct btinfo_framebuffer *fb = &btinfo_framebuffer;
6805e073c03Smanu 
6815e073c03Smanu #ifndef EFIBOOT
6825e073c03Smanu 	struct modeinfoblock mi;
6835e073c03Smanu 
6845e073c03Smanu 	if (fb->physaddr != 0) {
6855e073c03Smanu 		int ret;
6865e073c03Smanu 
6875e073c03Smanu 		ret = biosvbe_get_mode_info(fb->vbemode, &mi);
6885e073c03Smanu 		if (ret != 0x004f)
6895e073c03Smanu 			return 0;
6905e073c03Smanu 	}
6915e073c03Smanu #endif
6925e073c03Smanu 
6935e073c03Smanu 	len = sizeof(*mbt);
6945e073c03Smanu 
6955e073c03Smanu 	if (mbt) {
6965e073c03Smanu 		mbt->common.type = MULTIBOOT_TAG_TYPE_FRAMEBUFFER;
6975e073c03Smanu 		mbt->common.size = len;
6985e073c03Smanu 		mbt->common.reserved = 0;
6995e073c03Smanu 
7005e073c03Smanu 		/*
7015e073c03Smanu 		 * No framebuffer, default to 80x25 console
7025e073c03Smanu 		 */
7035e073c03Smanu 		if (fb->physaddr == 0) {
7045e073c03Smanu 			int width = 80;
7055e073c03Smanu 			int height = 25;
7065e073c03Smanu 			int charlen = 2;
7075e073c03Smanu 			mbt->common.framebuffer_addr = CGA_BUF;
7085e073c03Smanu 			mbt->common.framebuffer_width = width;
7095e073c03Smanu 			mbt->common.framebuffer_height = height;
7105e073c03Smanu 			mbt->common.framebuffer_bpp = charlen * 8;
7115e073c03Smanu 			mbt->common.framebuffer_pitch = width * charlen;
7125e073c03Smanu 			mbt->common.framebuffer_type =
7135e073c03Smanu 			    MULTIBOOT_FRAMEBUFFER_TYPE_EGA_TEXT;
7145e073c03Smanu 		} else {
7155e073c03Smanu 			mbt->common.framebuffer_addr = fb->physaddr;
7165e073c03Smanu 			mbt->common.framebuffer_pitch = fb->stride;
7175e073c03Smanu 			mbt->common.framebuffer_width = fb->width;
7185e073c03Smanu 			mbt->common.framebuffer_height = fb->height;
7195e073c03Smanu 			mbt->common.framebuffer_bpp = fb->depth;
7205e073c03Smanu 			mbt->common.framebuffer_type =
7215e073c03Smanu 			    MULTIBOOT_FRAMEBUFFER_TYPE_RGB;
7225e073c03Smanu #ifndef EFIBOOT
7235e073c03Smanu 			if (mi.MemoryModel == 0x04)
7245e073c03Smanu 				mbt->common.framebuffer_type =
7255e073c03Smanu 				    MULTIBOOT_FRAMEBUFFER_TYPE_INDEXED;
7265e073c03Smanu #endif
7275e073c03Smanu 		}
7285e073c03Smanu 
7295e073c03Smanu 		switch (mbt->common.framebuffer_type) {
7305e073c03Smanu #ifndef EFIBOOT
7315e073c03Smanu 		case MULTIBOOT_FRAMEBUFFER_TYPE_INDEXED:
7325e073c03Smanu 			mbt->framebuffer_palette_num_colors = 256;
7335e073c03Smanu 
7345e073c03Smanu 			for (int i = 0; i < 256; i++) {
7355e073c03Smanu 				mbt->framebuffer_palette[i].red =
7365e073c03Smanu 				    rasops_cmap[3 * i];
7375e073c03Smanu 				mbt->framebuffer_palette[i].green =
7385e073c03Smanu 				    rasops_cmap[(3 * i) + 1];
7395e073c03Smanu 				mbt->framebuffer_palette[i].blue =
7405e073c03Smanu 				    rasops_cmap[(3 * i) + 2];
7415e073c03Smanu 			}
7425e073c03Smanu 			break;
7435e073c03Smanu #endif
7445e073c03Smanu 		case MULTIBOOT_FRAMEBUFFER_TYPE_RGB:
7455e073c03Smanu 			mbt->framebuffer_red_field_position = fb->rpos;
7465e073c03Smanu 			mbt->framebuffer_red_mask_size = fb->rnum;
7475e073c03Smanu 			mbt->framebuffer_green_field_position = fb->gpos;
7485e073c03Smanu 			mbt->framebuffer_green_mask_size = fb->gnum;
7495e073c03Smanu 			mbt->framebuffer_blue_field_position = fb->bpos;
7505e073c03Smanu 			mbt->framebuffer_blue_mask_size = fb->bnum;
7515e073c03Smanu 			break;
7525e073c03Smanu 		default:
7535e073c03Smanu 			break;
7545e073c03Smanu 		}
7555e073c03Smanu 	}
7565e073c03Smanu 
7575e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
7585e073c03Smanu }
7595e073c03Smanu 
7605e073c03Smanu static size_t
mbi_acpi_old(struct multiboot_package * mbp,void * buf)7615e073c03Smanu mbi_acpi_old(struct multiboot_package *mbp, void *buf)
7625e073c03Smanu {
7635e073c03Smanu 	size_t len = 0;
7645e073c03Smanu 	struct multiboot_tag_old_acpi *mbt = buf;
7655e073c03Smanu 	ACPI_PHYSICAL_ADDRESS rsdp_phys = -1;
7665e073c03Smanu 	ACPI_RSDP_COMMON rsdp;
7675e073c03Smanu #ifdef EFIBOOT
7685e073c03Smanu 	const EFI_GUID acpi_table_guid = ACPI_TABLE_GUID;
7695e073c03Smanu 	int i;
7705e073c03Smanu 
7715e073c03Smanu 	if (ST == NULL)
7725e073c03Smanu 		goto out;
7735e073c03Smanu 
7745e073c03Smanu 	for (i = 0; i < ST->NumberOfTableEntries; i++)  {
7755e073c03Smanu 		if (memcmp(&ST->ConfigurationTable[i].VendorGuid,
7765e073c03Smanu 		   &acpi_table_guid, sizeof(acpi_table_guid)) == 0) {
7775e073c03Smanu 			rsdp_phys = (ACPI_PHYSICAL_ADDRESS)
7785e073c03Smanu 			    ST->ConfigurationTable[i].VendorTable;
7795e073c03Smanu 			break;
7805e073c03Smanu 		}
7815e073c03Smanu 	}
7825e073c03Smanu #else
7835e073c03Smanu #ifdef notyet
7845e073c03Smanu 	rsdp_phys = acpi_md_OsGetRootPointer();
7855e073c03Smanu 	pvbcopy((void *)(vaddr_t)rsdp_phys, &rsdp, sizeof(rsdp));
7865e073c03Smanu 
7875e073c03Smanu 	/* Check ACPI 1.0 */
7885e073c03Smanu 	if (rsdp.Revision != 0)
7895e073c03Smanu 		rsdp_phys = -1;
7905e073c03Smanu #endif
7915e073c03Smanu #endif
7925e073c03Smanu 
7935e073c03Smanu 	if (rsdp_phys == -1)
7945e073c03Smanu 		goto out;
7955e073c03Smanu 
7965e073c03Smanu 	len = sizeof(*mbt) + sizeof(rsdp);
7975e073c03Smanu 	if (mbt) {
7985e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_ACPI_OLD;
7995e073c03Smanu 		mbt->size = len;
8005e073c03Smanu 		pvbcopy((void *)(vaddr_t)rsdp_phys, mbt->rsdp, sizeof(rsdp));
8015e073c03Smanu 	}
8025e073c03Smanu out:
8035e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
8045e073c03Smanu }
8055e073c03Smanu 
8065e073c03Smanu static size_t
mbi_acpi_new(struct multiboot_package * mbp,void * buf)8075e073c03Smanu mbi_acpi_new(struct multiboot_package *mbp, void *buf)
8085e073c03Smanu {
8095e073c03Smanu 	size_t len = 0;
8105e073c03Smanu 	struct multiboot_tag_new_acpi *mbt = buf;
8115e073c03Smanu 	ACPI_PHYSICAL_ADDRESS rsdp_phys = -1;
8125e073c03Smanu 	ACPI_TABLE_RSDP rsdp;
8135e073c03Smanu #ifdef EFIBOOT
8145e073c03Smanu 	const EFI_GUID acpi_20_table_guid = ACPI_20_TABLE_GUID;
8155e073c03Smanu 	int i;
8165e073c03Smanu 
8175e073c03Smanu 	if (ST == NULL)
8185e073c03Smanu 		goto out;
8195e073c03Smanu 
8205e073c03Smanu 	for (i = 0; i < ST->NumberOfTableEntries; i++)  {
8215e073c03Smanu 		if (memcmp(&ST->ConfigurationTable[i].VendorGuid,
8225e073c03Smanu 		   &acpi_20_table_guid, sizeof(acpi_20_table_guid)) == 0) {
8235e073c03Smanu 			rsdp_phys = (ACPI_PHYSICAL_ADDRESS)
8245e073c03Smanu 			    ST->ConfigurationTable[i].VendorTable;
8255e073c03Smanu 			break;
8265e073c03Smanu 		}
8275e073c03Smanu 	}
8285e073c03Smanu #else
8295e073c03Smanu #ifdef notyet
8305e073c03Smanu 	rsdp_phys = acpi_md_OsGetRootPointer();
8315e073c03Smanu 	pvbcopy((void *)(vaddr_t)rsdp_phys, &rsdp, sizeof(rsdp));
8325e073c03Smanu 
8335e073c03Smanu 	/* Check ACPI 2.0 */
8345e073c03Smanu 	if (rsdp.Revision != 2)
8355e073c03Smanu 		rsdp_phys = -1;
8365e073c03Smanu #endif
8375e073c03Smanu #endif
8385e073c03Smanu 	if (rsdp_phys == -1)
8395e073c03Smanu 		goto out;
8405e073c03Smanu 
8415e073c03Smanu 	len = sizeof(*mbt) + sizeof(rsdp);
8425e073c03Smanu 	if (mbt) {
8435e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_ACPI_NEW;
8445e073c03Smanu 		mbt->size = len;
8455e073c03Smanu 		pvbcopy((void *)(vaddr_t)rsdp_phys, mbt->rsdp, sizeof(rsdp));
8465e073c03Smanu 	}
8475e073c03Smanu out:
8485e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
8495e073c03Smanu }
8505e073c03Smanu 
8515e073c03Smanu static size_t
mbi_apm(struct multiboot_package * mbp,void * buf)8525e073c03Smanu mbi_apm(struct multiboot_package *mbp, void *buf)
8535e073c03Smanu {
8545e073c03Smanu 	size_t len = 0;
8555e073c03Smanu #ifdef notyet
8565e073c03Smanu 	struct multiboot_tag_apm *mbt = buf;
8575e073c03Smanu 
8585e073c03Smanu 	len = sizeof(*mbt):
8595e073c03Smanu 
8605e073c03Smanu 	if (mbt) {
8615e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_A;
8625e073c03Smanu 		mbt->size = len;
8635e073c03Smanu 		mbt->version = 0;
8645e073c03Smanu 		mbt->cseg = 0;
8655e073c03Smanu 		mbt->offset = 0;
8665e073c03Smanu 		mbt->cseg_16 = 0;
8678012ca3fSmsaitoh 		mbt->dseg = 0;
8685e073c03Smanu 		mbt->flags = 0;
8695e073c03Smanu 		mbt->cseg_len = 0;
8705e073c03Smanu 		mbt->cseg_16_len = 0;
8715e073c03Smanu 		mbt->dseg_len = 0;
8725e073c03Smanu 	}
8735e073c03Smanu out:
8745e073c03Smanu #endif
8755e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
8765e073c03Smanu }
8775e073c03Smanu 
8785e073c03Smanu static size_t
mbi_smbios(struct multiboot_package * mbp,void * buf)8795e073c03Smanu mbi_smbios(struct multiboot_package *mbp, void *buf)
8805e073c03Smanu {
8815e073c03Smanu 	size_t len = 0;
8825e073c03Smanu 	struct multiboot_tag_smbios *mbt = buf;
8835e073c03Smanu 	void *smbios_phys;
8845e073c03Smanu 	struct smb3hdr *smbios3_phys = NULL;
8855e073c03Smanu 	struct smb3hdr smbios3;
8865e073c03Smanu 	struct smbhdr *smbios21_phys = NULL;
8875e073c03Smanu 	struct smbhdr smbios21;
8885e073c03Smanu 	size_t smbios_len;
8895e073c03Smanu 	int major;
8905e073c03Smanu 	int minor;
8915e073c03Smanu #ifdef EFIBOOT
8925e073c03Smanu 	const EFI_GUID smbios3_guid = SMBIOS3_TABLE_GUID;
8935e073c03Smanu 	const EFI_GUID smbios21_guid = SMBIOS_TABLE_GUID;
8945e073c03Smanu 	int i;
8955e073c03Smanu 
8965e073c03Smanu 	if (ST == NULL)
8975e073c03Smanu 		goto out;
8985e073c03Smanu 
8995e073c03Smanu 	for (i = 0; i < ST->NumberOfTableEntries; i++)  {
9005e073c03Smanu 		if (memcmp(&ST->ConfigurationTable[i].VendorGuid,
9015e073c03Smanu 		   &smbios3_guid, sizeof(smbios3_guid)) == 0)
9025e073c03Smanu 			smbios3_phys = ST->ConfigurationTable[i].VendorTable;
9035e073c03Smanu 
9045e073c03Smanu 		if (memcmp(&ST->ConfigurationTable[i].VendorGuid,
9055e073c03Smanu 		   &smbios21_guid, sizeof(smbios21_guid)) == 0)
9065e073c03Smanu 			smbios21_phys = ST->ConfigurationTable[i].VendorTable;
9075e073c03Smanu 	}
9085e073c03Smanu #else
9095e073c03Smanu 	char *cp;
9105e073c03Smanu 	char line[16];
9115e073c03Smanu 	const char *smbios21_anchor = "_SM_";
9125e073c03Smanu 	const char *smbios3_anchor = "_SM3_";
9135e073c03Smanu 
9145e073c03Smanu 	for (cp = (char *)SMBIOS_START;
9155e073c03Smanu 	     cp < (char *)SMBIOS_END;
9165e073c03Smanu 	     cp += sizeof(buf)) {
9175e073c03Smanu 		pvbcopy(cp, line, sizeof(line));
9185e073c03Smanu 		if (memcmp(line, smbios3_anchor, strlen(smbios3_anchor)) == 0)
9195e073c03Smanu 			smbios3_phys = (struct smb3hdr *)cp;
9205e073c03Smanu 		if (memcmp(line, smbios21_anchor, strlen(smbios21_anchor)) == 0)
9215e073c03Smanu 			smbios21_phys = (struct smbhdr *)cp;
9225e073c03Smanu 	}
9235e073c03Smanu #endif
9245e073c03Smanu 	if (smbios3_phys != NULL) {
9255e073c03Smanu 		pvbcopy(smbios3_phys, &smbios3, sizeof(smbios3));
9265e073c03Smanu 		smbios_len = smbios3.len;
9275e073c03Smanu 		major = smbios3.majrev;
9285e073c03Smanu 		minor = smbios3.minrev;
9295e073c03Smanu 		smbios_phys = smbios3_phys;
9305e073c03Smanu 	} else if (smbios21_phys != NULL) {
9315e073c03Smanu 		pvbcopy(smbios21_phys, &smbios21, sizeof(smbios21));
9325e073c03Smanu 		smbios_len = smbios21.len;
9335e073c03Smanu 		major = smbios21.majrev;
9345e073c03Smanu 		minor = smbios21.minrev;
9355e073c03Smanu 		smbios_phys = smbios21_phys;
9365e073c03Smanu 	} else {
9375e073c03Smanu 		goto out;
9385e073c03Smanu 	}
9395e073c03Smanu 
9405e073c03Smanu 	len = sizeof(*mbt) + smbios_len;
9415e073c03Smanu 	if (mbt) {
9425e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_SMBIOS;
9435e073c03Smanu 		mbt->size = len;
9445e073c03Smanu 		mbt->major = major;
9455e073c03Smanu 		mbt->minor = minor;
9465e073c03Smanu 		pvbcopy(smbios_phys, mbt->tables, smbios_len);
9475e073c03Smanu 	}
9485e073c03Smanu out:
9495e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
9505e073c03Smanu }
9515e073c03Smanu 
9525e073c03Smanu static size_t
mbi_network(struct multiboot_package * mbp,void * buf)9535e073c03Smanu mbi_network(struct multiboot_package *mbp, void *buf)
9545e073c03Smanu {
9555e073c03Smanu 	size_t len = 0;
9565e073c03Smanu #ifdef notyet
9575e073c03Smanu 	struct multiboot_tag_network *mbt = buf;
9585e073c03Smanu 
9595e073c03Smanu 	if (saved_dhcpack == NULL || saved_dhcpack_len == 0)
9605e073c03Smanu 		goto out;
9615e073c03Smanu 
9625e073c03Smanu 	len = sizeof(*mbt) + saved_dhcpack_len;
9635e073c03Smanu 
9645e073c03Smanu 	if (mbt) {
9655e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_NETWORK;
9665e073c03Smanu 		mbt->size = len;
9675e073c03Smanu 		memcpy(mbt->dhcpack, saved_dhcpack, saved_dhcpack_len);
9685e073c03Smanu 	}
9695e073c03Smanu out:
9705e073c03Smanu #endif
9715e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
9725e073c03Smanu }
9735e073c03Smanu 
9745e073c03Smanu static size_t
mbi_elf_sections(struct multiboot_package * mbp,void * buf)9755e073c03Smanu mbi_elf_sections(struct multiboot_package *mbp, void *buf)
9765e073c03Smanu {
9775e073c03Smanu 	size_t len = 0;
9785e073c03Smanu 	struct multiboot_tag_elf_sections *mbt = buf;
979*6cf5ca46Srin 	union {
980*6cf5ca46Srin 		Elf32_Ehdr e32;
981*6cf5ca46Srin 		Elf64_Ehdr e64;
982*6cf5ca46Srin 	} ehdr;
98325313e1cSmanu 	int class;
9845e073c03Smanu 	Elf32_Ehdr *ehdr32 = NULL;
9855e073c03Smanu 	Elf64_Ehdr *ehdr64 = NULL;
98625313e1cSmanu 	uint64_t shnum, shentsize, shstrndx, shoff;
9875e073c03Smanu 	size_t shdr_len;
9885e073c03Smanu 
9895e073c03Smanu 	if (mbp->mbp_marks[MARK_SYM] == 0)
9905e073c03Smanu 		goto out;
9915e073c03Smanu 
9925e073c03Smanu 	pvbcopy((void *)mbp->mbp_marks[MARK_SYM], &ehdr, sizeof(ehdr));
9935e073c03Smanu 
9945e073c03Smanu 	/*
9955e073c03Smanu 	 * Check this is a ELF header
9965e073c03Smanu 	 */
997*6cf5ca46Srin 	if (memcmp(&ehdr.e32.e_ident, ELFMAG, SELFMAG) != 0)
9985e073c03Smanu 		goto out;
9995e073c03Smanu 
1000*6cf5ca46Srin 	class = ehdr.e32.e_ident[EI_CLASS];
100125313e1cSmanu 
100225313e1cSmanu 	switch (class) {
10035e073c03Smanu 	case ELFCLASS32:
1004*6cf5ca46Srin 		ehdr32 = &ehdr.e32;
10055e073c03Smanu 		shnum = ehdr32->e_shnum;
10065e073c03Smanu 		shentsize = ehdr32->e_shentsize;
10075e073c03Smanu 		shstrndx = ehdr32->e_shstrndx;
10085e073c03Smanu 		shoff = ehdr32->e_shoff;
10095e073c03Smanu 		break;
10105e073c03Smanu 	case ELFCLASS64:
1011*6cf5ca46Srin 		ehdr64 = &ehdr.e64;
10125e073c03Smanu 		shnum = ehdr64->e_shnum;
10135e073c03Smanu 		shentsize = ehdr64->e_shentsize;
10145e073c03Smanu 		shstrndx = ehdr64->e_shstrndx;
10155e073c03Smanu 		shoff = ehdr64->e_shoff;
10165e073c03Smanu 		break;
10175e073c03Smanu 	default:
10185e073c03Smanu 		goto out;
10195e073c03Smanu 	}
10205e073c03Smanu 
10215e073c03Smanu 	shdr_len = shnum * shentsize;
10225e073c03Smanu 	if (shdr_len == 0)
10235e073c03Smanu 		goto out;
10245e073c03Smanu 
10255e073c03Smanu 	len = sizeof(*mbt) + shdr_len;
10265e073c03Smanu 	if (mbt) {
102725313e1cSmanu 		char *shdr = (char *)mbp->mbp_marks[MARK_SYM] + shoff;
10285e073c03Smanu 
10295e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_ELF_SECTIONS;
10305e073c03Smanu 		mbt->size = len;
10315e073c03Smanu 		mbt->num = shnum;
10325e073c03Smanu 		mbt->entsize = shentsize;
10335e073c03Smanu 		mbt->shndx = shstrndx;
10345e073c03Smanu 
103525313e1cSmanu 		pvbcopy((void *)shdr, mbt + 1, shdr_len);
10365e073c03Smanu 
103725313e1cSmanu 		/*
103825313e1cSmanu 		 * Adjust sh_addr for symtab and strtab
103925313e1cSmanu 		 * section that have been loaded.
104025313e1cSmanu 		 */
104125313e1cSmanu 		ksyms_addr_set(&ehdr, mbt + 1,
104225313e1cSmanu 		    (void *)mbp->mbp_marks[MARK_SYM]);
10435e073c03Smanu 	}
104425313e1cSmanu 
10455e073c03Smanu out:
10465e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
10475e073c03Smanu }
10485e073c03Smanu 
10495e073c03Smanu static size_t
mbi_end(struct multiboot_package * mbp,void * buf)10505e073c03Smanu mbi_end(struct multiboot_package *mbp, void *buf)
10515e073c03Smanu {
10525e073c03Smanu 	struct multiboot_tag *mbt = buf;
10535e073c03Smanu 	size_t len = sizeof(*mbt);
10545e073c03Smanu 
10555e073c03Smanu 	if (mbt) {
10565e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_END;
10575e073c03Smanu 		mbt->size = len;
10585e073c03Smanu 	}
10595e073c03Smanu 
10605e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
10615e073c03Smanu }
10625e073c03Smanu 
10635e073c03Smanu static size_t
mbi_load_base_addr(struct multiboot_package * mbp,void * buf)10645e073c03Smanu mbi_load_base_addr(struct multiboot_package *mbp, void *buf)
10655e073c03Smanu {
10665e073c03Smanu 	size_t len = 0;
10675e073c03Smanu 	struct multiboot_tag_load_base_addr *mbt = buf;
10685e073c03Smanu 
10695e073c03Smanu 	len = sizeof(*mbt);
10705e073c03Smanu 
10715e073c03Smanu 	if (mbt) {
10725e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR;
10735e073c03Smanu 		mbt->size = len;
10745e073c03Smanu 		mbt->load_base_addr = mbp->mbp_marks[MARK_START];
10755e073c03Smanu 	}
10765e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
10775e073c03Smanu }
10785e073c03Smanu 
10795e073c03Smanu #ifdef EFIBOOT
10805e073c03Smanu /* Set if EFI ExitBootServices was not called */
10815e073c03Smanu static size_t
mbi_efi_bs(struct multiboot_package * mbp,void * buf)10825e073c03Smanu mbi_efi_bs(struct multiboot_package *mbp, void *buf)
10835e073c03Smanu {
10845e073c03Smanu 	size_t len = 0;
10855e073c03Smanu 	struct multiboot_tag *mbt = buf;
10865e073c03Smanu 
10875e073c03Smanu 	if (mbp->mbp_priv->mpp_efi_bs == NULL)
10885e073c03Smanu 		goto out;
10895e073c03Smanu 
10905e073c03Smanu 	len = sizeof(*mbt);
10915e073c03Smanu 
10925e073c03Smanu 	if (mbt) {
10935e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI_BS;
10945e073c03Smanu 		mbt->size = len;
10955e073c03Smanu 	}
10965e073c03Smanu 
10975e073c03Smanu out:
10985e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
10995e073c03Smanu }
11005e073c03Smanu 
11015e073c03Smanu 
11025e073c03Smanu static size_t
mbi_efi_mmap(struct multiboot_package * mbp,void * buf)11035e073c03Smanu mbi_efi_mmap(struct multiboot_package *mbp, void *buf)
11045e073c03Smanu {
11055e073c03Smanu 	size_t len = 0;
11065e073c03Smanu 	struct multiboot_tag_efi_mmap *mbt = buf;
11075e073c03Smanu 	size_t memmap_len;
11085e073c03Smanu 
11095e073c03Smanu 	if (btinfo_efimemmap == NULL)
11105e073c03Smanu 		goto out;
11115e073c03Smanu 
11125e073c03Smanu 	memmap_len = btinfo_efimemmap->num * btinfo_efimemmap->size;
11135e073c03Smanu 	len = sizeof(*mbt) + memmap_len;
11145e073c03Smanu 
11155e073c03Smanu 	if (mbt) {
11165e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI_MMAP;
11175e073c03Smanu 		mbt->size = len;
11185e073c03Smanu 		mbt->descr_size = btinfo_efimemmap->size;
11195e073c03Smanu 		mbt->descr_vers = btinfo_efimemmap->version;
11205e073c03Smanu 		memcpy(mbt + 1, btinfo_efimemmap->memmap, memmap_len);
11215e073c03Smanu 	}
11225e073c03Smanu 
11235e073c03Smanu out:
11245e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
11255e073c03Smanu }
11265e073c03Smanu 
11275e073c03Smanu 
11285e073c03Smanu 
11295e073c03Smanu #ifndef __LP64__
11305e073c03Smanu static size_t
mbi_efi32_ih(struct multiboot_package * mbp,void * buf)11315e073c03Smanu mbi_efi32_ih(struct multiboot_package *mbp, void *buf)
11325e073c03Smanu {
11335e073c03Smanu 	size_t len = 0;
11345e073c03Smanu 	struct multiboot_tag_efi32_ih *mbt = buf;
11355e073c03Smanu 
11365e073c03Smanu 	len = sizeof(*mbt);
11375e073c03Smanu 
11385e073c03Smanu 	if (mbt) {
11395e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI32_IH;
11405e073c03Smanu 		mbt->size = len;
11415e073c03Smanu 		mbt->pointer = (multiboot_uint32_t)IH;
11425e073c03Smanu 	}
11435e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
11445e073c03Smanu }
11455e073c03Smanu 
11465e073c03Smanu static size_t
mbi_efi32(struct multiboot_package * mbp,void * buf)11475e073c03Smanu mbi_efi32(struct multiboot_package *mbp, void *buf)
11485e073c03Smanu {
11495e073c03Smanu 	size_t len = 0;
11505e073c03Smanu 	struct multiboot_tag_efi32 *mbt = buf;
11515e073c03Smanu 
11525e073c03Smanu 	len = sizeof(*mbt);
11535e073c03Smanu 
11545e073c03Smanu 	if (mbt) {
11555e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI32;
11565e073c03Smanu 		mbt->size = len;
11575e073c03Smanu 		mbt->pointer = (multiboot_uint32_t)ST;
11585e073c03Smanu 	}
11595e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
11605e073c03Smanu }
11615e073c03Smanu #endif
11625e073c03Smanu 
11635e073c03Smanu #ifdef __LP64__
11645e073c03Smanu static size_t
mbi_efi64_ih(struct multiboot_package * mbp,void * buf)11655e073c03Smanu mbi_efi64_ih(struct multiboot_package *mbp, void *buf)
11665e073c03Smanu {
11675e073c03Smanu 	size_t len = 0;
11685e073c03Smanu 	struct multiboot_tag_efi64_ih *mbt = buf;
11695e073c03Smanu 
11705e073c03Smanu 	len = sizeof(*mbt);
11715e073c03Smanu 
11725e073c03Smanu 	if (mbt) {
11735e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI64_IH;
11745e073c03Smanu 		mbt->size = len;
11755e073c03Smanu 		mbt->pointer = (multiboot_uint64_t)IH;
11765e073c03Smanu 	}
11775e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
11785e073c03Smanu }
11795e073c03Smanu 
11805e073c03Smanu static size_t
mbi_efi64(struct multiboot_package * mbp,void * buf)11815e073c03Smanu mbi_efi64(struct multiboot_package *mbp, void *buf)
11825e073c03Smanu {
11835e073c03Smanu 	size_t len = 0;
11845e073c03Smanu 	struct multiboot_tag_efi64 *mbt = buf;
11855e073c03Smanu 
11865e073c03Smanu 	len = sizeof(*mbt);
11875e073c03Smanu 
11885e073c03Smanu 	if (mbt) {
11895e073c03Smanu 		mbt->type = MULTIBOOT_TAG_TYPE_EFI64;
11905e073c03Smanu 		mbt->size = len;
11915e073c03Smanu 		mbt->pointer = (multiboot_uint64_t)ST;
11925e073c03Smanu 	}
11935e073c03Smanu 	return roundup(len, MULTIBOOT_TAG_ALIGN);
11945e073c03Smanu }
11955e073c03Smanu #endif /* __LP64__ */
11965e073c03Smanu #endif /* EFIBOOT */
11975e073c03Smanu 
11985e073c03Smanu static bool
is_tag_required(struct multiboot_package * mbp,uint16_t tag)11995e073c03Smanu is_tag_required(struct multiboot_package *mbp, uint16_t tag)
12005e073c03Smanu {
12015e073c03Smanu 	bool ret = false;
12025e073c03Smanu 	int i;
12035e073c03Smanu 	struct multiboot_header_tag_information_request *info_req;
12045e073c03Smanu 	size_t nreq;
12055e073c03Smanu 
12065e073c03Smanu 	info_req = mbp->mbp_priv->mpp_info_req;
12075e073c03Smanu 
12085e073c03Smanu 	if (info_req == NULL)
12095e073c03Smanu 		goto out;
12105e073c03Smanu 
12115e073c03Smanu 	if (info_req->flags & MULTIBOOT_HEADER_TAG_OPTIONAL)
12125e073c03Smanu 		goto out;
12135e073c03Smanu 
12145e073c03Smanu 	nreq = (info_req->size - sizeof(*info_req))
12155e073c03Smanu 	     / sizeof(info_req->requests[0]);
12165e073c03Smanu 
12175e073c03Smanu 	for (i = 0; i < nreq; i++) {
12185e073c03Smanu 		if (info_req->requests[i] == tag) {
12195e073c03Smanu 			ret = true;
12205e073c03Smanu 			break;
12215e073c03Smanu 		}
12225e073c03Smanu 	}
12235e073c03Smanu 
12245e073c03Smanu out:
12255e073c03Smanu 	return ret;
12265e073c03Smanu }
12275e073c03Smanu 
12285e073c03Smanu static int
mbi_dispatch(struct multiboot_package * mbp,uint16_t type,char * bp,size_t * total_len)12295e073c03Smanu mbi_dispatch(struct multiboot_package *mbp, uint16_t type,
12305e073c03Smanu     char *bp, size_t *total_len)
12315e073c03Smanu {
12325e073c03Smanu 	int ret = 0;
12335e073c03Smanu 	size_t len = 0;
12345e073c03Smanu 
12355e073c03Smanu 	switch (type) {
12365e073c03Smanu 	case MULTIBOOT_TAG_TYPE_END:
12375e073c03Smanu 		len = mbi_end(mbp, bp);
12385e073c03Smanu 		break;
12395e073c03Smanu 	case MULTIBOOT_TAG_TYPE_CMDLINE:
12405e073c03Smanu 		len = mbi_cmdline(mbp, bp);
12415e073c03Smanu 		break;
12425e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME:
12435e073c03Smanu 		len = mbi_boot_loader_name(mbp, bp);
12445e073c03Smanu 		break;
12455e073c03Smanu 	case MULTIBOOT_TAG_TYPE_MODULE:
12465e073c03Smanu 		len = mbi_modules(mbp, bp);
12475e073c03Smanu 		break;
12485e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO:
12495e073c03Smanu 		len = mbi_basic_meminfo(mbp, bp);
12505e073c03Smanu 		break;
12515e073c03Smanu 	case MULTIBOOT_TAG_TYPE_BOOTDEV:
12525e073c03Smanu 		len = mbi_bootdev(mbp, bp);
12535e073c03Smanu 		break;
12545e073c03Smanu 	case MULTIBOOT_TAG_TYPE_MMAP:
12555e073c03Smanu 		len = mbi_mmap(mbp, bp);
12565e073c03Smanu 		break;
12575e073c03Smanu 	case MULTIBOOT_TAG_TYPE_VBE:
12585e073c03Smanu 		len = mbi_vbe(mbp, bp);
12595e073c03Smanu 		break;
12605e073c03Smanu 	case MULTIBOOT_TAG_TYPE_FRAMEBUFFER:
12615e073c03Smanu 		len = mbi_framebuffer(mbp, bp);
12625e073c03Smanu 		break;
12635e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ACPI_OLD:
12645e073c03Smanu 		len = mbi_acpi_old(mbp, bp);
12655e073c03Smanu 		break;
12665e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ACPI_NEW:
12675e073c03Smanu 		len = mbi_acpi_new(mbp, bp);
12685e073c03Smanu 		break;
12695e073c03Smanu 	case MULTIBOOT_TAG_TYPE_ELF_SECTIONS:
12705e073c03Smanu 		len = mbi_elf_sections(mbp, bp);
12715e073c03Smanu 		break;
12725e073c03Smanu 	case MULTIBOOT_TAG_TYPE_APM:
12735e073c03Smanu 		len = mbi_apm(mbp, bp);
12745e073c03Smanu 		break;
12755e073c03Smanu 	case MULTIBOOT_TAG_TYPE_SMBIOS:
12765e073c03Smanu 		len = mbi_smbios(mbp, bp);
12775e073c03Smanu 		break;
12785e073c03Smanu 	case MULTIBOOT_TAG_TYPE_NETWORK:
12795e073c03Smanu 		len = mbi_network(mbp, bp);
12805e073c03Smanu 		break;
12815e073c03Smanu #ifdef EFIBOOT
12825e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI_MMAP:
12835e073c03Smanu 		len = mbi_efi_mmap(mbp, bp);
12845e073c03Smanu 		break;
12855e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI_BS:
12865e073c03Smanu 		len = mbi_efi_bs(mbp, bp);
12875e073c03Smanu 		break;
12885e073c03Smanu #ifndef __LP64__
12895e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI32_IH:
12905e073c03Smanu 		len = mbi_efi32_ih(mbp, bp);
12915e073c03Smanu 		break;
12925e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI32:
12935e073c03Smanu 		len = mbi_efi32(mbp, bp);
12945e073c03Smanu 		break;
12955e073c03Smanu #else /* __LP64__ */
12965e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI64_IH:
12975e073c03Smanu 		len = mbi_efi64_ih(mbp, bp);
12985e073c03Smanu 		break;
12995e073c03Smanu 	case MULTIBOOT_TAG_TYPE_EFI64:
13005e073c03Smanu 		len = mbi_efi64(mbp, bp);
13015e073c03Smanu 		break;
13025e073c03Smanu #endif /* __LP64__ */
13035e073c03Smanu #endif /* EFIBOOT */
13045e073c03Smanu 	case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR:
13055e073c03Smanu 		len = mbi_load_base_addr(mbp, bp);
13065e073c03Smanu 		break;
13075e073c03Smanu 	default:
13085e073c03Smanu 		len = 0;
13095e073c03Smanu 		break;
13105e073c03Smanu 	}
13115e073c03Smanu 
13125e073c03Smanu 	if (len == 0 && is_tag_required(mbp, type))
13135e073c03Smanu 		ret = -1;
13145e073c03Smanu 
13155e073c03Smanu 	*total_len += len;
13165e073c03Smanu 	return ret;
13175e073c03Smanu }
13185e073c03Smanu 
13195e073c03Smanu static int
exec_multiboot2(struct multiboot_package * mbp)13205e073c03Smanu exec_multiboot2(struct multiboot_package *mbp)
13215e073c03Smanu {
13225e073c03Smanu 	size_t len, alen;
13235e073c03Smanu 	char *mbi = NULL;
13245e073c03Smanu 	struct multiboot_package_priv *mpp = mbp->mbp_priv;
13255e073c03Smanu 	uint16_t tags[] = {
13265e073c03Smanu 		MULTIBOOT_TAG_TYPE_CMDLINE,
13275e073c03Smanu 		MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME,
13285e073c03Smanu 		MULTIBOOT_TAG_TYPE_MODULE,
13295e073c03Smanu 		MULTIBOOT_TAG_TYPE_BASIC_MEMINFO,
13305e073c03Smanu 		MULTIBOOT_TAG_TYPE_BOOTDEV,
13315e073c03Smanu 		MULTIBOOT_TAG_TYPE_VBE,
13325e073c03Smanu 		MULTIBOOT_TAG_TYPE_FRAMEBUFFER,
13335e073c03Smanu 		MULTIBOOT_TAG_TYPE_ELF_SECTIONS,
13345e073c03Smanu 		MULTIBOOT_TAG_TYPE_APM,
13355e073c03Smanu 		MULTIBOOT_TAG_TYPE_SMBIOS,
13365e073c03Smanu 		MULTIBOOT_TAG_TYPE_ACPI_OLD,
13375e073c03Smanu 		MULTIBOOT_TAG_TYPE_ACPI_NEW,
13385e073c03Smanu 		MULTIBOOT_TAG_TYPE_NETWORK,
13395e073c03Smanu 		MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR,
13405e073c03Smanu #ifdef EFIBOOT
13415e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI_BS,
13425e073c03Smanu #ifndef __LP64__
13435e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI32,
13445e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI32_IH,
13455e073c03Smanu #else
13465e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI64,
13475e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI64_IH,
13485e073c03Smanu #endif /* __LP64__ */
13495e073c03Smanu 		/*
13505e073c03Smanu 		 * EFI_MMAP and MMAP at the end so that they
13515e073c03Smanu 		 * catch page allocation made for other tags.
13525e073c03Smanu 		 */
13535e073c03Smanu 		MULTIBOOT_TAG_TYPE_EFI_MMAP,
13545e073c03Smanu #endif /* EFIGOOT */
13555e073c03Smanu 		MULTIBOOT_TAG_TYPE_MMAP,
13565e073c03Smanu 		MULTIBOOT_TAG_TYPE_END, /* Must be last */
13575e073c03Smanu 	};
13585e073c03Smanu 	physaddr_t entry;
13595e073c03Smanu 	int i;
13605e073c03Smanu 
13615e073c03Smanu 	BI_ALLOC(BTINFO_MAX);
13625e073c03Smanu 
13635e073c03Smanu 	/* set new video mode if text mode was not requested */
13645e073c03Smanu 	if (mpp->mpp_framebuffer == NULL ||
13655e073c03Smanu 	    mpp->mpp_framebuffer->depth != 0)
13665e073c03Smanu 	vbe_commit();
13675e073c03Smanu 
13685e073c03Smanu 	len = 2 * sizeof(multiboot_uint32_t);
13695e073c03Smanu 	for (i = 0; i < sizeof(tags) / sizeof(*tags); i++) {
13705e073c03Smanu 		if (mbi_dispatch(mbp, tags[i], NULL, &len) != 0)
13715e073c03Smanu 			goto fail;
13725e073c03Smanu 	}
13735e073c03Smanu 
13745e073c03Smanu 	mpp->mpp_mbi_len = len + MULTIBOOT_TAG_ALIGN;
13755e073c03Smanu 	mpp->mpp_mbi = alloc(mpp->mpp_mbi_len);
13765e073c03Smanu 	mbi = (char *)roundup((vaddr_t)mpp->mpp_mbi, MULTIBOOT_TAG_ALIGN);
13775e073c03Smanu 
13785e073c03Smanu 	alen = 2 * sizeof(multiboot_uint32_t);
13795e073c03Smanu 	for (i = 0; i < sizeof(tags) / sizeof(*tags); i++) {
13805e073c03Smanu 		if (mbi_dispatch(mbp, tags[i], mbi + alen, &alen) != 0)
13815e073c03Smanu 			goto fail;
13825e073c03Smanu 
13835e073c03Smanu 		/*
13845e073c03Smanu 		 * It may shrink because of failure when filling
13855e073c03Smanu 		 * structures, but it should not grow.
13865e073c03Smanu 		 */
13875e073c03Smanu 		if (alen > len)
13885e073c03Smanu 			panic("multiboot2 info size mismatch");
13895e073c03Smanu 	}
13905e073c03Smanu 
13915e073c03Smanu 
13925e073c03Smanu 	((multiboot_uint32_t *)mbi)[0] = alen;	/* total size */
13935e073c03Smanu 	((multiboot_uint32_t *)mbi)[1] = 0;	/* reserved */
13945e073c03Smanu 
13955e073c03Smanu #if 0
13965e073c03Smanu 	for (i = 0; i < len; i += 16) {
13975e073c03Smanu 		printf("%p ", mbi + i);
13985e073c03Smanu 		for (int j = 0; j < 16; j++)
13995e073c03Smanu 			printf("%s%s%x",
14005e073c03Smanu 			       (i+j) % 4 ? "" : " ",
14015e073c03Smanu 			       (unsigned char)mbi[i+j] < 0x10 ? "0" : "",
14025e073c03Smanu 			       (unsigned char)(mbi[i+j]));
14035e073c03Smanu 		printf("\n");
14045e073c03Smanu 	}
14055e073c03Smanu #endif
14065e073c03Smanu 
14075e073c03Smanu 	printf("Start @ 0x%lx [%ld=0x%lx-0x%lx]...\n",
14085e073c03Smanu 	    mbp->mbp_marks[MARK_ENTRY],
14095e073c03Smanu 	    mbp->mbp_marks[MARK_NSYM],
14105e073c03Smanu 	    mbp->mbp_marks[MARK_SYM],
14115e073c03Smanu 	    mbp->mbp_marks[MARK_END]);
14125e073c03Smanu 
14135e073c03Smanu #ifdef MULTIBOOT2_DEBUG
14145e073c03Smanu 	multiboot2_info_dump(MULTIBOOT2_BOOTLOADER_MAGIC, mbi);
14155e073c03Smanu #endif /* MULTIBOOT2_DEBUG */
14165e073c03Smanu 
14175e073c03Smanu 	entry = mbp->mbp_marks[MARK_ENTRY];
14185e073c03Smanu 
14195e073c03Smanu 	if (mpp->mpp_entry)
14205e073c03Smanu 		entry = mpp->mpp_entry->entry_addr;
14215e073c03Smanu #ifdef EFIBOOT
14225e073c03Smanu #ifdef __LP64__
14235e073c03Smanu 	if (mpp->mpp_entry_elf64)
14245e073c03Smanu 		entry = mpp->mpp_entry_elf64->entry_addr
14255e073c03Smanu 		      + efi_loadaddr;
14265e073c03Smanu #else
14275e073c03Smanu 	if (mpp->mpp_entry_elf32)
14285e073c03Smanu 		entry = mpp->mpp_entry_elf32->entry_addr
14295e073c03Smanu 		      + efi_loadaddr;
14305e073c03Smanu #endif /* __LP64__ */
14315e073c03Smanu 	if (mpp->mpp_efi_bs == NULL)
14325e073c03Smanu 		efi_cleanup();
14335e073c03Smanu #endif /* EFIBOOT */
14345e073c03Smanu 
14355e073c03Smanu 	/* Does not return */
14365e073c03Smanu 	multiboot(entry, vtophys(mbi),
14375e073c03Smanu 	    x86_trunc_page(mbp->mbp_basemem * 1024),
14385e073c03Smanu 	    MULTIBOOT2_BOOTLOADER_MAGIC);
14395e073c03Smanu fail:
14405e073c03Smanu 	return -1;
14415e073c03Smanu }
14425e073c03Smanu 
14435e073c03Smanu static void
cleanup_multiboot2(struct multiboot_package * mbp)14445e073c03Smanu cleanup_multiboot2(struct multiboot_package *mbp)
14455e073c03Smanu {
14465e073c03Smanu 	if (mbp->mbp_header)
14475e073c03Smanu 		dealloc(mbp->mbp_header, mbp->mbp_header->header_length);
14485e073c03Smanu 	if (mbp->mbp_priv && mbp->mbp_priv->mpp_mbi)
14495e073c03Smanu 		dealloc(mbp->mbp_priv->mpp_mbi, mbp->mbp_priv->mpp_mbi_len);
14505e073c03Smanu 	if (mbp->mbp_priv)
14515e073c03Smanu 		dealloc(mbp->mbp_priv, sizeof(*mbp->mbp_priv));
14525e073c03Smanu 
14535e073c03Smanu 	dealloc(mbp, sizeof(*mbp));
14545e073c03Smanu 
14555e073c03Smanu 	return;
14565e073c03Smanu }
14575e073c03Smanu 
14585e073c03Smanu static bool
is_header_required(struct multiboot_header_tag * mbt)14595e073c03Smanu is_header_required(struct multiboot_header_tag *mbt)
14605e073c03Smanu {
14615e073c03Smanu 	bool ret = false;
14625e073c03Smanu 
14635e073c03Smanu 	if (mbt == NULL)
14645e073c03Smanu 		goto out;
14655e073c03Smanu 
14665e073c03Smanu 	if (mbt->flags & MULTIBOOT_HEADER_TAG_OPTIONAL)
14675e073c03Smanu 		goto out;
14685e073c03Smanu 
14695e073c03Smanu 	ret = true;
14705e073c03Smanu out:
14715e073c03Smanu 	return ret;
14725e073c03Smanu }
14735e073c03Smanu 
14745e073c03Smanu #define NEXT_HEADER(mbt) ((struct multiboot_header_tag *) \
14755e073c03Smanu    ((char *)mbt + roundup(mbt->size, MULTIBOOT_HEADER_ALIGN)))
14765e073c03Smanu 
14775e073c03Smanu struct multiboot_package *
probe_multiboot2(const char * path)14785e073c03Smanu probe_multiboot2(const char *path)
14795e073c03Smanu {
14805e073c03Smanu 	int fd = -1;
14815e073c03Smanu 	size_t i;
14825e073c03Smanu 	char buf[MULTIBOOT_SEARCH + sizeof(struct multiboot_header)];
14835e073c03Smanu 	ssize_t readen;
14845e073c03Smanu 	struct multiboot_package *mbp = NULL;
14855e073c03Smanu 	struct multiboot_header *mbh;
14865e073c03Smanu 	struct multiboot_header_tag *mbt;
14875e073c03Smanu 	size_t mbh_len = 0;
14885e073c03Smanu 
14895e073c03Smanu 	if ((fd = open(path, 0)) == -1)
14905e073c03Smanu 		goto out;
14915e073c03Smanu 
14925e073c03Smanu 	readen = read(fd, buf, sizeof(buf));
14935e073c03Smanu 	if (readen < sizeof(struct multiboot_header))
14945e073c03Smanu 		goto out;
14955e073c03Smanu 
14965e073c03Smanu 	for (i = 0; i < readen; i += MULTIBOOT_HEADER_ALIGN) {
14975e073c03Smanu 		mbh = (struct multiboot_header *)(buf + i);
14985e073c03Smanu 
14995e073c03Smanu 		if (mbh->magic != MULTIBOOT2_HEADER_MAGIC)
15005e073c03Smanu 			continue;
15015e073c03Smanu 
15025e073c03Smanu 		if (mbh->architecture != MULTIBOOT_ARCHITECTURE_I386)
15035e073c03Smanu 			continue;
15045e073c03Smanu 
15055e073c03Smanu 		if (mbh->magic + mbh->architecture +
15065e073c03Smanu 		    mbh->header_length + mbh->checksum)
15075e073c03Smanu 			continue;
15085e073c03Smanu 		mbh_len = mbh->header_length;
15095e073c03Smanu 
15105e073c03Smanu 		mbp = alloc(sizeof(*mbp));
15115e073c03Smanu 		mbp->mbp_version	= 2;
15125e073c03Smanu 		mbp->mbp_file		= path;
15135e073c03Smanu 		mbp->mbp_header		= alloc(mbh_len);
15145e073c03Smanu 		mbp->mbp_priv		= alloc(sizeof(*mbp->mbp_priv));
15155e073c03Smanu 		memset(mbp->mbp_priv, 0, sizeof (*mbp->mbp_priv));
15165e073c03Smanu 		mbp->mbp_probe		= *probe_multiboot2;
15175e073c03Smanu 		mbp->mbp_exec		= *exec_multiboot2;
15185e073c03Smanu 		mbp->mbp_cleanup	= *cleanup_multiboot2;
15195e073c03Smanu 
15205e073c03Smanu 		break;
15215e073c03Smanu 	}
15225e073c03Smanu 
15235e073c03Smanu 	if (mbp == NULL)
15245e073c03Smanu 		goto out;
15255e073c03Smanu 
15265e073c03Smanu 	if (lseek(fd, i, SEEK_SET) != i) {
15275e073c03Smanu 		printf("lseek failed");
15285e073c03Smanu 		mbp->mbp_cleanup(mbp);
15295e073c03Smanu 		mbp = NULL;
15305e073c03Smanu 		goto out;
15315e073c03Smanu 	}
15325e073c03Smanu 
15335e073c03Smanu 	mbh = mbp->mbp_header;
15345e073c03Smanu 	if (read(fd, mbh, mbh_len) != mbh_len) {
15355e073c03Smanu 		printf("read failed");
15365e073c03Smanu 		mbp->mbp_cleanup(mbp);
15375e073c03Smanu 		mbp = NULL;
15385e073c03Smanu 		goto out;
15395e073c03Smanu 	}
15405e073c03Smanu 
15415e073c03Smanu 	for (mbt = (struct multiboot_header_tag *)(mbh + 1);
15425e073c03Smanu 	     (char *)mbt - (char *)mbh < mbh_len;
15435e073c03Smanu 	     mbt = NEXT_HEADER(mbt)) {
15445e073c03Smanu 
15455e073c03Smanu 		switch(mbt->type) {
15465e073c03Smanu 		case MULTIBOOT_HEADER_TAG_INFORMATION_REQUEST:
15475e073c03Smanu 			mbp->mbp_priv->mpp_info_req = (void *)mbt;
15485e073c03Smanu 			break;
15495e073c03Smanu 		case MULTIBOOT_HEADER_TAG_ADDRESS:
15505e073c03Smanu 			mbp->mbp_priv->mpp_address = (void *)mbt;
15515e073c03Smanu 			break;
15525e073c03Smanu 		case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS:
15535e073c03Smanu 			mbp->mbp_priv->mpp_entry = (void *)mbt;
15545e073c03Smanu 			break;
15555e073c03Smanu 		case MULTIBOOT_HEADER_TAG_CONSOLE_FLAGS:
15565e073c03Smanu 			mbp->mbp_priv->mpp_console = (void *)mbt;
15575e073c03Smanu 
15585e073c03Smanu 		case MULTIBOOT_HEADER_TAG_FRAMEBUFFER:
15595e073c03Smanu 			mbp->mbp_priv->mpp_framebuffer = (void *)mbt;
15605e073c03Smanu 			break;
15615e073c03Smanu 		case MULTIBOOT_HEADER_TAG_MODULE_ALIGN:
15625e073c03Smanu 			mbp->mbp_priv->mpp_module_align = (void *)mbt;
15635e073c03Smanu 			break;
15645e073c03Smanu #ifdef EFIBOOT
15655e073c03Smanu 		case MULTIBOOT_HEADER_TAG_EFI_BS:
15665e073c03Smanu 			mbp->mbp_priv->mpp_efi_bs = (void *)mbt;
15675e073c03Smanu 			break;
15685e073c03Smanu 		case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI32:
15695e073c03Smanu 			mbp->mbp_priv->mpp_entry_elf32 = (void *)mbt;
15705e073c03Smanu 			break;
15715e073c03Smanu 		case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI64:
15725e073c03Smanu 			mbp->mbp_priv->mpp_entry_elf64 = (void *)mbt;
15735e073c03Smanu 			break;
15745e073c03Smanu #endif
15755e073c03Smanu 		case MULTIBOOT_HEADER_TAG_RELOCATABLE:
15765e073c03Smanu 			mbp->mbp_priv->mpp_relocatable = (void *)mbt;
15775e073c03Smanu 			break;
15785e073c03Smanu 		case MULTIBOOT_HEADER_TAG_END: /* FALLTHROUGH */
15795e073c03Smanu 		default:
15805e073c03Smanu 			break;
15815e073c03Smanu 		}
15825e073c03Smanu 	}
15835e073c03Smanu 
15845e073c03Smanu #ifdef MULTIBOOT2_DEBUG
15855e073c03Smanu 	multiboot2_header_dump(mbp);
15865e073c03Smanu #endif /* MULTIBOOT2_DEBUG */
15875e073c03Smanu 
15885e073c03Smanu 	/*
15895e073c03Smanu 	 * multiboot header fully supported
15905e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_INFORMATION_REQUEST
15915e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS
15925e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_MODULE_ALIGN (we always load as page aligned)
15935e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_EFI_BS
15945e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI32
15955e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI64
15965e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_CONSOLE_FLAGS (we always have a console)
15975e073c03Smanu 	 *
15985e073c03Smanu 	 * Not supported:
15995e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_ADDRESS
16005e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_FRAMEBUFFER (but spec says it is onty a hint)
16015e073c03Smanu 	 *  MULTIBOOT_HEADER_TAG_RELOCATABLE
16025e073c03Smanu 	 */
16035e073c03Smanu 
16045e073c03Smanu 	if (is_header_required((void *)mbp->mbp_priv->mpp_address)) {
16055e073c03Smanu 		printf("Unsupported multiboot address header\n");
16065e073c03Smanu 		mbp->mbp_cleanup(mbp);
16075e073c03Smanu 		mbp = NULL;
16085e073c03Smanu 		goto out;
16095e073c03Smanu 	}
16105e073c03Smanu 
16115e073c03Smanu #ifdef EFIBOOT
16125e073c03Smanu 	/*
16135e073c03Smanu 	 * We do not fully support the relocatable header, but
16145e073c03Smanu 	 * at least we honour the alignment request. Xen requires
16155e073c03Smanu 	 * that to boot.
16165e073c03Smanu 	 */
16175e073c03Smanu 	struct multiboot_header_tag_relocatable *reloc =
16185e073c03Smanu 	    mbp->mbp_priv->mpp_relocatable;
16195e073c03Smanu 	if (reloc)
16205e073c03Smanu 		efi_loadaddr = roundup(efi_loadaddr, reloc->align);
16215e073c03Smanu #endif
16225e073c03Smanu 
16235e073c03Smanu 	if (is_header_required((void *)mbp->mbp_priv->mpp_relocatable)) {
16245e073c03Smanu 		printf("Unsupported multiboot relocatable header\n");
16255e073c03Smanu 		mbp->mbp_cleanup(mbp);
16265e073c03Smanu 		mbp = NULL;
16275e073c03Smanu 		goto out;
16285e073c03Smanu 	}
16295e073c03Smanu 
16305e073c03Smanu out:
16315e073c03Smanu 
16325e073c03Smanu 	if (fd != -1)
16335e073c03Smanu 		close(fd);
16345e073c03Smanu 
16355e073c03Smanu 	return mbp;
16365e073c03Smanu }
16375e073c03Smanu 
16385e073c03Smanu #endif /* NO_MULTIBOOT2 */
1639