| Bryan O'Donoghue | 59d13f9 | 2008-05-08 13:47:00 +0100 | [diff] [blame] | 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 |  | 
 | 20 | static bd_t bd; | 
 | 21 | BSS_STACK(4096); | 
 | 22 |  | 
 | 23 | #define MHZ(x)	((x + 500000) / 1000000) | 
 | 24 |  | 
 | 25 | static 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 |  | 
 | 42 | void 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 | } |