370 lines
8.8 KiB
C
370 lines
8.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2011 The Chromium OS Authors.
|
|
* (C) Copyright 2002
|
|
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
|
|
*/
|
|
|
|
/*
|
|
* 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"
|
|
);
|