61 lines
1.4 KiB
C
61 lines
1.4 KiB
C
|
/*
|
||
|
|
* RedBoot firmware support
|
||
|
|
*
|
||
|
|
* Author: Scott Wood <scottwood@freescale.com>
|
||
|
|
*
|
||
|
|
* Copyright (c) 2007 Freescale Semiconductor, Inc.
|
||
|
|
* Copyright (c) 2008 Codehermit
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
|
* under the terms of the GNU General Public License version 2 as published
|
||
|
|
* by the Free Software Foundation.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "ops.h"
|
||
|
|
#include "stdio.h"
|
||
|
|
#include "redboot.h"
|
||
|
|
#include "fsl-soc.h"
|
||
|
|
#include "io.h"
|
||
|
|
|
||
|
|
static bd_t bd;
|
||
|
|
BSS_STACK(4096);
|
||
|
|
|
||
|
|
#define MHZ(x) ((x + 500000) / 1000000)
|
||
|
|
|
||
|
|
static void platform_fixups(void)
|
||
|
|
{
|
||
|
|
void *node;
|
||
|
|
|
||
|
|
dt_fixup_memory(bd.bi_memstart, bd.bi_memsize);
|
||
|
|
dt_fixup_mac_addresses(bd.bi_enetaddr);
|
||
|
|
dt_fixup_cpu_clocks(bd.bi_intfreq, bd.bi_busfreq / 16, bd.bi_busfreq);
|
||
|
|
|
||
|
|
node = finddevice("/soc/cpm/brg");
|
||
|
|
if (node) {
|
||
|
|
printf("BRG clock-frequency <- 0x%x (%dMHz)\r\n",
|
||
|
|
bd.bi_busfreq, MHZ(bd.bi_busfreq));
|
||
|
|
setprop(node, "clock-frequency", &bd.bi_busfreq, 4);
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
|
||
|
|
unsigned long r6, unsigned long r7)
|
||
|
|
{
|
||
|
|
memcpy(&bd, (char *)r3, sizeof(bd));
|
||
|
|
|
||
|
|
if (bd.bi_tag != 0x42444944)
|
||
|
|
return;
|
||
|
|
|
||
|
|
simple_alloc_init(_end,
|
||
|
|
bd.bi_memstart + bd.bi_memsize - (unsigned long)_end,
|
||
|
|
32, 64);
|
||
|
|
|
||
|
|
fdt_init(_dtb_start);
|
||
|
|
serial_console_init();
|
||
|
|
platform_ops.fixups = platform_fixups;
|
||
|
|
|
||
|
|
loader_info.cmdline = (char *)bd.bi_cmdline;
|
||
|
|
loader_info.cmdline_len = strlen((char *)bd.bi_cmdline);
|
||
|
|
}
|