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