530 lines
14 KiB
C
530 lines
14 KiB
C
/* linux.c - boot Linux */
|
|
/*
|
|
* VasEBoot -- GRand Unified Bootloader
|
|
* Copyright (C) 2013 Free Software Foundation, Inc.
|
|
*
|
|
* VasEBoot 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.
|
|
*
|
|
* VasEBoot 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 VasEBoot. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <VasEBoot/dl.h>
|
|
#include <VasEBoot/fdt.h>
|
|
#include <VasEBoot/file.h>
|
|
#include <VasEBoot/loader.h>
|
|
#include <VasEBoot/mm.h>
|
|
#include <VasEBoot/misc.h>
|
|
#include <VasEBoot/command.h>
|
|
#include <VasEBoot/cache.h>
|
|
#include <VasEBoot/cpu/linux.h>
|
|
#include <VasEBoot/lib/cmdline.h>
|
|
#include <VasEBoot/linux.h>
|
|
|
|
VasEBoot_MOD_LICENSE ("GPLv3+");
|
|
|
|
static VasEBoot_dl_t my_mod;
|
|
|
|
static VasEBoot_addr_t initrd_start;
|
|
static VasEBoot_addr_t initrd_end;
|
|
|
|
static VasEBoot_addr_t linux_addr;
|
|
static VasEBoot_size_t linux_size;
|
|
|
|
static char *linux_args;
|
|
|
|
static VasEBoot_uint32_t machine_type;
|
|
static void *fdt_addr;
|
|
|
|
typedef void (*kernel_entry_t) (int, unsigned long, void *);
|
|
|
|
#define LINUX_ZIMAGE_OFFSET 0x24
|
|
#define LINUX_ZIMAGE_MAGIC 0x016f2818
|
|
|
|
#define LINUX_PHYS_OFFSET (0x00008000)
|
|
#define LINUX_INITRD_PHYS_OFFSET (LINUX_PHYS_OFFSET + 0x02000000)
|
|
#define LINUX_FDT_PHYS_OFFSET (LINUX_INITRD_PHYS_OFFSET - 0x10000)
|
|
|
|
static VasEBoot_size_t
|
|
get_atag_size (VasEBoot_uint32_t *atag)
|
|
{
|
|
VasEBoot_uint32_t *atag0 = atag;
|
|
while (atag[0] && atag[1])
|
|
atag += atag[0];
|
|
return atag - atag0;
|
|
}
|
|
|
|
/*
|
|
* linux_prepare_fdt():
|
|
* Prepares a loaded FDT for being passed to Linux.
|
|
* Merges in command line parameters and sets up initrd addresses.
|
|
*/
|
|
static VasEBoot_err_t
|
|
linux_prepare_atag (void)
|
|
{
|
|
VasEBoot_uint32_t *atag_orig = (VasEBoot_uint32_t *) fdt_addr;
|
|
VasEBoot_uint32_t *tmp_atag, *from, *to;
|
|
VasEBoot_size_t tmp_size;
|
|
VasEBoot_size_t arg_size = VasEBoot_strlen (linux_args);
|
|
char *cmdline_orig = NULL;
|
|
VasEBoot_size_t cmdline_orig_len = 0;
|
|
|
|
/* some place for cmdline, initrd and terminator. */
|
|
tmp_size = get_atag_size (atag_orig) + 20 + (arg_size) / 4;
|
|
tmp_atag = VasEBoot_malloc (tmp_size * sizeof (VasEBoot_uint32_t));
|
|
if (!tmp_atag)
|
|
return VasEBoot_errno;
|
|
|
|
for (from = atag_orig, to = tmp_atag; from[0] && from[1];
|
|
from += from[0])
|
|
switch (from[1])
|
|
{
|
|
case 0x54410004:
|
|
case 0x54410005:
|
|
case 0x54420005:
|
|
break;
|
|
case 0x54410009:
|
|
if (*(char *) (from + 2))
|
|
{
|
|
cmdline_orig = (char *) (from + 2);
|
|
cmdline_orig_len = VasEBoot_strlen (cmdline_orig) + 1;
|
|
}
|
|
break;
|
|
default:
|
|
VasEBoot_memcpy (to, from, sizeof (VasEBoot_uint32_t) * from[0]);
|
|
to += from[0];
|
|
break;
|
|
}
|
|
|
|
VasEBoot_dprintf ("linux", "linux inherited args: '%s'\n",
|
|
cmdline_orig ? : "");
|
|
VasEBoot_dprintf ("linux", "linux_args: '%s'\n", linux_args);
|
|
|
|
/* Generate and set command line */
|
|
to[0] = 3 + (arg_size + cmdline_orig_len) / 4;
|
|
to[1] = 0x54410009;
|
|
if (cmdline_orig)
|
|
{
|
|
VasEBoot_memcpy ((char *) to + 8, cmdline_orig, cmdline_orig_len - 1);
|
|
*((char *) to + 8 + cmdline_orig_len - 1) = ' ';
|
|
}
|
|
VasEBoot_memcpy ((char *) to + 8 + cmdline_orig_len, linux_args, arg_size);
|
|
VasEBoot_memset ((char *) to + 8 + cmdline_orig_len + arg_size, 0,
|
|
4 - ((arg_size + cmdline_orig_len) & 3));
|
|
to += to[0];
|
|
|
|
if (initrd_start && initrd_end)
|
|
{
|
|
/*
|
|
* We're using physical addresses, so even if we have LPAE, we're
|
|
* restricted to a 32-bit address space.
|
|
*/
|
|
VasEBoot_dprintf ("loader", "Initrd @ 0x%08x-0x%08x\n",
|
|
initrd_start, initrd_end);
|
|
|
|
to[0] = 4;
|
|
to[1] = 0x54420005;
|
|
to[2] = initrd_start;
|
|
to[3] = initrd_end - initrd_start;
|
|
to += 4;
|
|
}
|
|
|
|
to[0] = 0;
|
|
to[1] = 0;
|
|
to += 2;
|
|
|
|
/* Copy updated FDT to its launch location */
|
|
VasEBoot_memcpy (atag_orig, tmp_atag, sizeof (VasEBoot_uint32_t) * (to - tmp_atag));
|
|
VasEBoot_free (tmp_atag);
|
|
|
|
VasEBoot_dprintf ("loader", "ATAG updated for Linux boot\n");
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
/*
|
|
* linux_prepare_fdt():
|
|
* Prepares a loaded FDT for being passed to Linux.
|
|
* Merges in command line parameters and sets up initrd addresses.
|
|
*/
|
|
static VasEBoot_err_t
|
|
linux_prepare_fdt (void)
|
|
{
|
|
int node;
|
|
int retval;
|
|
int tmp_size;
|
|
void *tmp_fdt;
|
|
|
|
tmp_size = VasEBoot_fdt_get_totalsize (fdt_addr) + 0x100 + VasEBoot_strlen (linux_args);
|
|
tmp_fdt = VasEBoot_malloc (tmp_size);
|
|
if (!tmp_fdt)
|
|
return VasEBoot_errno;
|
|
|
|
VasEBoot_memcpy (tmp_fdt, fdt_addr, VasEBoot_fdt_get_totalsize (fdt_addr));
|
|
VasEBoot_fdt_set_totalsize (tmp_fdt, tmp_size);
|
|
|
|
/* Find or create '/chosen' node */
|
|
node = VasEBoot_fdt_find_subnode (tmp_fdt, 0, "chosen");
|
|
if (node < 0)
|
|
{
|
|
VasEBoot_dprintf ("linux", "No 'chosen' node in FDT - creating.\n");
|
|
node = VasEBoot_fdt_add_subnode (tmp_fdt, 0, "chosen");
|
|
if (node < 0)
|
|
goto failure;
|
|
}
|
|
|
|
VasEBoot_dprintf ("linux", "linux_args: '%s'\n", linux_args);
|
|
|
|
/* Generate and set command line */
|
|
retval = VasEBoot_fdt_set_prop (tmp_fdt, node, "bootargs", linux_args,
|
|
VasEBoot_strlen (linux_args) + 1);
|
|
if (retval)
|
|
goto failure;
|
|
|
|
if (initrd_start && initrd_end)
|
|
{
|
|
/*
|
|
* We're using physical addresses, so even if we have LPAE, we're
|
|
* restricted to a 32-bit address space.
|
|
*/
|
|
VasEBoot_dprintf ("loader", "Initrd @ 0x%08x-0x%08x\n",
|
|
initrd_start, initrd_end);
|
|
|
|
retval = VasEBoot_fdt_set_prop32 (tmp_fdt, node, "linux,initrd-start",
|
|
initrd_start);
|
|
if (retval)
|
|
goto failure;
|
|
retval = VasEBoot_fdt_set_prop32 (tmp_fdt, node, "linux,initrd-end",
|
|
initrd_end);
|
|
if (retval)
|
|
goto failure;
|
|
}
|
|
|
|
/* Copy updated FDT to its launch location */
|
|
VasEBoot_memcpy (fdt_addr, tmp_fdt, tmp_size);
|
|
VasEBoot_free (tmp_fdt);
|
|
|
|
VasEBoot_dprintf ("loader", "FDT updated for Linux boot\n");
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
|
|
failure:
|
|
VasEBoot_free (tmp_fdt);
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, "unable to prepare FDT");
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
linux_boot (void)
|
|
{
|
|
kernel_entry_t linuxmain;
|
|
int fdt_valid, atag_valid;
|
|
|
|
fdt_valid = (fdt_addr && VasEBoot_fdt_check_header_nosize (fdt_addr) == 0);
|
|
atag_valid = ((((VasEBoot_uint16_t *) fdt_addr)[3] & ~3) == 0x5440
|
|
&& *((VasEBoot_uint32_t *) fdt_addr));
|
|
VasEBoot_dprintf ("loader", "atag: %p, %x, %x, %s, %s\n",
|
|
fdt_addr,
|
|
((VasEBoot_uint16_t *) fdt_addr)[3],
|
|
*((VasEBoot_uint32_t *) fdt_addr),
|
|
(char *) fdt_addr,
|
|
(char *) fdt_addr + 1);
|
|
|
|
if (!fdt_valid && machine_type == VasEBoot_ARM_MACHINE_TYPE_FDT)
|
|
return VasEBoot_error (VasEBoot_ERR_FILE_NOT_FOUND,
|
|
N_("device tree must be supplied (see `devicetree' command)"));
|
|
|
|
VasEBoot_arch_sync_caches ((void *) linux_addr, linux_size);
|
|
|
|
VasEBoot_dprintf ("loader", "Kernel at: 0x%x\n", linux_addr);
|
|
|
|
if (fdt_valid)
|
|
{
|
|
VasEBoot_err_t err;
|
|
|
|
err = linux_prepare_fdt ();
|
|
if (err)
|
|
return err;
|
|
VasEBoot_dprintf ("loader", "FDT @ 0x%p\n", fdt_addr);
|
|
}
|
|
else if (atag_valid)
|
|
{
|
|
VasEBoot_err_t err;
|
|
|
|
err = linux_prepare_atag ();
|
|
if (err)
|
|
return err;
|
|
VasEBoot_dprintf ("loader", "ATAG @ 0x%p\n", fdt_addr);
|
|
}
|
|
|
|
VasEBoot_dprintf ("loader", "Jumping to Linux...\n");
|
|
|
|
/* Boot the kernel.
|
|
* Arguments to kernel:
|
|
* r0 - 0
|
|
* r1 - machine type
|
|
* r2 - address of DTB
|
|
*/
|
|
linuxmain = (kernel_entry_t) linux_addr;
|
|
|
|
#ifdef VasEBoot_MACHINE_EFI
|
|
{
|
|
VasEBoot_err_t err;
|
|
err = VasEBoot_efi_prepare_platform();
|
|
if (err != VasEBoot_ERR_NONE)
|
|
return err;
|
|
}
|
|
#endif
|
|
|
|
VasEBoot_arm_disable_caches_mmu ();
|
|
|
|
linuxmain (0, machine_type, fdt_addr);
|
|
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_OS, "Linux call returned");
|
|
}
|
|
|
|
/*
|
|
* Only support zImage, so no relocations necessary
|
|
*/
|
|
static VasEBoot_err_t
|
|
linux_load (const char *filename, VasEBoot_file_t file)
|
|
{
|
|
int size;
|
|
|
|
size = VasEBoot_file_size (file);
|
|
|
|
#ifdef VasEBoot_MACHINE_EFI
|
|
linux_addr = (VasEBoot_addr_t) VasEBoot_efi_allocate_loader_memory (LINUX_PHYS_OFFSET, size);
|
|
if (!linux_addr)
|
|
return VasEBoot_errno;
|
|
#else
|
|
linux_addr = LINUX_ADDRESS;
|
|
#endif
|
|
VasEBoot_dprintf ("loader", "Loading Linux to 0x%08x\n",
|
|
(VasEBoot_addr_t) linux_addr);
|
|
|
|
if (VasEBoot_file_read (file, (void *) linux_addr, size) != size)
|
|
{
|
|
if (!VasEBoot_errno)
|
|
VasEBoot_error (VasEBoot_ERR_BAD_OS, N_("premature end of file %s"),
|
|
filename);
|
|
return VasEBoot_errno;
|
|
}
|
|
|
|
if (size > LINUX_ZIMAGE_OFFSET + 4
|
|
&& *(VasEBoot_uint32_t *) (linux_addr + LINUX_ZIMAGE_OFFSET)
|
|
== LINUX_ZIMAGE_MAGIC)
|
|
;
|
|
else if (size > 0x8000 && *(VasEBoot_uint32_t *) (linux_addr) == 0xea000006
|
|
&& machine_type == VasEBoot_ARM_MACHINE_TYPE_RASPBERRY_PI)
|
|
VasEBoot_memmove ((void *) linux_addr, (void *) (linux_addr + 0x8000),
|
|
size - 0x8000);
|
|
else
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_FILE_TYPE, N_("invalid zImage"));
|
|
|
|
linux_size = size;
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
linux_unload (void)
|
|
{
|
|
VasEBoot_dl_unref (my_mod);
|
|
|
|
VasEBoot_free (linux_args);
|
|
linux_args = NULL;
|
|
|
|
initrd_start = initrd_end = 0;
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_cmd_linux (VasEBoot_command_t cmd __attribute__ ((unused)),
|
|
int argc, char *argv[])
|
|
{
|
|
int size;
|
|
VasEBoot_err_t err;
|
|
VasEBoot_file_t file;
|
|
VasEBoot_dl_ref (my_mod);
|
|
|
|
if (argc == 0)
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, N_("filename expected"));
|
|
|
|
file = VasEBoot_file_open (argv[0]);
|
|
if (!file)
|
|
goto fail;
|
|
|
|
err = linux_load (argv[0], file);
|
|
VasEBoot_file_close (file);
|
|
if (err)
|
|
goto fail;
|
|
|
|
VasEBoot_loader_set (linux_boot, linux_unload, 0);
|
|
|
|
size = VasEBoot_loader_cmdline_size (argc, argv);
|
|
linux_args = VasEBoot_malloc (size + sizeof (LINUX_IMAGE));
|
|
if (!linux_args)
|
|
{
|
|
VasEBoot_loader_unset();
|
|
goto fail;
|
|
}
|
|
|
|
/* Create kernel command line. */
|
|
VasEBoot_memcpy (linux_args, LINUX_IMAGE, sizeof (LINUX_IMAGE));
|
|
VasEBoot_create_loader_cmdline (argc, argv,
|
|
linux_args + sizeof (LINUX_IMAGE) - 1, size);
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
|
|
fail:
|
|
VasEBoot_dl_unref (my_mod);
|
|
return VasEBoot_errno;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_cmd_initrd (VasEBoot_command_t cmd __attribute__ ((unused)),
|
|
int argc, char *argv[])
|
|
{
|
|
VasEBoot_file_t file;
|
|
VasEBoot_size_t size = 0;
|
|
struct VasEBoot_linux_initrd_context initrd_ctx = { 0, 0, 0 };
|
|
|
|
if (argc == 0)
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, N_("filename expected"));
|
|
|
|
file = VasEBoot_file_open (argv[0]);
|
|
if (!file)
|
|
return VasEBoot_errno;
|
|
|
|
if (VasEBoot_initrd_init (argc, argv, &initrd_ctx))
|
|
goto fail;
|
|
|
|
size = VasEBoot_get_initrd_size (&initrd_ctx);
|
|
|
|
#ifdef VasEBoot_MACHINE_EFI
|
|
if (initrd_start)
|
|
VasEBoot_efi_free_pages (initrd_start,
|
|
(initrd_end - initrd_start + 0xfff) >> 12);
|
|
initrd_start = (VasEBoot_addr_t) VasEBoot_efi_allocate_loader_memory (LINUX_INITRD_PHYS_OFFSET, size);
|
|
|
|
if (!initrd_start)
|
|
{
|
|
VasEBoot_error (VasEBoot_ERR_OUT_OF_MEMORY, N_("out of memory"));
|
|
goto fail;
|
|
}
|
|
#else
|
|
initrd_start = LINUX_INITRD_ADDRESS;
|
|
#endif
|
|
|
|
VasEBoot_dprintf ("loader", "Loading initrd to 0x%08x\n",
|
|
(VasEBoot_addr_t) initrd_start);
|
|
|
|
if (VasEBoot_initrd_load (&initrd_ctx, argv, (void *) initrd_start))
|
|
goto fail;
|
|
|
|
initrd_end = initrd_start + size;
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
|
|
fail:
|
|
VasEBoot_file_close (file);
|
|
|
|
return VasEBoot_errno;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
load_dtb (VasEBoot_file_t dtb, int size)
|
|
{
|
|
if ((VasEBoot_file_read (dtb, fdt_addr, size) != size)
|
|
|| (VasEBoot_fdt_check_header (fdt_addr, size) != 0))
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_OS, N_("invalid device tree"));
|
|
|
|
VasEBoot_fdt_set_totalsize (fdt_addr, size);
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_cmd_devicetree (VasEBoot_command_t cmd __attribute__ ((unused)),
|
|
int argc, char *argv[])
|
|
{
|
|
VasEBoot_file_t dtb;
|
|
int size;
|
|
|
|
if (argc != 1)
|
|
return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, N_("filename expected"));
|
|
|
|
dtb = VasEBoot_file_open (argv[0]);
|
|
if (!dtb)
|
|
goto out;
|
|
|
|
size = VasEBoot_file_size (dtb);
|
|
if (size == 0)
|
|
{
|
|
VasEBoot_error (VasEBoot_ERR_BAD_OS, "empty file");
|
|
goto out;
|
|
}
|
|
|
|
#ifdef VasEBoot_MACHINE_EFI
|
|
fdt_addr = VasEBoot_efi_allocate_loader_memory (LINUX_FDT_PHYS_OFFSET, size);
|
|
if (!fdt_addr)
|
|
{
|
|
VasEBoot_error (VasEBoot_ERR_OUT_OF_MEMORY, N_("out of memory"));
|
|
goto out;
|
|
}
|
|
#else
|
|
fdt_addr = (void *) LINUX_FDT_ADDRESS;
|
|
#endif
|
|
|
|
VasEBoot_dprintf ("loader", "Loading device tree to 0x%08x\n",
|
|
(VasEBoot_addr_t) fdt_addr);
|
|
load_dtb (dtb, size);
|
|
if (VasEBoot_errno != VasEBoot_ERR_NONE)
|
|
{
|
|
fdt_addr = NULL;
|
|
goto out;
|
|
}
|
|
|
|
/*
|
|
* We've successfully loaded an FDT, so any machine type passed
|
|
* from firmware is now obsolete.
|
|
*/
|
|
machine_type = VasEBoot_ARM_MACHINE_TYPE_FDT;
|
|
|
|
out:
|
|
VasEBoot_file_close (dtb);
|
|
|
|
return VasEBoot_errno;
|
|
}
|
|
|
|
static VasEBoot_command_t cmd_linux, cmd_initrd, cmd_devicetree;
|
|
|
|
VasEBoot_MOD_INIT (linux)
|
|
{
|
|
cmd_linux = VasEBoot_register_command ("linux", VasEBoot_cmd_linux,
|
|
0, N_("Load Linux."));
|
|
cmd_initrd = VasEBoot_register_command ("initrd", VasEBoot_cmd_initrd,
|
|
0, N_("Load initrd."));
|
|
cmd_devicetree = VasEBoot_register_command ("devicetree", VasEBoot_cmd_devicetree,
|
|
/* TRANSLATORS: DTB stands for device tree blob. */
|
|
0, N_("Load DTB file."));
|
|
my_mod = mod;
|
|
fdt_addr = (void *) VasEBoot_arm_firmware_get_boot_data ();
|
|
machine_type = VasEBoot_arm_firmware_get_machine_type ();
|
|
}
|
|
|
|
VasEBoot_MOD_FINI (linux)
|
|
{
|
|
VasEBoot_unregister_command (cmd_linux);
|
|
VasEBoot_unregister_command (cmd_initrd);
|
|
VasEBoot_unregister_command (cmd_devicetree);
|
|
}
|