1
2
3
4
5
6
7
8
9
10
11
12
13
14#define DRV_MODULE_NAME "wii"
15#define pr_fmt(fmt) DRV_MODULE_NAME ": " fmt
16
17#include <linux/kernel.h>
18#include <linux/init.h>
19#include <linux/irq.h>
20#include <linux/seq_file.h>
21#include <linux/of_platform.h>
22#include <linux/memblock.h>
23#include <mm/mmu_decl.h>
24
25#include <asm/io.h>
26#include <asm/machdep.h>
27#include <asm/prom.h>
28#include <asm/time.h>
29#include <asm/udbg.h>
30
31#include "flipper-pic.h"
32#include "hlwd-pic.h"
33#include "usbgecko_udbg.h"
34
35
36#define HW_CTRL_COMPATIBLE "nintendo,hollywood-control"
37
38#define HW_CTRL_RESETS 0x94
39#define HW_CTRL_RESETS_SYS (1<<0)
40
41
42#define HW_GPIO_COMPATIBLE "nintendo,hollywood-gpio"
43
44#define HW_GPIO_BASE(idx) (idx * 0x20)
45#define HW_GPIO_OUT(idx) (HW_GPIO_BASE(idx) + 0)
46#define HW_GPIO_DIR(idx) (HW_GPIO_BASE(idx) + 4)
47
48#define HW_GPIO_SHUTDOWN (1<<1)
49#define HW_GPIO_SLOT_LED (1<<5)
50#define HW_GPIO_SENSOR_BAR (1<<8)
51
52
53static void __iomem *hw_ctrl;
54static void __iomem *hw_gpio;
55
56unsigned long wii_hole_start;
57unsigned long wii_hole_size;
58
59
60static int __init page_aligned(unsigned long x)
61{
62 return !(x & (PAGE_SIZE-1));
63}
64
65void __init wii_memory_fixups(void)
66{
67 struct memblock_region *p = memblock.memory.regions;
68
69
70
71
72
73
74
75
76
77
78
79 BUG_ON(memblock.memory.cnt != 2);
80 BUG_ON(!page_aligned(p[0].base) || !page_aligned(p[1].base));
81
82
83 memblock_remove(ALIGN(p[1].base + p[1].size, PAGE_SIZE),
84 (phys_addr_t)ULLONG_MAX);
85
86
87 wii_hole_start = ALIGN(p[0].base + p[0].size, PAGE_SIZE);
88 wii_hole_size = p[1].base - wii_hole_start;
89 memblock_add(wii_hole_start, wii_hole_size);
90 memblock_reserve(wii_hole_start, wii_hole_size);
91
92 BUG_ON(memblock.memory.cnt != 1);
93 __memblock_dump_all();
94
95
96 __allow_ioremap_reserved = 1;
97}
98
99unsigned long __init wii_mmu_mapin_mem2(unsigned long top)
100{
101 unsigned long delta, size, bl;
102 unsigned long max_size = (256<<20);
103
104
105 delta = wii_hole_start + wii_hole_size;
106 size = top - delta;
107 for (bl = 128<<10; bl < max_size; bl <<= 1) {
108 if (bl * 2 > size)
109 break;
110 }
111 setbat(4, PAGE_OFFSET+delta, delta, bl, PAGE_KERNEL_X);
112 return delta + bl;
113}
114
115static void wii_spin(void)
116{
117 local_irq_disable();
118 for (;;)
119 cpu_relax();
120}
121
122static void __iomem *wii_ioremap_hw_regs(char *name, char *compatible)
123{
124 void __iomem *hw_regs = NULL;
125 struct device_node *np;
126 struct resource res;
127 int error = -ENODEV;
128
129 np = of_find_compatible_node(NULL, NULL, compatible);
130 if (!np) {
131 pr_err("no compatible node found for %s\n", compatible);
132 goto out;
133 }
134 error = of_address_to_resource(np, 0, &res);
135 if (error) {
136 pr_err("no valid reg found for %s\n", np->name);
137 goto out_put;
138 }
139
140 hw_regs = ioremap(res.start, resource_size(&res));
141 if (hw_regs) {
142 pr_info("%s at 0x%08x mapped to 0x%p\n", name,
143 res.start, hw_regs);
144 }
145
146out_put:
147 of_node_put(np);
148out:
149 return hw_regs;
150}
151
152static void __init wii_setup_arch(void)
153{
154 hw_ctrl = wii_ioremap_hw_regs("hw_ctrl", HW_CTRL_COMPATIBLE);
155 hw_gpio = wii_ioremap_hw_regs("hw_gpio", HW_GPIO_COMPATIBLE);
156 if (hw_gpio) {
157
158 clrbits32(hw_gpio + HW_GPIO_OUT(0),
159 HW_GPIO_SLOT_LED | HW_GPIO_SENSOR_BAR);
160 }
161}
162
163static void wii_restart(char *cmd)
164{
165 local_irq_disable();
166
167 if (hw_ctrl) {
168
169 clrbits32(hw_ctrl + HW_CTRL_RESETS, HW_CTRL_RESETS_SYS);
170 }
171 wii_spin();
172}
173
174static void wii_power_off(void)
175{
176 local_irq_disable();
177
178 if (hw_gpio) {
179
180 setbits32(hw_gpio + HW_GPIO_DIR(1), HW_GPIO_SHUTDOWN);
181
182
183 setbits32(hw_gpio + HW_GPIO_OUT(1), HW_GPIO_SHUTDOWN);
184 }
185 wii_spin();
186}
187
188static void wii_halt(void)
189{
190 if (ppc_md.restart)
191 ppc_md.restart(NULL);
192 wii_spin();
193}
194
195static void __init wii_init_early(void)
196{
197 ug_udbg_init();
198}
199
200static void __init wii_pic_probe(void)
201{
202 flipper_pic_probe();
203 hlwd_pic_probe();
204}
205
206static int __init wii_probe(void)
207{
208 unsigned long dt_root;
209
210 dt_root = of_get_flat_dt_root();
211 if (!of_flat_dt_is_compatible(dt_root, "nintendo,wii"))
212 return 0;
213
214 pm_power_off = wii_power_off;
215
216 return 1;
217}
218
219static void wii_shutdown(void)
220{
221 hlwd_quiesce();
222 flipper_quiesce();
223}
224
225define_machine(wii) {
226 .name = "wii",
227 .probe = wii_probe,
228 .init_early = wii_init_early,
229 .setup_arch = wii_setup_arch,
230 .restart = wii_restart,
231 .halt = wii_halt,
232 .init_IRQ = wii_pic_probe,
233 .get_irq = flipper_pic_get_irq,
234 .calibrate_decr = generic_calibrate_decr,
235 .progress = udbg_progress,
236 .machine_shutdown = wii_shutdown,
237};
238
239static const struct of_device_id wii_of_bus[] = {
240 { .compatible = "nintendo,hollywood", },
241 { },
242};
243
244static int __init wii_device_probe(void)
245{
246 if (!machine_is(wii))
247 return 0;
248
249 of_platform_bus_probe(NULL, wii_of_bus, NULL);
250 return 0;
251}
252device_initcall(wii_device_probe);
253
254