1/*
2 * RedBoot firmware support
3 *
4 * Author: Scott Wood <scottwood@freescale.com>
5 *
6 * Copyright (c) 2007 Freescale Semiconductor, Inc.
7 * Copyright (c) 2008 Codehermit
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License version 2 as published
11 * by the Free Software Foundation.
12 */
13
14#include "ops.h"
15#include "stdio.h"
16#include "redboot.h"
17#include "fsl-soc.h"
18#include "io.h"
19
20static bd_t bd;
21BSS_STACK(4096);
22
23#define MHZ(x)	((x + 500000) / 1000000)
24
25static void platform_fixups(void)
26{
27	void *node;
28
29	dt_fixup_memory(bd.bi_memstart, bd.bi_memsize);
30	dt_fixup_mac_addresses(bd.bi_enetaddr);
31	dt_fixup_cpu_clocks(bd.bi_intfreq, bd.bi_busfreq / 16, bd.bi_busfreq);
32
33	node = finddevice("/soc/cpm/brg");
34	if (node) {
35		printf("BRG clock-frequency <- 0x%x (%dMHz)\r\n",
36		       bd.bi_busfreq, MHZ(bd.bi_busfreq));
37		setprop(node, "clock-frequency",  &bd.bi_busfreq, 4);
38	}
39
40}
41
42void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
43		   unsigned long r6, unsigned long r7)
44{
45	memcpy(&bd, (char *)r3, sizeof(bd));
46
47	if (bd.bi_tag != 0x42444944)
48		return;
49
50	simple_alloc_init(_end,
51			  bd.bi_memstart + bd.bi_memsize - (unsigned long)_end,
52			  32, 64);
53
54	fdt_init(_dtb_start);
55	serial_console_init();
56	platform_ops.fixups = platform_fixups;
57
58	loader_info.cmdline = (char *)bd.bi_cmdline;
59	loader_info.cmdline_len = strlen((char *)bd.bi_cmdline);
60}
61