1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include "ops.h"
16#include "stdio.h"
17#include "dcr.h"
18#include "4xx.h"
19#include "io.h"
20
21BSS_STACK(4096);
22
23static void walnut_flashsel_fixup(void)
24{
25 void *devp, *sram;
26 u32 reg_flash[3] = {0x0, 0x0, 0x80000};
27 u32 reg_sram[3] = {0x0, 0x0, 0x80000};
28 u8 *fpga;
29 u8 fpga_brds1 = 0x0;
30
31 devp = finddevice("/plb/ebc/fpga");
32 if (!devp)
33 fatal("Couldn't locate FPGA node\n\r");
34
35 if (getprop(devp, "virtual-reg", &fpga, sizeof(fpga)) != sizeof(fpga))
36 fatal("no virtual-reg property\n\r");
37
38 fpga_brds1 = in_8(fpga);
39
40 devp = finddevice("/plb/ebc/flash");
41 if (!devp)
42 fatal("Couldn't locate flash node\n\r");
43
44 if (getprop(devp, "reg", reg_flash, sizeof(reg_flash)) != sizeof(reg_flash))
45 fatal("flash reg property has unexpected size\n\r");
46
47 sram = finddevice("/plb/ebc/sram");
48 if (!sram)
49 fatal("Couldn't locate sram node\n\r");
50
51 if (getprop(sram, "reg", reg_sram, sizeof(reg_sram)) != sizeof(reg_sram))
52 fatal("sram reg property has unexpected size\n\r");
53
54 if (fpga_brds1 & 0x1) {
55 reg_flash[1] ^= 0x80000;
56 reg_sram[1] ^= 0x80000;
57 }
58
59 setprop(devp, "reg", reg_flash, sizeof(reg_flash));
60 setprop(sram, "reg", reg_sram, sizeof(reg_sram));
61}
62
63#define WALNUT_OPENBIOS_MAC_OFF 0xfffffe0b
64static void walnut_fixups(void)
65{
66 ibm4xx_sdram_fixup_memsize();
67 ibm405gp_fixup_clocks(33330000, 0xa8c000);
68 ibm4xx_quiesce_eth((u32 *)0xef600800, NULL);
69 ibm4xx_fixup_ebc_ranges("/plb/ebc");
70 walnut_flashsel_fixup();
71 dt_fixup_mac_address_by_alias("ethernet0", (u8 *) WALNUT_OPENBIOS_MAC_OFF);
72}
73
74void platform_init(void)
75{
76 unsigned long end_of_ram = 0x2000000;
77 unsigned long avail_ram = end_of_ram - (unsigned long) _end;
78
79 simple_alloc_init(_end, avail_ram, 32, 32);
80 platform_ops.fixups = walnut_fixups;
81 platform_ops.exit = ibm40x_dbcr_reset;
82 fdt_init(_dtb_start);
83 serial_console_init();
84}
85