ppc: switch to libfdt based oftree implementation
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
parent
07fc87d530
commit
609c4a988c
|
@ -16,230 +16,14 @@
|
||||||
#endif
|
#endif
|
||||||
extern bd_t *bd;
|
extern bd_t *bd;
|
||||||
|
|
||||||
static int do_bootm_linux(struct image_data *idata)
|
static int do_bootm_linux(struct image_data *data)
|
||||||
{
|
{
|
||||||
ulong sp;
|
void (*kernel)(void *, void *, unsigned long,
|
||||||
ulong initrd_end = 0;
|
unsigned long, unsigned long);
|
||||||
ulong cmd_start, cmd_end;
|
struct image_header *os_header = &data->os->header;
|
||||||
ulong initrd_high;
|
|
||||||
int initrd_copy_to_ram = 1;
|
|
||||||
char *cmdline;
|
|
||||||
const char *c;
|
|
||||||
bd_t *kbd;
|
|
||||||
void (*kernel)(bd_t *, ulong, ulong, ulong, ulong);
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
|
||||||
char *of_flat_tree = NULL;
|
|
||||||
#endif
|
|
||||||
image_header_t *os_header = &idata->os->header;
|
|
||||||
image_header_t *initrd_header = NULL;
|
|
||||||
void *os_data = NULL;
|
|
||||||
void *initrd_data = NULL;
|
|
||||||
void *of_data = NULL;
|
|
||||||
struct image_handle *oftree_handle;
|
|
||||||
unsigned long os_len, initrd_len;
|
|
||||||
|
|
||||||
if (idata->initrd)
|
kernel = (void *)image_get_ep(os_header);
|
||||||
initrd_header = &idata->initrd->header;
|
|
||||||
|
|
||||||
printf("entering %s: os_header: %p initrd_header: %p oftree: %s\n",
|
|
||||||
__FUNCTION__, os_header, initrd_header, idata->oftree);
|
|
||||||
|
|
||||||
if (image_get_type(os_header) == IH_TYPE_MULTI) {
|
|
||||||
unsigned long *data = (unsigned long *)(idata->os->data);
|
|
||||||
unsigned long len1 = 0, len2 = 0;
|
|
||||||
|
|
||||||
if (!*data) {
|
|
||||||
printf("multifile image with 0 entries???\n");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
os_len = ntohl(*data); /* first one is the kernel */
|
|
||||||
data++;
|
|
||||||
|
|
||||||
if (*data) {
|
|
||||||
len1 = ntohl(*data); /* could be initrd or oftree */
|
|
||||||
data++;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (*data) {
|
|
||||||
len2 = ntohl(*data); /* could be oftree */
|
|
||||||
data++;
|
|
||||||
}
|
|
||||||
|
|
||||||
while (*data) /* skip all remaining files */
|
|
||||||
data++;
|
|
||||||
|
|
||||||
data++; /* skip terminating zero */
|
|
||||||
|
|
||||||
os_data = (void *)ntohl(data);
|
|
||||||
|
|
||||||
if (len2) {
|
|
||||||
initrd_data = (void *)
|
|
||||||
((unsigned long)data + ((os_len + 3) & ~3));
|
|
||||||
initrd_len = len1;
|
|
||||||
of_data = (void *)
|
|
||||||
((unsigned long)initrd_data + ((initrd_len + 3) & ~3));
|
|
||||||
} else if (len1) {
|
|
||||||
/* We could check here if this is a multifile image
|
|
||||||
* with only a kernel and an oftree. Original barebox
|
|
||||||
* did not do this, so leave it out for now.
|
|
||||||
*/
|
|
||||||
initrd_data = (void *)((unsigned long)data + ((os_len + 3) & ~3));
|
|
||||||
initrd_len = len1;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
os_data = idata->os->data;
|
|
||||||
printf("set os_data to %p\n", os_data);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (idata->initrd)
|
|
||||||
initrd_data = idata->initrd->data;
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
|
||||||
if (idata->oftree) {
|
|
||||||
/* The oftree can be given either as an barebox image or as a
|
|
||||||
* binary blob. First try to read it as an image.
|
|
||||||
*/
|
|
||||||
oftree_handle = map_image(idata->oftree, 1);
|
|
||||||
if (oftree_handle) {
|
|
||||||
of_data = oftree_handle->data;
|
|
||||||
} else {
|
|
||||||
of_data = read_file(idata->oftree, 0);
|
|
||||||
if (!of_data) {
|
|
||||||
printf("could not read %s: %s\n", idata->oftree, errno_str());
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/* FIXME: check if this is really an oftree */
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
printf("loading kernel.\n");
|
|
||||||
|
|
||||||
if ((c = getenv ("initrd_high")) != NULL) {
|
|
||||||
/* a value of "no" or a similar string will act like 0,
|
|
||||||
* turning the "load high" feature off. This is intentional.
|
|
||||||
*/
|
|
||||||
initrd_high = simple_strtoul(c, NULL, 16);
|
|
||||||
if (initrd_high == ~0)
|
|
||||||
initrd_copy_to_ram = 0;
|
|
||||||
} else { /* not set, no restrictions to load high */
|
|
||||||
initrd_high = ~0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef CONFIG_LOGBUFFER
|
|
||||||
kbd=gd->bd;
|
|
||||||
/* Prevent initrd from overwriting logbuffer */
|
|
||||||
if (initrd_high < (kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD))
|
|
||||||
initrd_high = kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD;
|
|
||||||
debug ("## Logbuffer at 0x%08lX ", kbd->bi_memsize-LOGBUFF_LEN);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Booting a (Linux) kernel image
|
|
||||||
*
|
|
||||||
* Allocate space for command line and board info - the
|
|
||||||
* address should be as high as possible within the reach of
|
|
||||||
* the kernel (see CFG_BOOTMAPSZ settings), but in unused
|
|
||||||
* memory, which means far enough below the current stack
|
|
||||||
* pointer.
|
|
||||||
*/
|
|
||||||
|
|
||||||
asm( "mr %0,1": "=r"(sp) : );
|
|
||||||
|
|
||||||
debug ("## Current stack ends at 0x%08lX ", sp);
|
|
||||||
|
|
||||||
sp -= 2048; /* just to be sure */
|
|
||||||
if (sp > CFG_BOOTMAPSZ)
|
|
||||||
sp = CFG_BOOTMAPSZ;
|
|
||||||
sp &= ~0xF;
|
|
||||||
|
|
||||||
debug ("=> set upper limit to 0x%08lX\n", sp);
|
|
||||||
|
|
||||||
cmdline = (char *)((sp - CONFIG_CBSIZE) & ~0xF);
|
|
||||||
kbd = (bd_t *)(((ulong)cmdline - sizeof(bd_t)) & ~0xF);
|
|
||||||
|
|
||||||
printf("cmdline: %p kbd: %p\n", cmdline, kbd);
|
|
||||||
|
|
||||||
if ((c = getenv("bootargs")) == NULL)
|
|
||||||
c = "";
|
|
||||||
|
|
||||||
strcpy (cmdline, c);
|
|
||||||
|
|
||||||
cmd_start = (ulong)cmdline;
|
|
||||||
cmd_end = cmd_start + strlen(cmdline);
|
|
||||||
|
|
||||||
init_board_data(kbd);
|
|
||||||
|
|
||||||
#ifdef DEBUG
|
|
||||||
printf ("## cmdline at 0x%08lX ... 0x%08lX\n", cmd_start, cmd_end);
|
|
||||||
|
|
||||||
// do_bdinfo (NULL, 0, 0, NULL);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
if ((c = getenv ("clocks_in_mhz")) != NULL) {
|
|
||||||
/* convert all clock information to MHz */
|
|
||||||
kbd->bi_intfreq /= 1000000L;
|
|
||||||
kbd->bi_busfreq /= 1000000L;
|
|
||||||
#if defined(CONFIG_MPC8220)
|
|
||||||
kbd->bi_inpfreq /= 1000000L;
|
|
||||||
kbd->bi_pcifreq /= 1000000L;
|
|
||||||
kbd->bi_pevfreq /= 1000000L;
|
|
||||||
kbd->bi_flbfreq /= 1000000L;
|
|
||||||
kbd->bi_vcofreq /= 1000000L;
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_CPM2)
|
|
||||||
kbd->bi_cpmfreq /= 1000000L;
|
|
||||||
kbd->bi_brgfreq /= 1000000L;
|
|
||||||
kbd->bi_sccfreq /= 1000000L;
|
|
||||||
kbd->bi_vco /= 1000000L;
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_MPC5xxx)
|
|
||||||
kbd->bi_ipbfreq /= 1000000L;
|
|
||||||
kbd->bi_pcifreq /= 1000000L;
|
|
||||||
#endif /* CONFIG_MPC5xxx */
|
|
||||||
}
|
|
||||||
|
|
||||||
kernel = (void (*)(bd_t *, ulong, ulong, ulong, ulong))image_get_ep(os_header); /* FIXME */
|
|
||||||
|
|
||||||
#if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
|
|
||||||
unlock_ram_in_cache();
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
|
||||||
/* move of_flat_tree if needed */
|
|
||||||
if (of_data) {
|
|
||||||
ulong of_start, of_len;
|
|
||||||
of_len = ((struct boot_param_header *)of_data)->totalsize;
|
|
||||||
/* provide extra 8k pad */
|
|
||||||
if (initrd_data)
|
|
||||||
of_start = (unsigned long)initrd_data - of_len - 8192;
|
|
||||||
else
|
|
||||||
of_start = (ulong)kbd - of_len - 8192;
|
|
||||||
of_start &= ~(4096 - 1); /* align on page */
|
|
||||||
debug ("## device tree at 0x%p ... 0x%p (len=%ld=0x%lX)\n",
|
|
||||||
of_data, of_data + of_len - 1, of_len, of_len);
|
|
||||||
|
|
||||||
of_flat_tree = (char *)of_start;
|
|
||||||
printf (" Loading Device Tree to %08lx, end %08lx ... ",
|
|
||||||
of_start, of_start + of_len - 1);
|
|
||||||
memmove ((void *)of_start, (void *)of_data, of_len);
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Linux Kernel Parameters (passing board info data):
|
|
||||||
* r3: ptr to board info data
|
|
||||||
* r4: initrd_start or 0 if no initrd
|
|
||||||
* r5: initrd_end - unused if r4 is 0
|
|
||||||
* r6: Start of command line string
|
|
||||||
* r7: End of command line string
|
|
||||||
*/
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
|
||||||
if (!of_flat_tree) /* no device tree; boot old style */
|
|
||||||
#endif
|
|
||||||
(*kernel) (kbd, (ulong)initrd_data, initrd_end, cmd_start, cmd_end);
|
|
||||||
/* does not return */
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
|
||||||
/*
|
/*
|
||||||
* Linux Kernel Parameters (passing device tree):
|
* Linux Kernel Parameters (passing device tree):
|
||||||
* r3: ptr to OF flat tree, followed by the board info data
|
* r3: ptr to OF flat tree, followed by the board info data
|
||||||
|
@ -248,11 +32,8 @@ static int do_bootm_linux(struct image_data *idata)
|
||||||
* r6: NULL
|
* r6: NULL
|
||||||
* r7: NULL
|
* r7: NULL
|
||||||
*/
|
*/
|
||||||
ft_setup(of_flat_tree, kbd, (long)initrd_data, initrd_end);
|
kernel(data->oftree, kernel, 0, 0, 0);
|
||||||
ft_cpu_setup(of_flat_tree, kbd);
|
|
||||||
|
|
||||||
(*kernel) ((bd_t *)of_flat_tree, (ulong)kernel, 0, 0, 0);
|
|
||||||
#endif
|
|
||||||
reset_cpu(0);
|
reset_cpu(0);
|
||||||
|
|
||||||
/* not reached */
|
/* not reached */
|
||||||
|
|
|
@ -34,12 +34,9 @@
|
||||||
#include <init.h>
|
#include <init.h>
|
||||||
#include <types.h>
|
#include <types.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
|
#include <of.h>
|
||||||
#include <mach/clocks.h>
|
#include <mach/clocks.h>
|
||||||
|
|
||||||
#if defined(CONFIG_OF_FLAT_TREE)
|
|
||||||
#include <ft_build.h>
|
|
||||||
#endif
|
|
||||||
|
|
||||||
int checkcpu (void)
|
int checkcpu (void)
|
||||||
{
|
{
|
||||||
ulong clock = get_cpu_clock();
|
ulong clock = get_cpu_clock();
|
||||||
|
@ -83,27 +80,26 @@ void __noreturn reset_cpu (unsigned long addr)
|
||||||
|
|
||||||
/* ------------------------------------------------------------------------- */
|
/* ------------------------------------------------------------------------- */
|
||||||
|
|
||||||
#ifdef CONFIG_OF_FLAT_TREE
|
#ifdef CONFIG_OFTREE
|
||||||
void
|
static int of_mpc5200_fixup(struct fdt_header *fdt)
|
||||||
ft_cpu_setup(void *blob, bd_t *bd)
|
|
||||||
{
|
{
|
||||||
u32 *p;
|
char *cpu_path = "/cpus/PowerPC,5200@0";
|
||||||
int len;
|
int div = in_8((void*)CFG_MBAR + 0x204) & 0x0020 ? 8 : 4;
|
||||||
|
|
||||||
/* Core XLB bus frequency */
|
do_fixup_by_path_u32(fdt, cpu_path, "timebase-frequency", get_timebase_clock(), 1);
|
||||||
p = ft_get_prop(blob, "/cpus/" OF_CPU "/bus-frequency", &len);
|
do_fixup_by_path_u32(fdt, cpu_path, "bus-frequency", get_bus_clock(), 1);
|
||||||
if (p != NULL)
|
do_fixup_by_path_u32(fdt, cpu_path, "clock-frequency", get_cpu_clock(), 1);
|
||||||
*p = cpu_to_be32(get_bus_clock());
|
do_fixup_by_path_u32(fdt, "/soc5200@f0000000", "bus-frequency", get_ipb_clock(), 1);
|
||||||
|
do_fixup_by_path_u32(fdt, "/soc5200@f0000000", "system-frequency",
|
||||||
/* SOC peripherals use the IPB bus frequency */
|
get_bus_clock() * div, 1);
|
||||||
p = ft_get_prop(blob, "/" OF_SOC "/bus-frequency", &len);
|
return 0;
|
||||||
if (p != NULL)
|
|
||||||
*p = cpu_to_be32(get_ipb_clock());
|
|
||||||
|
|
||||||
p = ft_get_prop(blob, "/" OF_SOC "/ethernet@3000/mac-address", &len);
|
|
||||||
if (p != NULL)
|
|
||||||
memcpy(p, bd->bi_enetaddr, 6);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int of_register_mpc5200_fixup(void)
|
||||||
|
{
|
||||||
|
return of_register_fixup(of_mpc5200_fixup);
|
||||||
|
}
|
||||||
|
late_initcall(of_register_mpc5200_fixup);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
int cpu_init_board_data(bd_t *bd)
|
int cpu_init_board_data(bd_t *bd)
|
||||||
|
|
|
@ -38,6 +38,7 @@
|
||||||
#include <fs.h>
|
#include <fs.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
#include <boot.h>
|
#include <boot.h>
|
||||||
|
#include <of.h>
|
||||||
#include <rtc.h>
|
#include <rtc.h>
|
||||||
#include <init.h>
|
#include <init.h>
|
||||||
#include <magicvar.h>
|
#include <magicvar.h>
|
||||||
|
@ -144,6 +145,10 @@ static int do_bootm(struct command *cmdtp, int argc, char *argv[])
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifdef CONFIG_OFTREE
|
||||||
|
data.oftree = of_get_fixed_tree();
|
||||||
|
#endif
|
||||||
|
|
||||||
if (optind == argc) {
|
if (optind == argc) {
|
||||||
ret = COMMAND_ERROR_USAGE;
|
ret = COMMAND_ERROR_USAGE;
|
||||||
goto err_out;
|
goto err_out;
|
||||||
|
|
|
@ -7,7 +7,7 @@
|
||||||
struct image_data {
|
struct image_data {
|
||||||
struct image_handle *os;
|
struct image_handle *os;
|
||||||
struct image_handle *initrd;
|
struct image_handle *initrd;
|
||||||
const char *oftree;
|
void *oftree;
|
||||||
int verify;
|
int verify;
|
||||||
unsigned long initrd_address;
|
unsigned long initrd_address;
|
||||||
unsigned long initrd_size;
|
unsigned long initrd_size;
|
||||||
|
|
Loading…
Reference in New Issue