Bug fix.
[kvmfornfv.git] / kernel / arch / powerpc / boot / wii.c
1 /*
2  * arch/powerpc/boot/wii.c
3  *
4  * Nintendo Wii bootwrapper support
5  * Copyright (C) 2008-2009 The GameCube Linux Team
6  * Copyright (C) 2008,2009 Albert Herranz
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License
10  * as published by the Free Software Foundation; either version 2
11  * of the License, or (at your option) any later version.
12  *
13  */
14
15 #include <stddef.h>
16 #include "stdio.h"
17 #include "types.h"
18 #include "io.h"
19 #include "ops.h"
20
21 #include "ugecon.h"
22
23 BSS_STACK(8192);
24
25 #define HW_REG(x)               ((void *)(x))
26
27 #define EXI_CTRL                HW_REG(0x0d800070)
28 #define EXI_CTRL_ENABLE         (1<<0)
29
30 #define MEM2_TOP                (0x10000000 + 64*1024*1024)
31 #define FIRMWARE_DEFAULT_SIZE   (12*1024*1024)
32
33
34 struct mipc_infohdr {
35         char magic[3];
36         u8 version;
37         u32 mem2_boundary;
38         u32 ipc_in;
39         size_t ipc_in_size;
40         u32 ipc_out;
41         size_t ipc_out_size;
42 };
43
44 static int mipc_check_address(u32 pa)
45 {
46         /* only MEM2 addresses */
47         if (pa < 0x10000000 || pa > 0x14000000)
48                 return -EINVAL;
49         return 0;
50 }
51
52 static struct mipc_infohdr *mipc_get_infohdr(void)
53 {
54         struct mipc_infohdr **hdrp, *hdr;
55
56         /* 'mini' header pointer is the last word of MEM2 memory */
57         hdrp = (struct mipc_infohdr **)0x13fffffc;
58         if (mipc_check_address((u32)hdrp)) {
59                 printf("mini: invalid hdrp %08X\n", (u32)hdrp);
60                 hdr = NULL;
61                 goto out;
62         }
63
64         hdr = *hdrp;
65         if (mipc_check_address((u32)hdr)) {
66                 printf("mini: invalid hdr %08X\n", (u32)hdr);
67                 hdr = NULL;
68                 goto out;
69         }
70         if (memcmp(hdr->magic, "IPC", 3)) {
71                 printf("mini: invalid magic\n");
72                 hdr = NULL;
73                 goto out;
74         }
75
76 out:
77         return hdr;
78 }
79
80 static int mipc_get_mem2_boundary(u32 *mem2_boundary)
81 {
82         struct mipc_infohdr *hdr;
83         int error;
84
85         hdr = mipc_get_infohdr();
86         if (!hdr) {
87                 error = -1;
88                 goto out;
89         }
90
91         if (mipc_check_address(hdr->mem2_boundary)) {
92                 printf("mini: invalid mem2_boundary %08X\n",
93                        hdr->mem2_boundary);
94                 error = -EINVAL;
95                 goto out;
96         }
97         *mem2_boundary = hdr->mem2_boundary;
98         error = 0;
99 out:
100         return error;
101
102 }
103
104 static void platform_fixups(void)
105 {
106         void *mem;
107         u32 reg[4];
108         u32 mem2_boundary;
109         int len;
110         int error;
111
112         mem = finddevice("/memory");
113         if (!mem)
114                 fatal("Can't find memory node\n");
115
116         /* two ranges of (address, size) words */
117         len = getprop(mem, "reg", reg, sizeof(reg));
118         if (len != sizeof(reg)) {
119                 /* nothing to do */
120                 goto out;
121         }
122
123         /* retrieve MEM2 boundary from 'mini' */
124         error = mipc_get_mem2_boundary(&mem2_boundary);
125         if (error) {
126                 /* if that fails use a sane value */
127                 mem2_boundary = MEM2_TOP - FIRMWARE_DEFAULT_SIZE;
128         }
129
130         if (mem2_boundary > reg[2] && mem2_boundary < reg[2] + reg[3]) {
131                 reg[3] = mem2_boundary - reg[2];
132                 printf("top of MEM2 @ %08X\n", reg[2] + reg[3]);
133                 setprop(mem, "reg", reg, sizeof(reg));
134         }
135
136 out:
137         return;
138 }
139
140 void platform_init(unsigned long r3, unsigned long r4, unsigned long r5)
141 {
142         u32 heapsize = 24*1024*1024 - (u32)_end;
143
144         simple_alloc_init(_end, heapsize, 32, 64);
145         fdt_init(_dtb_start);
146
147         /*
148          * 'mini' boots the Broadway processor with EXI disabled.
149          * We need it enabled before probing for the USB Gecko.
150          */
151         out_be32(EXI_CTRL, in_be32(EXI_CTRL) | EXI_CTRL_ENABLE);
152
153         if (ug_probe())
154                 console_ops.write = ug_console_write;
155
156         platform_ops.fixups = platform_fixups;
157 }
158