forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
370 lines
8.8 KiB
370 lines
8.8 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Copyright (c) 2011 The Chromium OS Authors. |
|
* (C) Copyright 2002 |
|
* Daniel Engström, Omicron Ceti AB, <[email protected]> |
|
*/ |
|
|
|
/* |
|
* Linux x86 zImage and bzImage loading |
|
* |
|
* based on the procdure described in |
|
* linux/Documentation/i386/boot.txt |
|
*/ |
|
|
|
#include <common.h> |
|
#include <malloc.h> |
|
#include <asm/acpi_table.h> |
|
#include <asm/io.h> |
|
#include <asm/ptrace.h> |
|
#include <asm/zimage.h> |
|
#include <asm/byteorder.h> |
|
#include <asm/bootm.h> |
|
#include <asm/bootparam.h> |
|
#ifdef CONFIG_SYS_COREBOOT |
|
#include <asm/arch/timestamp.h> |
|
#endif |
|
#include <linux/compiler.h> |
|
#include <linux/libfdt.h> |
|
|
|
/* |
|
* Memory lay-out: |
|
* |
|
* relative to setup_base (which is 0x90000 currently) |
|
* |
|
* 0x0000-0x7FFF Real mode kernel |
|
* 0x8000-0x8FFF Stack and heap |
|
* 0x9000-0x90FF Kernel command line |
|
*/ |
|
#define DEFAULT_SETUP_BASE 0x90000 |
|
#define COMMAND_LINE_OFFSET 0x9000 |
|
#define HEAP_END_OFFSET 0x8e00 |
|
|
|
#define COMMAND_LINE_SIZE 2048 |
|
|
|
static void build_command_line(char *command_line, int auto_boot) |
|
{ |
|
char *env_command_line; |
|
|
|
command_line[0] = '\0'; |
|
|
|
env_command_line = env_get("bootargs"); |
|
|
|
/* set console= argument if we use a serial console */ |
|
if (!strstr(env_command_line, "console=")) { |
|
if (!strcmp(env_get("stdout"), "serial")) { |
|
|
|
/* We seem to use serial console */ |
|
sprintf(command_line, "console=ttyS0,%s ", |
|
env_get("baudrate")); |
|
} |
|
} |
|
|
|
if (auto_boot) |
|
strcat(command_line, "auto "); |
|
|
|
if (env_command_line) |
|
strcat(command_line, env_command_line); |
|
|
|
printf("Kernel command line: \"%s\"\n", command_line); |
|
} |
|
|
|
static int kernel_magic_ok(struct setup_header *hdr) |
|
{ |
|
if (KERNEL_MAGIC != hdr->boot_flag) { |
|
printf("Error: Invalid Boot Flag " |
|
"(found 0x%04x, expected 0x%04x)\n", |
|
hdr->boot_flag, KERNEL_MAGIC); |
|
return 0; |
|
} else { |
|
printf("Valid Boot Flag\n"); |
|
return 1; |
|
} |
|
} |
|
|
|
static int get_boot_protocol(struct setup_header *hdr) |
|
{ |
|
if (hdr->header == KERNEL_V2_MAGIC) { |
|
printf("Magic signature found\n"); |
|
return hdr->version; |
|
} else { |
|
/* Very old kernel */ |
|
printf("Magic signature not found\n"); |
|
return 0x0100; |
|
} |
|
} |
|
|
|
static int setup_device_tree(struct setup_header *hdr, const void *fdt_blob) |
|
{ |
|
int bootproto = get_boot_protocol(hdr); |
|
struct setup_data *sd; |
|
int size; |
|
|
|
if (bootproto < 0x0209) |
|
return -ENOTSUPP; |
|
|
|
if (!fdt_blob) |
|
return 0; |
|
|
|
size = fdt_totalsize(fdt_blob); |
|
if (size < 0) |
|
return -EINVAL; |
|
|
|
size += sizeof(struct setup_data); |
|
sd = (struct setup_data *)malloc(size); |
|
if (!sd) { |
|
printf("Not enough memory for DTB setup data\n"); |
|
return -ENOMEM; |
|
} |
|
|
|
sd->next = hdr->setup_data; |
|
sd->type = SETUP_DTB; |
|
sd->len = fdt_totalsize(fdt_blob); |
|
memcpy(sd->data, fdt_blob, sd->len); |
|
hdr->setup_data = (unsigned long)sd; |
|
|
|
return 0; |
|
} |
|
|
|
struct boot_params *load_zimage(char *image, unsigned long kernel_size, |
|
ulong *load_addressp) |
|
{ |
|
struct boot_params *setup_base; |
|
int setup_size; |
|
int bootproto; |
|
int big_image; |
|
|
|
struct boot_params *params = (struct boot_params *)image; |
|
struct setup_header *hdr = ¶ms->hdr; |
|
|
|
/* base address for real-mode segment */ |
|
setup_base = (struct boot_params *)DEFAULT_SETUP_BASE; |
|
|
|
if (!kernel_magic_ok(hdr)) |
|
return 0; |
|
|
|
/* determine size of setup */ |
|
if (0 == hdr->setup_sects) { |
|
printf("Setup Sectors = 0 (defaulting to 4)\n"); |
|
setup_size = 5 * 512; |
|
} else { |
|
setup_size = (hdr->setup_sects + 1) * 512; |
|
} |
|
|
|
printf("Setup Size = 0x%8.8lx\n", (ulong)setup_size); |
|
|
|
if (setup_size > SETUP_MAX_SIZE) |
|
printf("Error: Setup is too large (%d bytes)\n", setup_size); |
|
|
|
/* determine boot protocol version */ |
|
bootproto = get_boot_protocol(hdr); |
|
|
|
printf("Using boot protocol version %x.%02x\n", |
|
(bootproto & 0xff00) >> 8, bootproto & 0xff); |
|
|
|
if (bootproto >= 0x0200) { |
|
if (hdr->setup_sects >= 15) { |
|
printf("Linux kernel version %s\n", |
|
(char *)params + |
|
hdr->kernel_version + 0x200); |
|
} else { |
|
printf("Setup Sectors < 15 - " |
|
"Cannot print kernel version.\n"); |
|
} |
|
} |
|
|
|
/* Determine image type */ |
|
big_image = (bootproto >= 0x0200) && |
|
(hdr->loadflags & BIG_KERNEL_FLAG); |
|
|
|
/* Determine load address */ |
|
if (big_image) |
|
*load_addressp = BZIMAGE_LOAD_ADDR; |
|
else |
|
*load_addressp = ZIMAGE_LOAD_ADDR; |
|
|
|
printf("Building boot_params at 0x%8.8lx\n", (ulong)setup_base); |
|
memset(setup_base, 0, sizeof(*setup_base)); |
|
setup_base->hdr = params->hdr; |
|
|
|
if (bootproto >= 0x0204) |
|
kernel_size = hdr->syssize * 16; |
|
else |
|
kernel_size -= setup_size; |
|
|
|
if (bootproto == 0x0100) { |
|
/* |
|
* A very old kernel MUST have its real-mode code |
|
* loaded at 0x90000 |
|
*/ |
|
if ((ulong)setup_base != 0x90000) { |
|
/* Copy the real-mode kernel */ |
|
memmove((void *)0x90000, setup_base, setup_size); |
|
|
|
/* Copy the command line */ |
|
memmove((void *)0x99000, |
|
(u8 *)setup_base + COMMAND_LINE_OFFSET, |
|
COMMAND_LINE_SIZE); |
|
|
|
/* Relocated */ |
|
setup_base = (struct boot_params *)0x90000; |
|
} |
|
|
|
/* It is recommended to clear memory up to the 32K mark */ |
|
memset((u8 *)0x90000 + setup_size, 0, |
|
SETUP_MAX_SIZE - setup_size); |
|
} |
|
|
|
if (big_image) { |
|
if (kernel_size > BZIMAGE_MAX_SIZE) { |
|
printf("Error: bzImage kernel too big! " |
|
"(size: %ld, max: %d)\n", |
|
kernel_size, BZIMAGE_MAX_SIZE); |
|
return 0; |
|
} |
|
} else if ((kernel_size) > ZIMAGE_MAX_SIZE) { |
|
printf("Error: zImage kernel too big! (size: %ld, max: %d)\n", |
|
kernel_size, ZIMAGE_MAX_SIZE); |
|
return 0; |
|
} |
|
|
|
printf("Loading %s at address %lx (%ld bytes)\n", |
|
big_image ? "bzImage" : "zImage", *load_addressp, kernel_size); |
|
|
|
memmove((void *)*load_addressp, image + setup_size, kernel_size); |
|
|
|
return setup_base; |
|
} |
|
|
|
int setup_zimage(struct boot_params *setup_base, char *cmd_line, int auto_boot, |
|
unsigned long initrd_addr, unsigned long initrd_size) |
|
{ |
|
struct setup_header *hdr = &setup_base->hdr; |
|
int bootproto = get_boot_protocol(hdr); |
|
|
|
setup_base->e820_entries = install_e820_map( |
|
ARRAY_SIZE(setup_base->e820_map), setup_base->e820_map); |
|
|
|
if (bootproto == 0x0100) { |
|
setup_base->screen_info.cl_magic = COMMAND_LINE_MAGIC; |
|
setup_base->screen_info.cl_offset = COMMAND_LINE_OFFSET; |
|
} |
|
if (bootproto >= 0x0200) { |
|
hdr->type_of_loader = 8; |
|
|
|
if (initrd_addr) { |
|
printf("Initial RAM disk at linear address " |
|
"0x%08lx, size %ld bytes\n", |
|
initrd_addr, initrd_size); |
|
|
|
hdr->ramdisk_image = initrd_addr; |
|
hdr->ramdisk_size = initrd_size; |
|
} |
|
} |
|
|
|
if (bootproto >= 0x0201) { |
|
hdr->heap_end_ptr = HEAP_END_OFFSET; |
|
hdr->loadflags |= HEAP_FLAG; |
|
} |
|
|
|
if (cmd_line) { |
|
if (bootproto >= 0x0202) { |
|
hdr->cmd_line_ptr = (uintptr_t)cmd_line; |
|
} else if (bootproto >= 0x0200) { |
|
setup_base->screen_info.cl_magic = COMMAND_LINE_MAGIC; |
|
setup_base->screen_info.cl_offset = |
|
(uintptr_t)cmd_line - (uintptr_t)setup_base; |
|
|
|
hdr->setup_move_size = 0x9100; |
|
} |
|
|
|
/* build command line at COMMAND_LINE_OFFSET */ |
|
build_command_line(cmd_line, auto_boot); |
|
} |
|
|
|
#ifdef CONFIG_INTEL_MID |
|
if (bootproto >= 0x0207) |
|
hdr->hardware_subarch = X86_SUBARCH_INTEL_MID; |
|
#endif |
|
|
|
setup_device_tree(hdr, (const void *)env_get_hex("fdtaddr", 0)); |
|
setup_video(&setup_base->screen_info); |
|
|
|
#ifdef CONFIG_EFI_STUB |
|
setup_efi_info(&setup_base->efi_info); |
|
#endif |
|
|
|
return 0; |
|
} |
|
|
|
void setup_pcat_compatibility(void) |
|
__attribute__((weak, alias("__setup_pcat_compatibility"))); |
|
|
|
void __setup_pcat_compatibility(void) |
|
{ |
|
} |
|
|
|
int do_zboot(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) |
|
{ |
|
struct boot_params *base_ptr; |
|
void *bzImage_addr = NULL; |
|
ulong load_address; |
|
char *s; |
|
ulong bzImage_size = 0; |
|
ulong initrd_addr = 0; |
|
ulong initrd_size = 0; |
|
|
|
disable_interrupts(); |
|
|
|
/* Setup board for maximum PC/AT Compatibility */ |
|
setup_pcat_compatibility(); |
|
|
|
if (argc >= 2) { |
|
/* argv[1] holds the address of the bzImage */ |
|
s = argv[1]; |
|
} else { |
|
s = env_get("fileaddr"); |
|
} |
|
|
|
if (s) |
|
bzImage_addr = (void *)simple_strtoul(s, NULL, 16); |
|
|
|
if (argc >= 3) { |
|
/* argv[2] holds the size of the bzImage */ |
|
bzImage_size = simple_strtoul(argv[2], NULL, 16); |
|
} |
|
|
|
if (argc >= 4) |
|
initrd_addr = simple_strtoul(argv[3], NULL, 16); |
|
if (argc >= 5) |
|
initrd_size = simple_strtoul(argv[4], NULL, 16); |
|
|
|
/* Lets look for */ |
|
base_ptr = load_zimage(bzImage_addr, bzImage_size, &load_address); |
|
|
|
if (!base_ptr) { |
|
puts("## Kernel loading failed ...\n"); |
|
return -1; |
|
} |
|
if (setup_zimage(base_ptr, (char *)base_ptr + COMMAND_LINE_OFFSET, |
|
0, initrd_addr, initrd_size)) { |
|
puts("Setting up boot parameters failed ...\n"); |
|
return -1; |
|
} |
|
|
|
/* we assume that the kernel is in place */ |
|
return boot_linux_kernel((ulong)base_ptr, load_address, false); |
|
} |
|
|
|
U_BOOT_CMD( |
|
zboot, 5, 0, do_zboot, |
|
"Boot bzImage", |
|
"[addr] [size] [initrd addr] [initrd size]\n" |
|
" addr - The optional starting address of the bzimage.\n" |
|
" If not set it defaults to the environment\n" |
|
" variable \"fileaddr\".\n" |
|
" size - The optional size of the bzimage. Defaults to\n" |
|
" zero.\n" |
|
" initrd addr - The address of the initrd image to use, if any.\n" |
|
" initrd size - The size of the initrd image to use, if any.\n" |
|
);
|
|
|