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