12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154 |
- /*
- * GRUB -- GRand Unified Bootloader
- * Copyright (C) 1999,2000,2001,2002,2003,2004,2005,2007,2008,2009,2010,2011,2012,2013 Free Software Foundation, Inc.
- *
- * GRUB is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * GRUB is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
- */
- #include <grub/memory.h>
- #ifdef GRUB_MACHINE_PCBIOS
- #include <grub/machine/biosnum.h>
- #include <grub/machine/apm.h>
- #include <grub/machine/memory.h>
- #endif
- #include <grub/multiboot.h>
- #include <grub/cpu/multiboot.h>
- #include <grub/cpu/relocator.h>
- #include <grub/disk.h>
- #include <grub/device.h>
- #include <grub/partition.h>
- #include <grub/mm.h>
- #include <grub/misc.h>
- #include <grub/env.h>
- #include <grub/video.h>
- #include <grub/acpi.h>
- #include <grub/i18n.h>
- #include <grub/net.h>
- #include <grub/lib/cmdline.h>
- #if defined (GRUB_MACHINE_EFI)
- #include <grub/efi/efi.h>
- #endif
- #if defined (GRUB_MACHINE_PCBIOS) || defined (GRUB_MACHINE_COREBOOT) || defined (GRUB_MACHINE_MULTIBOOT) || defined (GRUB_MACHINE_QEMU)
- #include <grub/i386/pc/vbe.h>
- #define HAS_VGA_TEXT 1
- #else
- #define HAS_VGA_TEXT 0
- #endif
- struct module
- {
- struct module *next;
- grub_addr_t start;
- grub_size_t size;
- char *cmdline;
- int cmdline_size;
- };
- static struct module *modules, *modules_last;
- static grub_size_t cmdline_size;
- static grub_size_t total_modcmd;
- static unsigned modcnt;
- static char *cmdline = NULL;
- static int bootdev_set;
- static grub_uint32_t biosdev, slice, part;
- static grub_size_t elf_sec_num, elf_sec_entsize;
- static unsigned elf_sec_shstrndx;
- static void *elf_sections;
- static int keep_bs = 0;
- static grub_uint32_t load_base_addr;
- void
- grub_multiboot_add_elfsyms (grub_size_t num, grub_size_t entsize,
- unsigned shndx, void *data)
- {
- elf_sec_num = num;
- elf_sec_shstrndx = shndx;
- elf_sec_entsize = entsize;
- elf_sections = data;
- }
- static struct multiboot_header *
- find_header (grub_properly_aligned_t *buffer, grub_ssize_t len)
- {
- struct multiboot_header *header;
- /* Look for the multiboot header in the buffer. The header should
- be at least 12 bytes and aligned on a 4-byte boundary. */
- for (header = (struct multiboot_header *) buffer;
- ((char *) header <= (char *) buffer + len - 12);
- header = (struct multiboot_header *) ((grub_uint32_t *) header + MULTIBOOT_HEADER_ALIGN / 4))
- {
- if (header->magic == MULTIBOOT_HEADER_MAGIC
- && !(header->magic + header->architecture
- + header->header_length + header->checksum)
- && header->architecture == MULTIBOOT_ARCHITECTURE_CURRENT)
- return header;
- }
- return NULL;
- }
- grub_err_t
- grub_multiboot_load (grub_file_t file, const char *filename)
- {
- grub_ssize_t len;
- struct multiboot_header *header;
- grub_err_t err;
- struct multiboot_header_tag *tag;
- struct multiboot_header_tag_address *addr_tag = NULL;
- struct multiboot_header_tag_relocatable *rel_tag;
- int entry_specified = 0, efi_entry_specified = 0;
- grub_addr_t entry = 0, efi_entry = 0;
- grub_uint32_t console_required = 0;
- struct multiboot_header_tag_framebuffer *fbtag = NULL;
- int accepted_consoles = GRUB_MULTIBOOT_CONSOLE_EGA_TEXT;
- mbi_load_data_t mld;
- mld.mbi_ver = 2;
- mld.relocatable = 0;
- mld.buffer = grub_malloc (MULTIBOOT_SEARCH);
- if (!mld.buffer)
- return grub_errno;
- len = grub_file_read (file, mld.buffer, MULTIBOOT_SEARCH);
- if (len < 32)
- {
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_BAD_OS, N_("premature end of file %s"), filename);
- }
- COMPILE_TIME_ASSERT (MULTIBOOT_HEADER_ALIGN % 4 == 0);
- header = find_header (mld.buffer, len);
- if (header == 0)
- {
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_BAD_ARGUMENT, "no multiboot header found");
- }
- COMPILE_TIME_ASSERT (MULTIBOOT_TAG_ALIGN % 4 == 0);
- keep_bs = 0;
- for (tag = (struct multiboot_header_tag *) (header + 1);
- tag->type != MULTIBOOT_TAG_TYPE_END;
- tag = (struct multiboot_header_tag *) ((grub_uint32_t *) tag + ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN) / 4))
- switch (tag->type)
- {
- case MULTIBOOT_HEADER_TAG_INFORMATION_REQUEST:
- {
- unsigned i;
- struct multiboot_header_tag_information_request *request_tag
- = (struct multiboot_header_tag_information_request *) tag;
- if (request_tag->flags & MULTIBOOT_HEADER_TAG_OPTIONAL)
- break;
- for (i = 0; i < (request_tag->size - sizeof (*request_tag))
- / sizeof (request_tag->requests[0]); i++)
- switch (request_tag->requests[i])
- {
- case MULTIBOOT_TAG_TYPE_END:
- case MULTIBOOT_TAG_TYPE_CMDLINE:
- case MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME:
- case MULTIBOOT_TAG_TYPE_MODULE:
- case MULTIBOOT_TAG_TYPE_BASIC_MEMINFO:
- case MULTIBOOT_TAG_TYPE_BOOTDEV:
- case MULTIBOOT_TAG_TYPE_MMAP:
- case MULTIBOOT_TAG_TYPE_FRAMEBUFFER:
- case MULTIBOOT_TAG_TYPE_VBE:
- case MULTIBOOT_TAG_TYPE_ELF_SECTIONS:
- case MULTIBOOT_TAG_TYPE_APM:
- case MULTIBOOT_TAG_TYPE_EFI32:
- case MULTIBOOT_TAG_TYPE_EFI64:
- case MULTIBOOT_TAG_TYPE_ACPI_OLD:
- case MULTIBOOT_TAG_TYPE_ACPI_NEW:
- case MULTIBOOT_TAG_TYPE_NETWORK:
- case MULTIBOOT_TAG_TYPE_EFI_MMAP:
- case MULTIBOOT_TAG_TYPE_EFI_BS:
- case MULTIBOOT_TAG_TYPE_EFI32_IH:
- case MULTIBOOT_TAG_TYPE_EFI64_IH:
- case MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR:
- break;
- default:
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_UNKNOWN_OS,
- "unsupported information tag: 0x%x",
- request_tag->requests[i]);
- }
- break;
- }
-
- case MULTIBOOT_HEADER_TAG_ADDRESS:
- addr_tag = (struct multiboot_header_tag_address *) tag;
- break;
- case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS:
- entry_specified = 1;
- entry = ((struct multiboot_header_tag_entry_address *) tag)->entry_addr;
- break;
- case MULTIBOOT_HEADER_TAG_ENTRY_ADDRESS_EFI64:
- #if defined (GRUB_MACHINE_EFI) && defined (__x86_64__)
- efi_entry_specified = 1;
- efi_entry = ((struct multiboot_header_tag_entry_address *) tag)->entry_addr;
- #endif
- break;
- case MULTIBOOT_HEADER_TAG_CONSOLE_FLAGS:
- if (!(((struct multiboot_header_tag_console_flags *) tag)->console_flags
- & MULTIBOOT_CONSOLE_FLAGS_EGA_TEXT_SUPPORTED))
- accepted_consoles &= ~GRUB_MULTIBOOT_CONSOLE_EGA_TEXT;
- if (((struct multiboot_header_tag_console_flags *) tag)->console_flags
- & MULTIBOOT_CONSOLE_FLAGS_CONSOLE_REQUIRED)
- console_required = 1;
- break;
- case MULTIBOOT_HEADER_TAG_FRAMEBUFFER:
- fbtag = (struct multiboot_header_tag_framebuffer *) tag;
- accepted_consoles |= GRUB_MULTIBOOT_CONSOLE_FRAMEBUFFER;
- break;
- case MULTIBOOT_HEADER_TAG_RELOCATABLE:
- mld.relocatable = 1;
- rel_tag = (struct multiboot_header_tag_relocatable *) tag;
- mld.min_addr = rel_tag->min_addr;
- mld.max_addr = rel_tag->max_addr;
- mld.align = rel_tag->align;
- switch (rel_tag->preference)
- {
- case MULTIBOOT_LOAD_PREFERENCE_LOW:
- mld.preference = GRUB_RELOCATOR_PREFERENCE_LOW;
- break;
- case MULTIBOOT_LOAD_PREFERENCE_HIGH:
- mld.preference = GRUB_RELOCATOR_PREFERENCE_HIGH;
- break;
- default:
- mld.preference = GRUB_RELOCATOR_PREFERENCE_NONE;
- }
- break;
- /* GRUB always page-aligns modules. */
- case MULTIBOOT_HEADER_TAG_MODULE_ALIGN:
- break;
- case MULTIBOOT_HEADER_TAG_EFI_BS:
- #ifdef GRUB_MACHINE_EFI
- keep_bs = 1;
- #endif
- break;
- default:
- if (! (tag->flags & MULTIBOOT_HEADER_TAG_OPTIONAL))
- {
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_UNKNOWN_OS,
- "unsupported tag: 0x%x", tag->type);
- }
- break;
- }
- if (addr_tag && !entry_specified && !(keep_bs && efi_entry_specified))
- {
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_UNKNOWN_OS,
- "load address tag without entry address tag");
- }
-
- if (addr_tag)
- {
- grub_uint64_t load_addr = (addr_tag->load_addr + 1)
- ? addr_tag->load_addr : (addr_tag->header_addr
- - ((char *) header - (char *) mld.buffer));
- int offset = ((char *) header - (char *) mld.buffer -
- (addr_tag->header_addr - load_addr));
- int load_size = ((addr_tag->load_end_addr == 0) ? file->size - offset :
- addr_tag->load_end_addr - addr_tag->load_addr);
- grub_size_t code_size;
- void *source;
- grub_relocator_chunk_t ch;
- if (addr_tag->bss_end_addr)
- code_size = (addr_tag->bss_end_addr - load_addr);
- else
- code_size = load_size;
- if (mld.relocatable)
- {
- if (code_size > mld.max_addr || mld.min_addr > mld.max_addr - code_size)
- {
- grub_free (mld.buffer);
- return grub_error (GRUB_ERR_BAD_OS, "invalid min/max address and/or load size");
- }
- err = grub_relocator_alloc_chunk_align (grub_multiboot_relocator, &ch,
- mld.min_addr, mld.max_addr - code_size,
- code_size, mld.align ? mld.align : 1,
- mld.preference, keep_bs);
- }
- else
- err = grub_relocator_alloc_chunk_addr (grub_multiboot_relocator,
- &ch, load_addr, code_size);
- if (err)
- {
- grub_dprintf ("multiboot_loader", "Error loading aout kludge\n");
- grub_free (mld.buffer);
- return err;
- }
- mld.link_base_addr = load_addr;
- mld.load_base_addr = get_physical_target_address (ch);
- source = get_virtual_current_address (ch);
- grub_dprintf ("multiboot_loader", "link_base_addr=0x%x, load_base_addr=0x%x, "
- "load_size=0x%lx, relocatable=%d\n", mld.link_base_addr,
- mld.load_base_addr, (long) code_size, mld.relocatable);
- if (mld.relocatable)
- grub_dprintf ("multiboot_loader", "align=0x%lx, preference=0x%x, avoid_efi_boot_services=%d\n",
- (long) mld.align, mld.preference, keep_bs);
- if ((grub_file_seek (file, offset)) == (grub_off_t) -1)
- {
- grub_free (mld.buffer);
- return grub_errno;
- }
- grub_file_read (file, source, load_size);
- if (grub_errno)
- {
- grub_free (mld.buffer);
- return grub_errno;
- }
- if (addr_tag->bss_end_addr)
- grub_memset ((grub_uint8_t *) source + load_size, 0,
- addr_tag->bss_end_addr - load_addr - load_size);
- }
- else
- {
- mld.file = file;
- mld.filename = filename;
- mld.avoid_efi_boot_services = keep_bs;
- err = grub_multiboot_load_elf (&mld);
- if (err)
- {
- grub_free (mld.buffer);
- return err;
- }
- }
- load_base_addr = mld.load_base_addr;
- if (keep_bs && efi_entry_specified)
- grub_multiboot_payload_eip = efi_entry;
- else if (entry_specified)
- grub_multiboot_payload_eip = entry;
- if (mld.relocatable)
- {
- /*
- * Both branches are mathematically equivalent. However, it looks
- * that real life (C?) is more complicated. I am trying to avoid
- * wrap around here if mld.load_base_addr < mld.link_base_addr.
- * If you look at C operator precedence then everything should work.
- * However, I am not 100% sure that a given compiler will not
- * optimize/break this stuff. So, maybe we should use signed
- * 64-bit int here.
- */
- if (mld.load_base_addr >= mld.link_base_addr)
- grub_multiboot_payload_eip += mld.load_base_addr - mld.link_base_addr;
- else
- grub_multiboot_payload_eip -= mld.link_base_addr - mld.load_base_addr;
- }
- if (fbtag)
- err = grub_multiboot_set_console (GRUB_MULTIBOOT_CONSOLE_FRAMEBUFFER,
- accepted_consoles,
- fbtag->width, fbtag->height,
- fbtag->depth, console_required);
- else
- err = grub_multiboot_set_console (GRUB_MULTIBOOT_CONSOLE_EGA_TEXT,
- accepted_consoles,
- 0, 0, 0, console_required);
- return err;
- }
- static grub_size_t
- acpiv2_size (void)
- {
- #if GRUB_MACHINE_HAS_ACPI
- struct grub_acpi_rsdp_v20 *p = grub_acpi_get_rsdpv2 ();
- if (!p)
- return 0;
- return ALIGN_UP (sizeof (struct multiboot_tag_old_acpi)
- + p->length, MULTIBOOT_TAG_ALIGN);
- #else
- return 0;
- #endif
- }
- #ifdef GRUB_MACHINE_EFI
- static grub_efi_uintn_t efi_mmap_size = 0;
- /* Find the optimal number of pages for the memory map. Is it better to
- move this code to efi/mm.c? */
- static void
- find_efi_mmap_size (void)
- {
- efi_mmap_size = (1 << 12);
- while (1)
- {
- int ret;
- grub_efi_memory_descriptor_t *mmap;
- grub_efi_uintn_t desc_size;
- grub_efi_uintn_t cur_mmap_size = efi_mmap_size;
- mmap = grub_malloc (cur_mmap_size);
- if (! mmap)
- return;
- ret = grub_efi_get_memory_map (&cur_mmap_size, mmap, 0, &desc_size, 0);
- grub_free (mmap);
- if (ret < 0)
- return;
- else if (ret > 0)
- break;
- if (efi_mmap_size < cur_mmap_size)
- efi_mmap_size = cur_mmap_size;
- efi_mmap_size += (1 << 12);
- }
- /* Increase the size a bit for safety, because GRUB allocates more on
- later, and EFI itself may allocate more. */
- efi_mmap_size += (3 << 12);
- efi_mmap_size = ALIGN_UP (efi_mmap_size, 4096);
- }
- #endif
- static grub_size_t
- net_size (void)
- {
- struct grub_net_network_level_interface *net;
- grub_size_t ret = 0;
- FOR_NET_NETWORK_LEVEL_INTERFACES(net)
- if (net->dhcp_ack)
- ret += ALIGN_UP (sizeof (struct multiboot_tag_network) + net->dhcp_acklen,
- MULTIBOOT_TAG_ALIGN);
- return ret;
- }
- static grub_size_t
- grub_multiboot_get_mbi_size (void)
- {
- #ifdef GRUB_MACHINE_EFI
- if (!keep_bs && !efi_mmap_size)
- find_efi_mmap_size ();
- #endif
- return 2 * sizeof (grub_uint32_t) + sizeof (struct multiboot_tag)
- + sizeof (struct multiboot_tag)
- + (sizeof (struct multiboot_tag_string)
- + ALIGN_UP (cmdline_size, MULTIBOOT_TAG_ALIGN))
- + (sizeof (struct multiboot_tag_string)
- + ALIGN_UP (sizeof (PACKAGE_STRING), MULTIBOOT_TAG_ALIGN))
- + (modcnt * sizeof (struct multiboot_tag_module) + total_modcmd)
- + ALIGN_UP (sizeof (struct multiboot_tag_basic_meminfo),
- MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_bootdev), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_elf_sections), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (elf_sec_entsize * elf_sec_num, MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP ((sizeof (struct multiboot_tag_mmap)
- + grub_get_multiboot_mmap_count ()
- * sizeof (struct multiboot_mmap_entry)), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_framebuffer), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_old_acpi)
- + sizeof (struct grub_acpi_rsdp_v10), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_load_base_addr), MULTIBOOT_TAG_ALIGN)
- + acpiv2_size ()
- + net_size ()
- #ifdef GRUB_MACHINE_EFI
- + ALIGN_UP (sizeof (struct multiboot_tag_efi32), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_efi32_ih), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_efi64), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_efi64_ih), MULTIBOOT_TAG_ALIGN)
- + ALIGN_UP (sizeof (struct multiboot_tag_efi_mmap)
- + efi_mmap_size, MULTIBOOT_TAG_ALIGN)
- #endif
- + sizeof (struct multiboot_tag_vbe) + MULTIBOOT_TAG_ALIGN - 1
- + sizeof (struct multiboot_tag_apm) + MULTIBOOT_TAG_ALIGN - 1;
- }
- /* Helper for grub_fill_multiboot_mmap. */
- static int
- grub_fill_multiboot_mmap_iter (grub_uint64_t addr, grub_uint64_t size,
- grub_memory_type_t type, void *data)
- {
- struct multiboot_mmap_entry **mmap_entry = data;
- (*mmap_entry)->addr = addr;
- (*mmap_entry)->len = size;
- (*mmap_entry)->type = type;
- (*mmap_entry)->zero = 0;
- (*mmap_entry)++;
- return 0;
- }
- /* Fill previously allocated Multiboot mmap. */
- static void
- grub_fill_multiboot_mmap (struct multiboot_tag_mmap *tag)
- {
- struct multiboot_mmap_entry *mmap_entry = tag->entries;
- tag->type = MULTIBOOT_TAG_TYPE_MMAP;
- tag->size = sizeof (struct multiboot_tag_mmap)
- + sizeof (struct multiboot_mmap_entry) * grub_get_multiboot_mmap_count ();
- tag->entry_size = sizeof (struct multiboot_mmap_entry);
- tag->entry_version = 0;
- grub_mmap_iterate (grub_fill_multiboot_mmap_iter, &mmap_entry);
- }
- #if defined (GRUB_MACHINE_PCBIOS)
- static void
- fill_vbe_tag (struct multiboot_tag_vbe *tag)
- {
- grub_vbe_status_t status;
- void *scratch = (void *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
- tag->type = MULTIBOOT_TAG_TYPE_VBE;
- tag->size = 0;
-
- status = grub_vbe_bios_get_controller_info (scratch);
- if (status != GRUB_VBE_STATUS_OK)
- return;
-
- grub_memcpy (&tag->vbe_control_info, scratch,
- sizeof (struct grub_vbe_info_block));
-
- status = grub_vbe_bios_get_mode (scratch);
- tag->vbe_mode = *(grub_uint32_t *) scratch;
- if (status != GRUB_VBE_STATUS_OK)
- return;
- /* get_mode_info isn't available for mode 3. */
- if (tag->vbe_mode == 3)
- {
- struct grub_vbe_mode_info_block *mode_info = (void *) &tag->vbe_mode_info;
- grub_memset (mode_info, 0,
- sizeof (struct grub_vbe_mode_info_block));
- mode_info->memory_model = GRUB_VBE_MEMORY_MODEL_TEXT;
- mode_info->x_resolution = 80;
- mode_info->y_resolution = 25;
- }
- else
- {
- status = grub_vbe_bios_get_mode_info (tag->vbe_mode, scratch);
- if (status != GRUB_VBE_STATUS_OK)
- return;
- grub_memcpy (&tag->vbe_mode_info, scratch,
- sizeof (struct grub_vbe_mode_info_block));
- }
- grub_vbe_bios_get_pm_interface (&tag->vbe_interface_seg,
- &tag->vbe_interface_off,
- &tag->vbe_interface_len);
- tag->size = sizeof (*tag);
- }
- #endif
- static grub_err_t
- retrieve_video_parameters (grub_properly_aligned_t **ptrorig)
- {
- grub_err_t err;
- struct grub_video_mode_info mode_info;
- void *framebuffer;
- grub_video_driver_id_t driv_id;
- struct grub_video_palette_data palette[256];
- struct multiboot_tag_framebuffer *tag
- = (struct multiboot_tag_framebuffer *) *ptrorig;
- err = grub_multiboot_set_video_mode ();
- if (err)
- {
- grub_print_error ();
- grub_errno = GRUB_ERR_NONE;
- }
- grub_video_get_palette (0, ARRAY_SIZE (palette), palette);
- driv_id = grub_video_get_driver_id ();
- #if HAS_VGA_TEXT
- if (driv_id == GRUB_VIDEO_DRIVER_NONE)
- {
- struct grub_vbe_mode_info_block vbe_mode_info;
- grub_uint32_t vbe_mode;
- #if defined (GRUB_MACHINE_PCBIOS)
- {
- grub_vbe_status_t status;
- void *scratch = (void *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
- status = grub_vbe_bios_get_mode (scratch);
- vbe_mode = *(grub_uint32_t *) scratch;
- if (status != GRUB_VBE_STATUS_OK)
- return GRUB_ERR_NONE;
- }
- #else
- vbe_mode = 3;
- #endif
- /* get_mode_info isn't available for mode 3. */
- if (vbe_mode == 3)
- {
- grub_memset (&vbe_mode_info, 0,
- sizeof (struct grub_vbe_mode_info_block));
- vbe_mode_info.memory_model = GRUB_VBE_MEMORY_MODEL_TEXT;
- vbe_mode_info.x_resolution = 80;
- vbe_mode_info.y_resolution = 25;
- }
- #if defined (GRUB_MACHINE_PCBIOS)
- else
- {
- grub_vbe_status_t status;
- void *scratch = (void *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
- status = grub_vbe_bios_get_mode_info (vbe_mode, scratch);
- if (status != GRUB_VBE_STATUS_OK)
- return GRUB_ERR_NONE;
- grub_memcpy (&vbe_mode_info, scratch,
- sizeof (struct grub_vbe_mode_info_block));
- }
- #endif
- if (vbe_mode_info.memory_model == GRUB_VBE_MEMORY_MODEL_TEXT)
- {
- tag = (struct multiboot_tag_framebuffer *) *ptrorig;
- tag->common.type = MULTIBOOT_TAG_TYPE_FRAMEBUFFER;
- tag->common.size = 0;
- tag->common.framebuffer_addr = 0xb8000;
-
- tag->common.framebuffer_pitch = 2 * vbe_mode_info.x_resolution;
- tag->common.framebuffer_width = vbe_mode_info.x_resolution;
- tag->common.framebuffer_height = vbe_mode_info.y_resolution;
- tag->common.framebuffer_bpp = 16;
-
- tag->common.framebuffer_type = MULTIBOOT_FRAMEBUFFER_TYPE_EGA_TEXT;
- tag->common.size = sizeof (tag->common);
- tag->common.reserved = 0;
- *ptrorig += ALIGN_UP (tag->common.size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- return GRUB_ERR_NONE;
- }
- #else
- if (driv_id == GRUB_VIDEO_DRIVER_NONE)
- return GRUB_ERR_NONE;
- #endif
- #if GRUB_MACHINE_HAS_VBE
- {
- struct multiboot_tag_vbe *tag_vbe = (struct multiboot_tag_vbe *) *ptrorig;
- fill_vbe_tag (tag_vbe);
- *ptrorig += ALIGN_UP (tag_vbe->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #endif
- err = grub_video_get_info_and_fini (&mode_info, &framebuffer);
- if (err)
- return err;
- tag = (struct multiboot_tag_framebuffer *) *ptrorig;
- tag->common.type = MULTIBOOT_TAG_TYPE_FRAMEBUFFER;
- tag->common.size = 0;
- tag->common.framebuffer_addr = (grub_addr_t) framebuffer;
- tag->common.framebuffer_pitch = mode_info.pitch;
- tag->common.framebuffer_width = mode_info.width;
- tag->common.framebuffer_height = mode_info.height;
- tag->common.framebuffer_bpp = mode_info.bpp;
- tag->common.reserved = 0;
-
- if (mode_info.mode_type & GRUB_VIDEO_MODE_TYPE_INDEX_COLOR)
- {
- unsigned i;
- tag->common.framebuffer_type = MULTIBOOT_FRAMEBUFFER_TYPE_INDEXED;
- tag->framebuffer_palette_num_colors = mode_info.number_of_colors;
- if (tag->framebuffer_palette_num_colors > ARRAY_SIZE (palette))
- tag->framebuffer_palette_num_colors = ARRAY_SIZE (palette);
- tag->common.size = sizeof (struct multiboot_tag_framebuffer_common)
- + sizeof (multiboot_uint16_t) + tag->framebuffer_palette_num_colors
- * sizeof (struct multiboot_color);
- for (i = 0; i < tag->framebuffer_palette_num_colors; i++)
- {
- tag->framebuffer_palette[i].red = palette[i].r;
- tag->framebuffer_palette[i].green = palette[i].g;
- tag->framebuffer_palette[i].blue = palette[i].b;
- }
- }
- else
- {
- tag->common.framebuffer_type = MULTIBOOT_FRAMEBUFFER_TYPE_RGB;
- tag->framebuffer_red_field_position = mode_info.red_field_pos;
- tag->framebuffer_red_mask_size = mode_info.red_mask_size;
- tag->framebuffer_green_field_position = mode_info.green_field_pos;
- tag->framebuffer_green_mask_size = mode_info.green_mask_size;
- tag->framebuffer_blue_field_position = mode_info.blue_field_pos;
- tag->framebuffer_blue_mask_size = mode_info.blue_mask_size;
- tag->common.size = sizeof (struct multiboot_tag_framebuffer_common) + 6;
- }
- *ptrorig += ALIGN_UP (tag->common.size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- return GRUB_ERR_NONE;
- }
- grub_err_t
- grub_multiboot_make_mbi (grub_uint32_t *target)
- {
- grub_properly_aligned_t *ptrorig;
- grub_properly_aligned_t *mbistart;
- grub_err_t err;
- grub_size_t bufsize;
- grub_relocator_chunk_t ch;
- bufsize = grub_multiboot_get_mbi_size ();
- COMPILE_TIME_ASSERT (MULTIBOOT_TAG_ALIGN % sizeof (grub_properly_aligned_t) == 0);
- err = grub_relocator_alloc_chunk_align (grub_multiboot_relocator, &ch,
- 0, 0xffffffff - bufsize,
- bufsize, MULTIBOOT_TAG_ALIGN,
- GRUB_RELOCATOR_PREFERENCE_NONE, 1);
- if (err)
- return err;
- ptrorig = get_virtual_current_address (ch);
- #if defined (__i386__) || defined (__x86_64__)
- *target = get_physical_target_address (ch);
- #elif defined (__mips)
- *target = get_physical_target_address (ch) | 0x80000000;
- #else
- #error Please complete this
- #endif
- mbistart = ptrorig;
- COMPILE_TIME_ASSERT ((2 * sizeof (grub_uint32_t))
- % sizeof (grub_properly_aligned_t) == 0);
- COMPILE_TIME_ASSERT (MULTIBOOT_TAG_ALIGN
- % sizeof (grub_properly_aligned_t) == 0);
- ptrorig += (2 * sizeof (grub_uint32_t)) / sizeof (grub_properly_aligned_t);
- {
- struct multiboot_tag_load_base_addr *tag = (struct multiboot_tag_load_base_addr *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_LOAD_BASE_ADDR;
- tag->size = sizeof (struct multiboot_tag_load_base_addr);
- tag->load_base_addr = load_base_addr;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- {
- struct multiboot_tag_string *tag = (struct multiboot_tag_string *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_CMDLINE;
- tag->size = sizeof (struct multiboot_tag_string) + cmdline_size;
- grub_memcpy (tag->string, cmdline, cmdline_size);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- {
- struct multiboot_tag_string *tag = (struct multiboot_tag_string *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_BOOT_LOADER_NAME;
- tag->size = sizeof (struct multiboot_tag_string) + sizeof (PACKAGE_STRING);
- grub_memcpy (tag->string, PACKAGE_STRING, sizeof (PACKAGE_STRING));
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #ifdef GRUB_MACHINE_PCBIOS
- {
- struct grub_apm_info info;
- if (grub_apm_get_info (&info))
- {
- struct multiboot_tag_apm *tag = (struct multiboot_tag_apm *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_APM;
- tag->size = sizeof (struct multiboot_tag_apm);
- tag->cseg = info.cseg;
- tag->offset = info.offset;
- tag->cseg_16 = info.cseg_16;
- tag->dseg = info.dseg;
- tag->flags = info.flags;
- tag->cseg_len = info.cseg_len;
- tag->dseg_len = info.dseg_len;
- tag->cseg_16_len = info.cseg_16_len;
- tag->version = info.version;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- #endif
- {
- unsigned i;
- struct module *cur;
- for (i = 0, cur = modules; i < modcnt; i++, cur = cur->next)
- {
- struct multiboot_tag_module *tag
- = (struct multiboot_tag_module *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_MODULE;
- tag->size = sizeof (struct multiboot_tag_module) + cur->cmdline_size;
- tag->mod_start = cur->start;
- tag->mod_end = tag->mod_start + cur->size;
- grub_memcpy (tag->cmdline, cur->cmdline, cur->cmdline_size);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- if (!keep_bs)
- {
- struct multiboot_tag_mmap *tag = (struct multiboot_tag_mmap *) ptrorig;
- grub_fill_multiboot_mmap (tag);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- {
- struct multiboot_tag_elf_sections *tag
- = (struct multiboot_tag_elf_sections *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_ELF_SECTIONS;
- tag->size = sizeof (struct multiboot_tag_elf_sections)
- + elf_sec_entsize * elf_sec_num;
- grub_memcpy (tag->sections, elf_sections, elf_sec_entsize * elf_sec_num);
- tag->num = elf_sec_num;
- tag->entsize = elf_sec_entsize;
- tag->shndx = elf_sec_shstrndx;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- if (!keep_bs)
- {
- struct multiboot_tag_basic_meminfo *tag
- = (struct multiboot_tag_basic_meminfo *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_BASIC_MEMINFO;
- tag->size = sizeof (struct multiboot_tag_basic_meminfo);
- /* Convert from bytes to kilobytes. */
- tag->mem_lower = grub_mmap_get_lower () / 1024;
- tag->mem_upper = grub_mmap_get_upper () / 1024;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- {
- struct grub_net_network_level_interface *net;
- FOR_NET_NETWORK_LEVEL_INTERFACES(net)
- if (net->dhcp_ack)
- {
- struct multiboot_tag_network *tag
- = (struct multiboot_tag_network *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_NETWORK;
- tag->size = sizeof (struct multiboot_tag_network) + net->dhcp_acklen;
- grub_memcpy (tag->dhcpack, net->dhcp_ack, net->dhcp_acklen);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- if (bootdev_set)
- {
- struct multiboot_tag_bootdev *tag
- = (struct multiboot_tag_bootdev *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_BOOTDEV;
- tag->size = sizeof (struct multiboot_tag_bootdev);
- tag->biosdev = biosdev;
- tag->slice = slice;
- tag->part = part;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- {
- err = retrieve_video_parameters (&ptrorig);
- if (err)
- {
- grub_print_error ();
- grub_errno = GRUB_ERR_NONE;
- }
- }
- #if defined (GRUB_MACHINE_EFI) && defined (__x86_64__)
- {
- struct multiboot_tag_efi64 *tag = (struct multiboot_tag_efi64 *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_EFI64;
- tag->size = sizeof (*tag);
- tag->pointer = (grub_addr_t) grub_efi_system_table;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #endif
- #if defined (GRUB_MACHINE_EFI) && defined (__i386__)
- {
- struct multiboot_tag_efi32 *tag = (struct multiboot_tag_efi32 *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_EFI32;
- tag->size = sizeof (*tag);
- tag->pointer = (grub_addr_t) grub_efi_system_table;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #endif
- #if GRUB_MACHINE_HAS_ACPI
- {
- struct multiboot_tag_old_acpi *tag = (struct multiboot_tag_old_acpi *)
- ptrorig;
- struct grub_acpi_rsdp_v10 *a = grub_acpi_get_rsdpv1 ();
- if (a)
- {
- tag->type = MULTIBOOT_TAG_TYPE_ACPI_OLD;
- tag->size = sizeof (*tag) + sizeof (*a);
- grub_memcpy (tag->rsdp, a, sizeof (*a));
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- {
- struct multiboot_tag_new_acpi *tag = (struct multiboot_tag_new_acpi *)
- ptrorig;
- struct grub_acpi_rsdp_v20 *a = grub_acpi_get_rsdpv2 ();
- if (a)
- {
- tag->type = MULTIBOOT_TAG_TYPE_ACPI_NEW;
- tag->size = sizeof (*tag) + a->length;
- grub_memcpy (tag->rsdp, a, a->length);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- #endif
- #ifdef GRUB_MACHINE_EFI
- {
- struct multiboot_tag_efi_mmap *tag = (struct multiboot_tag_efi_mmap *) ptrorig;
- grub_efi_uintn_t efi_desc_size;
- grub_efi_uint32_t efi_desc_version;
- if (!keep_bs)
- {
- tag->type = MULTIBOOT_TAG_TYPE_EFI_MMAP;
- tag->size = sizeof (*tag) + efi_mmap_size;
- err = grub_efi_finish_boot_services (&efi_mmap_size, tag->efi_mmap, NULL,
- &efi_desc_size, &efi_desc_version);
- if (err)
- return err;
- tag->descr_size = efi_desc_size;
- tag->descr_vers = efi_desc_version;
- tag->size = sizeof (*tag) + efi_mmap_size;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- }
- if (keep_bs)
- {
- {
- struct multiboot_tag *tag = (struct multiboot_tag *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_EFI_BS;
- tag->size = sizeof (struct multiboot_tag);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #ifdef __i386__
- {
- struct multiboot_tag_efi32_ih *tag = (struct multiboot_tag_efi32_ih *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_EFI32_IH;
- tag->size = sizeof (struct multiboot_tag_efi32_ih);
- tag->pointer = (grub_addr_t) grub_efi_image_handle;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #endif
- #ifdef __x86_64__
- {
- struct multiboot_tag_efi64_ih *tag = (struct multiboot_tag_efi64_ih *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_EFI64_IH;
- tag->size = sizeof (struct multiboot_tag_efi64_ih);
- tag->pointer = (grub_addr_t) grub_efi_image_handle;
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- #endif
- }
- #endif
- {
- struct multiboot_tag *tag = (struct multiboot_tag *) ptrorig;
- tag->type = MULTIBOOT_TAG_TYPE_END;
- tag->size = sizeof (struct multiboot_tag);
- ptrorig += ALIGN_UP (tag->size, MULTIBOOT_TAG_ALIGN)
- / sizeof (grub_properly_aligned_t);
- }
- ((grub_uint32_t *) mbistart)[0] = (char *) ptrorig - (char *) mbistart;
- ((grub_uint32_t *) mbistart)[1] = 0;
- return GRUB_ERR_NONE;
- }
- void
- grub_multiboot_free_mbi (void)
- {
- struct module *cur, *next;
- cmdline_size = 0;
- total_modcmd = 0;
- modcnt = 0;
- grub_free (cmdline);
- cmdline = NULL;
- bootdev_set = 0;
- for (cur = modules; cur; cur = next)
- {
- next = cur->next;
- grub_free (cur->cmdline);
- grub_free (cur);
- }
- modules = NULL;
- modules_last = NULL;
- }
- grub_err_t
- grub_multiboot_init_mbi (int argc, char *argv[])
- {
- grub_ssize_t len = 0;
- grub_multiboot_free_mbi ();
- len = grub_loader_cmdline_size (argc, argv);
- cmdline = grub_malloc (len);
- if (! cmdline)
- return grub_errno;
- cmdline_size = len;
- grub_create_loader_cmdline (argc, argv, cmdline,
- cmdline_size);
- return GRUB_ERR_NONE;
- }
- grub_err_t
- grub_multiboot_add_module (grub_addr_t start, grub_size_t size,
- int argc, char *argv[])
- {
- struct module *newmod;
- grub_size_t len = 0;
- newmod = grub_malloc (sizeof (*newmod));
- if (!newmod)
- return grub_errno;
- newmod->start = start;
- newmod->size = size;
- len = grub_loader_cmdline_size (argc, argv);
- newmod->cmdline = grub_malloc (len);
- if (! newmod->cmdline)
- {
- grub_free (newmod);
- return grub_errno;
- }
- newmod->cmdline_size = len;
- total_modcmd += ALIGN_UP (len, MULTIBOOT_TAG_ALIGN);
- grub_create_loader_cmdline (argc, argv, newmod->cmdline,
- newmod->cmdline_size);
- if (modules_last)
- modules_last->next = newmod;
- else
- modules = newmod;
- modules_last = newmod;
- modcnt++;
- return GRUB_ERR_NONE;
- }
- void
- grub_multiboot_set_bootdev (void)
- {
- grub_device_t dev;
- slice = ~0;
- part = ~0;
- #ifdef GRUB_MACHINE_PCBIOS
- biosdev = grub_get_root_biosnumber ();
- #else
- biosdev = 0xffffffff;
- #endif
- if (biosdev == 0xffffffff)
- return;
- dev = grub_device_open (0);
- if (dev && dev->disk && dev->disk->partition)
- {
- if (dev->disk->partition->parent)
- {
- part = dev->disk->partition->number;
- slice = dev->disk->partition->parent->number;
- }
- else
- slice = dev->disk->partition->number;
- }
- if (dev)
- grub_device_close (dev);
- bootdev_set = 1;
- }
|