Benjamin Herrenschmidt | 6197403 | 2007-12-21 15:39:26 +1100 | [diff] [blame] | 1 | /* |
| 2 | * Embedded Planet EP405 with PlanetCore firmware |
| 3 | * |
| 4 | * (c) Benjamin Herrenschmidt <benh@kernel.crashing.org>, IBM Corp,\ |
| 5 | * |
| 6 | * Based on ep88xc.c by |
| 7 | * |
| 8 | * Scott Wood <scottwood@freescale.com> |
| 9 | * |
| 10 | * Copyright (c) 2007 Freescale Semiconductor, Inc. |
| 11 | * |
| 12 | * This program is free software; you can redistribute it and/or modify it |
| 13 | * under the terms of the GNU General Public License version 2 as published |
| 14 | * by the Free Software Foundation. |
| 15 | */ |
| 16 | |
| 17 | #include "ops.h" |
| 18 | #include "stdio.h" |
| 19 | #include "planetcore.h" |
| 20 | #include "dcr.h" |
| 21 | #include "4xx.h" |
| 22 | #include "io.h" |
| 23 | |
| 24 | static char *table; |
| 25 | static u64 mem_size; |
| 26 | |
| 27 | static void platform_fixups(void) |
| 28 | { |
| 29 | u64 val; |
| 30 | void *nvrtc; |
| 31 | |
| 32 | dt_fixup_memory(0, mem_size); |
| 33 | planetcore_set_mac_addrs(table); |
| 34 | |
| 35 | if (!planetcore_get_decimal(table, PLANETCORE_KEY_CRYSTAL_HZ, &val)) { |
| 36 | printf("No PlanetCore crystal frequency key.\r\n"); |
| 37 | return; |
| 38 | } |
| 39 | ibm405gp_fixup_clocks(val, 0xa8c000); |
| 40 | ibm4xx_quiesce_eth((u32 *)0xef600800, NULL); |
| 41 | ibm4xx_fixup_ebc_ranges("/plb/ebc"); |
| 42 | |
| 43 | if (!planetcore_get_decimal(table, PLANETCORE_KEY_KB_NVRAM, &val)) { |
| 44 | printf("No PlanetCore NVRAM size key.\r\n"); |
| 45 | return; |
| 46 | } |
| 47 | nvrtc = finddevice("/plb/ebc/nvrtc@4,200000"); |
| 48 | if (nvrtc != NULL) { |
| 49 | u32 reg[3] = { 4, 0x200000, 0}; |
| 50 | getprop(nvrtc, "reg", reg, 3); |
| 51 | reg[2] = (val << 10) & 0xffffffff; |
| 52 | setprop(nvrtc, "reg", reg, 3); |
| 53 | } |
| 54 | } |
| 55 | |
| 56 | void platform_init(unsigned long r3, unsigned long r4, unsigned long r5, |
| 57 | unsigned long r6, unsigned long r7) |
| 58 | { |
| 59 | table = (char *)r3; |
| 60 | planetcore_prepare_table(table); |
| 61 | |
| 62 | if (!planetcore_get_decimal(table, PLANETCORE_KEY_MB_RAM, &mem_size)) |
| 63 | return; |
| 64 | |
| 65 | mem_size *= 1024 * 1024; |
| 66 | simple_alloc_init(_end, mem_size - (unsigned long)_end, 32, 64); |
| 67 | |
| 68 | fdt_init(_dtb_start); |
| 69 | |
| 70 | planetcore_set_stdout_path(table); |
| 71 | |
| 72 | serial_console_init(); |
| 73 | platform_ops.fixups = platform_fixups; |
| 74 | } |