Using a multi uimage stored in nand didn't work. Only one open for the bb file is allowed. The file type detection after bootm_open_os_uimage will fail. bootm_open_initrd_uimage and bootm_open_oftree_uimage already check if they can reuse data->os. Signed-off-by: Jan Remmet <j.remmet@phytec.de> Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
539 lines
12 KiB
C
539 lines
12 KiB
C
/*
|
|
* This program 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 2 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* This program 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.
|
|
*
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <boot.h>
|
|
#include <fs.h>
|
|
#include <malloc.h>
|
|
#include <memory.h>
|
|
#include <libfile.h>
|
|
#include <globalvar.h>
|
|
#include <init.h>
|
|
|
|
static LIST_HEAD(handler_list);
|
|
|
|
int register_image_handler(struct image_handler *handler)
|
|
{
|
|
list_add_tail(&handler->list, &handler_list);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct image_handler *bootm_find_handler(enum filetype filetype,
|
|
struct image_data *data)
|
|
{
|
|
struct image_handler *handler;
|
|
|
|
list_for_each_entry(handler, &handler_list, list) {
|
|
if (filetype != filetype_uimage &&
|
|
handler->filetype == filetype)
|
|
return handler;
|
|
if (filetype == filetype_uimage &&
|
|
handler->ih_os == data->os->header.ih_os)
|
|
return handler;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/*
|
|
* bootm_load_os() - load OS to RAM
|
|
*
|
|
* @data: image data context
|
|
* @load_address: The address where the OS should be loaded to
|
|
*
|
|
* This loads the OS to a RAM location. load_address must be a valid
|
|
* address. If the image_data doesn't have a OS specified it's considered
|
|
* an error.
|
|
*
|
|
* Return: 0 on success, negative error code otherwise
|
|
*/
|
|
int bootm_load_os(struct image_data *data, unsigned long load_address)
|
|
{
|
|
if (data->os_res)
|
|
return 0;
|
|
|
|
if (load_address == UIMAGE_INVALID_ADDRESS)
|
|
return -EINVAL;
|
|
|
|
if (data->os) {
|
|
data->os_res = uimage_load_to_sdram(data->os,
|
|
data->os_num, load_address);
|
|
if (!data->os_res)
|
|
return -ENOMEM;
|
|
|
|
return 0;
|
|
}
|
|
|
|
if (data->os_file) {
|
|
data->os_res = file_to_sdram(data->os_file, load_address);
|
|
if (!data->os_res)
|
|
return -ENOMEM;
|
|
|
|
return 0;
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* bootm_load_initrd() - load initrd to RAM
|
|
*
|
|
* @data: image data context
|
|
* @load_address: The address where the initrd should be loaded to
|
|
*
|
|
* This loads the initrd to a RAM location. load_address must be a valid
|
|
* address. If the image_data doesn't have a initrd specified this function
|
|
* still returns successful as an initrd is optional. Check data->initrd_res
|
|
* to see if an initrd has been loaded.
|
|
*
|
|
* Return: 0 on success, negative error code otherwise
|
|
*/
|
|
int bootm_load_initrd(struct image_data *data, unsigned long load_address)
|
|
{
|
|
if (data->initrd_res)
|
|
return 0;
|
|
|
|
if (data->initrd) {
|
|
data->initrd_res = uimage_load_to_sdram(data->initrd,
|
|
data->initrd_num, load_address);
|
|
if (!data->initrd_res)
|
|
return -ENOMEM;
|
|
|
|
return 0;
|
|
}
|
|
|
|
if (data->initrd_file) {
|
|
data->initrd_res = file_to_sdram(data->initrd_file, load_address);
|
|
if (!data->initrd_res)
|
|
return -ENOMEM;
|
|
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* bootm_load_devicetree() - load devicetree
|
|
*
|
|
* @data: image data context
|
|
* @load_address: The address where the devicetree should be loaded to
|
|
*
|
|
* This loads the devicetree to a RAM location. load_address must be a valid
|
|
* address. The resulting devicetree will be found at data->oftree.
|
|
*
|
|
* Return: 0 on success, negative error code otherwise
|
|
*/
|
|
int bootm_load_devicetree(struct image_data *data, unsigned long load_address)
|
|
{
|
|
int fdt_size;
|
|
struct fdt_header *oftree;
|
|
|
|
if (data->oftree)
|
|
return 0;
|
|
|
|
if (!IS_ENABLED(CONFIG_OFTREE))
|
|
return 0;
|
|
|
|
if (!data->of_root_node)
|
|
return 0;
|
|
|
|
if (data->initrd_res) {
|
|
of_add_initrd(data->of_root_node, data->initrd_res->start,
|
|
data->initrd_res->end);
|
|
of_add_reserve_entry(data->initrd_res->start, data->initrd_res->end);
|
|
}
|
|
|
|
oftree = of_get_fixed_tree(data->of_root_node);
|
|
if (!oftree)
|
|
return -EINVAL;
|
|
|
|
fdt_size = be32_to_cpu(oftree->totalsize);
|
|
|
|
data->oftree_res = request_sdram_region("oftree", load_address,
|
|
fdt_size);
|
|
if (!data->oftree_res) {
|
|
free(oftree);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
memcpy((void *)data->oftree_res->start, oftree, fdt_size);
|
|
|
|
free(oftree);
|
|
|
|
oftree = (void *)data->oftree_res->start;
|
|
|
|
fdt_add_reserve_map(oftree);
|
|
|
|
of_print_cmdline(data->of_root_node);
|
|
if (bootm_verbose(data) > 1)
|
|
of_print_nodes(data->of_root_node, 0);
|
|
|
|
data->oftree = oftree;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bootm_open_os_uimage(struct image_data *data)
|
|
{
|
|
int ret;
|
|
|
|
data->os = uimage_open(data->os_file);
|
|
if (!data->os)
|
|
return -EINVAL;
|
|
|
|
if (data->verify) {
|
|
ret = uimage_verify(data->os);
|
|
if (ret) {
|
|
printf("Checking data crc failed with %s\n",
|
|
strerror(-ret));
|
|
uimage_close(data->os);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
uimage_print_contents(data->os);
|
|
|
|
if (data->os->header.ih_arch != IH_ARCH) {
|
|
printf("Unsupported Architecture 0x%x\n",
|
|
data->os->header.ih_arch);
|
|
uimage_close(data->os);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (data->os_address == UIMAGE_SOME_ADDRESS)
|
|
data->os_address = data->os->header.ih_load;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bootm_open_initrd_uimage(struct image_data *data)
|
|
{
|
|
int ret;
|
|
|
|
if (!data->initrd_file)
|
|
return 0;
|
|
|
|
if (strcmp(data->os_file, data->initrd_file)) {
|
|
data->initrd = uimage_open(data->initrd_file);
|
|
if (!data->initrd)
|
|
return -EINVAL;
|
|
|
|
if (data->verify) {
|
|
ret = uimage_verify(data->initrd);
|
|
if (ret) {
|
|
printf("Checking data crc failed with %s\n",
|
|
strerror(-ret));
|
|
}
|
|
}
|
|
uimage_print_contents(data->initrd);
|
|
} else {
|
|
data->initrd = data->os;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bootm_open_oftree_uimage(struct image_data *data)
|
|
{
|
|
struct fdt_header *fdt;
|
|
enum filetype ft;
|
|
const char *oftree = data->oftree_file;
|
|
int num = data->oftree_num;
|
|
struct uimage_handle *of_handle;
|
|
int release = 0;
|
|
size_t size;
|
|
|
|
printf("Loading devicetree from '%s'@%d\n", oftree, num);
|
|
|
|
if (IS_ENABLED(CONFIG_CMD_BOOTM_OFTREE_UIMAGE)) {
|
|
if (!strcmp(data->os_file, oftree)) {
|
|
of_handle = data->os;
|
|
} else if (!strcmp(data->initrd_file, oftree)) {
|
|
of_handle = data->initrd;
|
|
} else {
|
|
of_handle = uimage_open(oftree);
|
|
if (!of_handle)
|
|
return -ENODEV;
|
|
uimage_print_contents(of_handle);
|
|
release = 1;
|
|
}
|
|
|
|
fdt = uimage_load_to_buf(of_handle, num, &size);
|
|
|
|
if (release)
|
|
uimage_close(of_handle);
|
|
|
|
ft = file_detect_type(fdt, size);
|
|
if (ft != filetype_oftree) {
|
|
printf("%s is not an oftree but %s\n",
|
|
data->oftree_file, file_type_to_string(ft));
|
|
return -EINVAL;
|
|
}
|
|
|
|
data->of_root_node = of_unflatten_dtb(fdt);
|
|
if (!data->of_root_node) {
|
|
pr_err("unable to unflatten devicetree\n");
|
|
free(fdt);
|
|
return -EINVAL;
|
|
}
|
|
|
|
free(fdt);
|
|
|
|
return 0;
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static int bootm_open_oftree(struct image_data *data)
|
|
{
|
|
struct fdt_header *fdt;
|
|
const char *oftree = data->oftree_file;
|
|
size_t size;
|
|
|
|
printf("Loading devicetree from '%s'\n", oftree);
|
|
|
|
fdt = read_file(oftree, &size);
|
|
if (!fdt) {
|
|
perror("open");
|
|
return -ENODEV;
|
|
}
|
|
|
|
data->of_root_node = of_unflatten_dtb(fdt);
|
|
if (!data->of_root_node) {
|
|
pr_err("unable to unflatten devicetree\n");
|
|
free(fdt);
|
|
return -EINVAL;
|
|
}
|
|
|
|
free(fdt);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void bootm_print_info(struct image_data *data)
|
|
{
|
|
if (data->os_res)
|
|
printf("OS image is at " PRINTF_CONVERSION_RESOURCE "-" PRINTF_CONVERSION_RESOURCE "\n",
|
|
data->os_res->start,
|
|
data->os_res->end);
|
|
else
|
|
printf("OS image not yet relocated\n");
|
|
|
|
if (data->initrd_file) {
|
|
enum filetype initrd_type = file_name_detect_type(data->initrd_file);
|
|
|
|
printf("Loading initrd %s '%s'",
|
|
file_type_to_string(initrd_type),
|
|
data->initrd_file);
|
|
if (initrd_type == filetype_uimage &&
|
|
data->initrd->header.ih_type == IH_TYPE_MULTI)
|
|
printf(", multifile image %d", data->initrd_num);
|
|
printf("\n");
|
|
if (data->initrd_res)
|
|
printf("initrd is at " PRINTF_CONVERSION_RESOURCE "-" PRINTF_CONVERSION_RESOURCE "\n",
|
|
data->initrd_res->start,
|
|
data->initrd_res->end);
|
|
else
|
|
printf("initrd image not yet relocated\n");
|
|
}
|
|
}
|
|
|
|
static char *bootm_image_name_and_no(const char *name, int *no)
|
|
{
|
|
char *at, *ret;
|
|
|
|
if (!name || !*name)
|
|
return NULL;
|
|
|
|
*no = 0;
|
|
|
|
ret = xstrdup(name);
|
|
at = strchr(ret, '@');
|
|
if (!at)
|
|
return ret;
|
|
|
|
*at++ = 0;
|
|
|
|
*no = simple_strtoul(at, NULL, 10);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* bootm_boot - Boot an application image described by bootm_data
|
|
*/
|
|
int bootm_boot(struct bootm_data *bootm_data)
|
|
{
|
|
struct image_data *data;
|
|
struct image_handler *handler;
|
|
int ret;
|
|
enum filetype os_type, initrd_type = filetype_unknown;
|
|
enum filetype oftree_type = filetype_unknown;
|
|
|
|
if (!bootm_data->os_file) {
|
|
printf("no image given\n");
|
|
return -ENOENT;
|
|
}
|
|
|
|
data = xzalloc(sizeof(*data));
|
|
|
|
data->os_file = bootm_image_name_and_no(bootm_data->os_file, &data->os_num);
|
|
data->oftree_file = bootm_image_name_and_no(bootm_data->oftree_file, &data->oftree_num);
|
|
data->initrd_file = bootm_image_name_and_no(bootm_data->initrd_file, &data->initrd_num);
|
|
data->verbose = bootm_data->verbose;
|
|
data->verify = bootm_data->verify;
|
|
data->force = bootm_data->force;
|
|
data->dryrun = bootm_data->dryrun;
|
|
data->initrd_address = bootm_data->initrd_address;
|
|
data->os_address = bootm_data->os_address;
|
|
data->os_entry = bootm_data->os_entry;
|
|
|
|
os_type = file_name_detect_type(data->os_file);
|
|
if ((int)os_type < 0) {
|
|
printf("could not open %s: %s\n", data->os_file,
|
|
strerror(-os_type));
|
|
ret = (int)os_type;
|
|
goto err_out;
|
|
}
|
|
|
|
if (!data->force && os_type == filetype_unknown) {
|
|
printf("Unknown OS filetype (try -f)\n");
|
|
ret = -EINVAL;
|
|
goto err_out;
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_CMD_BOOTM_INITRD) && data->initrd_file) {
|
|
initrd_type = file_name_detect_type(data->initrd_file);
|
|
|
|
if ((int)initrd_type < 0) {
|
|
printf("could not open %s: %s\n", data->initrd_file,
|
|
strerror(-initrd_type));
|
|
ret = (int)initrd_type;
|
|
goto err_out;
|
|
}
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_OFTREE) && data->oftree_file) {
|
|
oftree_type = file_name_detect_type(data->oftree_file);
|
|
|
|
if ((int)oftree_type < 0) {
|
|
printf("could not open %s: %s\n", data->oftree_file,
|
|
strerror(-oftree_type));
|
|
ret = (int) oftree_type;
|
|
goto err_out;
|
|
}
|
|
}
|
|
|
|
if (os_type == filetype_uimage) {
|
|
ret = bootm_open_os_uimage(data);
|
|
if (ret) {
|
|
printf("Loading OS image failed with %s\n",
|
|
strerror(-ret));
|
|
goto err_out;
|
|
}
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_CMD_BOOTM_INITRD) && data->initrd_file) {
|
|
if (initrd_type == filetype_uimage) {
|
|
ret = bootm_open_initrd_uimage(data);
|
|
if (ret) {
|
|
printf("loading initrd failed with %s\n",
|
|
strerror(-ret));
|
|
goto err_out;
|
|
}
|
|
}
|
|
}
|
|
|
|
printf("\nLoading %s '%s'", file_type_to_string(os_type),
|
|
data->os_file);
|
|
if (os_type == filetype_uimage &&
|
|
data->os->header.ih_type == IH_TYPE_MULTI)
|
|
printf(", multifile image %d", data->os_num);
|
|
printf("\n");
|
|
|
|
if (IS_ENABLED(CONFIG_OFTREE)) {
|
|
if (data->oftree_file) {
|
|
if (oftree_type == filetype_uimage)
|
|
ret = bootm_open_oftree_uimage(data);
|
|
if (oftree_type == filetype_oftree)
|
|
ret = bootm_open_oftree(data);
|
|
if (ret)
|
|
goto err_out;
|
|
} else {
|
|
data->of_root_node = of_get_root_node();
|
|
if (bootm_verbose(data) > 1 && data->of_root_node)
|
|
printf("using internal devicetree\n");
|
|
}
|
|
}
|
|
|
|
if (data->os_address == UIMAGE_SOME_ADDRESS)
|
|
data->os_address = UIMAGE_INVALID_ADDRESS;
|
|
|
|
handler = bootm_find_handler(os_type, data);
|
|
if (!handler) {
|
|
printf("no image handler found for image type %s\n",
|
|
file_type_to_string(os_type));
|
|
if (os_type == filetype_uimage)
|
|
printf("and OS type: %d\n", data->os->header.ih_os);
|
|
ret = -ENODEV;
|
|
goto err_out;
|
|
}
|
|
|
|
if (bootm_verbose(data)) {
|
|
bootm_print_info(data);
|
|
printf("Passing control to %s handler\n", handler->name);
|
|
}
|
|
|
|
if (data->dryrun)
|
|
ret = 0;
|
|
else
|
|
ret = handler->bootm(data);
|
|
err_out:
|
|
if (data->os_res)
|
|
release_sdram_region(data->os_res);
|
|
if (data->initrd_res)
|
|
release_sdram_region(data->initrd_res);
|
|
if (data->oftree_res)
|
|
release_sdram_region(data->oftree_res);
|
|
if (data->initrd && data->initrd != data->os)
|
|
uimage_close(data->initrd);
|
|
if (data->os)
|
|
uimage_close(data->os);
|
|
if (data->of_root_node && data->of_root_node != of_get_root_node())
|
|
of_delete_node(data->of_root_node);
|
|
|
|
free(data->os_file);
|
|
free(data->oftree_file);
|
|
free(data->initrd_file);
|
|
free(data);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int bootm_init(void)
|
|
{
|
|
globalvar_add_simple("bootm.image", NULL);
|
|
globalvar_add_simple("bootm.image.loadaddr", NULL);
|
|
globalvar_add_simple("bootm.oftree", NULL);
|
|
if (IS_ENABLED(CONFIG_CMD_BOOTM_INITRD)) {
|
|
globalvar_add_simple("bootm.initrd", NULL);
|
|
globalvar_add_simple("bootm.initrd.loadaddr", NULL);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
late_initcall(bootm_init);
|