110 lines
2.4 KiB
C
110 lines
2.4 KiB
C
#define DEBUG
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <image.h>
|
|
#include <init.h>
|
|
#include <malloc.h>
|
|
#include <environment.h>
|
|
#include <asm/bitops.h>
|
|
#include <asm/processor.h>
|
|
#include <boot.h>
|
|
#include <errno.h>
|
|
#include <restart.h>
|
|
#include <fs.h>
|
|
|
|
static int bootm_relocate_fdt(void *addr, struct image_data *data)
|
|
{
|
|
if (addr < LINUX_TLB1_MAX_ADDR) {
|
|
/* The kernel is within the boot TLB mapping.
|
|
* Put the DTB above if there is no space
|
|
* below.
|
|
*/
|
|
if (addr < (void *)data->oftree->totalsize) {
|
|
addr = (void *)PAGE_ALIGN((phys_addr_t)addr +
|
|
data->os->header.ih_size);
|
|
addr += data->oftree->totalsize;
|
|
if (addr < LINUX_TLB1_MAX_ADDR)
|
|
addr = LINUX_TLB1_MAX_ADDR;
|
|
}
|
|
}
|
|
|
|
if (addr > LINUX_TLB1_MAX_ADDR) {
|
|
pr_crit("Unable to relocate DTB to Linux TLB\n");
|
|
return 1;
|
|
}
|
|
|
|
addr = (void *)PAGE_ALIGN_DOWN((phys_addr_t)addr -
|
|
data->oftree->totalsize);
|
|
memcpy(addr, data->oftree, data->oftree->totalsize);
|
|
free(data->oftree);
|
|
data->oftree = addr;
|
|
|
|
pr_info("Relocating device tree to 0x%p\n", addr);
|
|
return 0;
|
|
}
|
|
|
|
static int do_bootm_linux(struct image_data *data)
|
|
{
|
|
void (*kernel)(void *, void *, unsigned long,
|
|
unsigned long, unsigned long);
|
|
int ret;
|
|
|
|
ret = bootm_load_os(data, data->os_address);
|
|
if (ret)
|
|
return ret;
|
|
|
|
data->oftree = of_get_fixed_tree(data->of_root_node);
|
|
if (!data->oftree) {
|
|
pr_err("bootm: No devicetree given.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Relocate the device tree if outside the initial
|
|
* Linux mapped TLB.
|
|
*/
|
|
if (IS_ENABLED(CONFIG_MPC85xx)) {
|
|
void *addr = data->oftree;
|
|
|
|
if ((addr + data->oftree->totalsize) > LINUX_TLB1_MAX_ADDR) {
|
|
addr = (void *)data->os_address;
|
|
|
|
if (bootm_relocate_fdt(addr, data))
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
fdt_add_reserve_map(data->oftree);
|
|
|
|
kernel = (void *)(data->os_address + data->os_entry);
|
|
|
|
/*
|
|
* Linux Kernel Parameters (passing device tree):
|
|
* r3: ptr to OF flat tree, followed by the board info data
|
|
* r4: physical pointer to the kernel itself
|
|
* r5: NULL
|
|
* r6: NULL
|
|
* r7: NULL
|
|
*/
|
|
kernel(data->oftree, kernel, 0, 0, 0);
|
|
|
|
restart_machine();
|
|
|
|
error:
|
|
return -1;
|
|
}
|
|
|
|
static struct image_handler handler = {
|
|
.name = "PowerPC Linux",
|
|
.bootm = do_bootm_linux,
|
|
.filetype = filetype_uimage,
|
|
.ih_os = IH_OS_LINUX,
|
|
};
|
|
|
|
static int ppclinux_register_image_handler(void)
|
|
{
|
|
return register_image_handler(&handler);
|
|
}
|
|
|
|
late_initcall(ppclinux_register_image_handler);
|