PageRenderTime 27ms CodeModel.GetById 13ms app.highlight 11ms RepoModel.GetById 0ms app.codeStats 0ms

/arch/powerpc/platforms/embedded6xx/wii.c

https://bitbucket.org/abioy/linux
C | 268 lines | 188 code | 49 blank | 31 comment | 14 complexity | bb28537ab689ca1fe82e863fa4ae5c29 MD5 | raw file
Possible License(s): CC-BY-SA-3.0, GPL-2.0, LGPL-2.0, AGPL-1.0
  1/*
  2 * arch/powerpc/platforms/embedded6xx/wii.c
  3 *
  4 * Nintendo Wii board-specific 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#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/kexec.h>
 22#include <linux/of_platform.h>
 23#include <linux/lmb.h>
 24#include <mm/mmu_decl.h>
 25
 26#include <asm/io.h>
 27#include <asm/machdep.h>
 28#include <asm/prom.h>
 29#include <asm/time.h>
 30#include <asm/udbg.h>
 31
 32#include "flipper-pic.h"
 33#include "hlwd-pic.h"
 34#include "usbgecko_udbg.h"
 35
 36/* control block */
 37#define HW_CTRL_COMPATIBLE	"nintendo,hollywood-control"
 38
 39#define HW_CTRL_RESETS		0x94
 40#define HW_CTRL_RESETS_SYS	(1<<0)
 41
 42/* gpio */
 43#define HW_GPIO_COMPATIBLE	"nintendo,hollywood-gpio"
 44
 45#define HW_GPIO_BASE(idx)	(idx * 0x20)
 46#define HW_GPIO_OUT(idx)	(HW_GPIO_BASE(idx) + 0)
 47#define HW_GPIO_DIR(idx)	(HW_GPIO_BASE(idx) + 4)
 48
 49#define HW_GPIO_SHUTDOWN	(1<<1)
 50#define HW_GPIO_SLOT_LED	(1<<5)
 51#define HW_GPIO_SENSOR_BAR	(1<<8)
 52
 53
 54static void __iomem *hw_ctrl;
 55static void __iomem *hw_gpio;
 56
 57unsigned long wii_hole_start;
 58unsigned long wii_hole_size;
 59
 60
 61static int __init page_aligned(unsigned long x)
 62{
 63	return !(x & (PAGE_SIZE-1));
 64}
 65
 66void __init wii_memory_fixups(void)
 67{
 68	struct lmb_property *p = lmb.memory.region;
 69
 70	/*
 71	 * This is part of a workaround to allow the use of two
 72	 * discontiguous RAM ranges on the Wii, even if this is
 73	 * currently unsupported on 32-bit PowerPC Linux.
 74	 *
 75	 * We coealesce the two memory ranges of the Wii into a
 76	 * single range, then create a reservation for the "hole"
 77	 * between both ranges.
 78	 */
 79
 80	BUG_ON(lmb.memory.cnt != 2);
 81	BUG_ON(!page_aligned(p[0].base) || !page_aligned(p[1].base));
 82
 83	p[0].size = _ALIGN_DOWN(p[0].size, PAGE_SIZE);
 84	p[1].size = _ALIGN_DOWN(p[1].size, PAGE_SIZE);
 85
 86	wii_hole_start = p[0].base + p[0].size;
 87	wii_hole_size = p[1].base - wii_hole_start;
 88
 89	pr_info("MEM1: <%08llx %08llx>\n", p[0].base, p[0].size);
 90	pr_info("HOLE: <%08lx %08lx>\n", wii_hole_start, wii_hole_size);
 91	pr_info("MEM2: <%08llx %08llx>\n", p[1].base, p[1].size);
 92
 93	p[0].size += wii_hole_size + p[1].size;
 94
 95	lmb.memory.cnt = 1;
 96	lmb_analyze();
 97
 98	/* reserve the hole */
 99	lmb_reserve(wii_hole_start, wii_hole_size);
100
101	/* allow ioremapping the address space in the hole */
102	__allow_ioremap_reserved = 1;
103}
104
105unsigned long __init wii_mmu_mapin_mem2(unsigned long top)
106{
107	unsigned long delta, size, bl;
108	unsigned long max_size = (256<<20);
109
110	/* MEM2 64MB@0x10000000 */
111	delta = wii_hole_start + wii_hole_size;
112	size = top - delta;
113	for (bl = 128<<10; bl < max_size; bl <<= 1) {
114		if (bl * 2 > size)
115			break;
116	}
117	setbat(4, PAGE_OFFSET+delta, delta, bl, PAGE_KERNEL_X);
118	return delta + bl;
119}
120
121static void wii_spin(void)
122{
123	local_irq_disable();
124	for (;;)
125		cpu_relax();
126}
127
128static void __iomem *wii_ioremap_hw_regs(char *name, char *compatible)
129{
130	void __iomem *hw_regs = NULL;
131	struct device_node *np;
132	struct resource res;
133	int error = -ENODEV;
134
135	np = of_find_compatible_node(NULL, NULL, compatible);
136	if (!np) {
137		pr_err("no compatible node found for %s\n", compatible);
138		goto out;
139	}
140	error = of_address_to_resource(np, 0, &res);
141	if (error) {
142		pr_err("no valid reg found for %s\n", np->name);
143		goto out_put;
144	}
145
146	hw_regs = ioremap(res.start, resource_size(&res));
147	if (hw_regs) {
148		pr_info("%s at 0x%08x mapped to 0x%p\n", name,
149			res.start, hw_regs);
150	}
151
152out_put:
153	of_node_put(np);
154out:
155	return hw_regs;
156}
157
158static void __init wii_setup_arch(void)
159{
160	hw_ctrl = wii_ioremap_hw_regs("hw_ctrl", HW_CTRL_COMPATIBLE);
161	hw_gpio = wii_ioremap_hw_regs("hw_gpio", HW_GPIO_COMPATIBLE);
162	if (hw_gpio) {
163		/* turn off the front blue led and IR light */
164		clrbits32(hw_gpio + HW_GPIO_OUT(0),
165			  HW_GPIO_SLOT_LED | HW_GPIO_SENSOR_BAR);
166	}
167}
168
169static void wii_restart(char *cmd)
170{
171	local_irq_disable();
172
173	if (hw_ctrl) {
174		/* clear the system reset pin to cause a reset */
175		clrbits32(hw_ctrl + HW_CTRL_RESETS, HW_CTRL_RESETS_SYS);
176	}
177	wii_spin();
178}
179
180static void wii_power_off(void)
181{
182	local_irq_disable();
183
184	if (hw_gpio) {
185		/* make sure that the poweroff GPIO is configured as output */
186		setbits32(hw_gpio + HW_GPIO_DIR(1), HW_GPIO_SHUTDOWN);
187
188		/* drive the poweroff GPIO high */
189		setbits32(hw_gpio + HW_GPIO_OUT(1), HW_GPIO_SHUTDOWN);
190	}
191	wii_spin();
192}
193
194static void wii_halt(void)
195{
196	if (ppc_md.restart)
197		ppc_md.restart(NULL);
198	wii_spin();
199}
200
201static void __init wii_init_early(void)
202{
203	ug_udbg_init();
204}
205
206static void __init wii_pic_probe(void)
207{
208	flipper_pic_probe();
209	hlwd_pic_probe();
210}
211
212static int __init wii_probe(void)
213{
214	unsigned long dt_root;
215
216	dt_root = of_get_flat_dt_root();
217	if (!of_flat_dt_is_compatible(dt_root, "nintendo,wii"))
218		return 0;
219
220	return 1;
221}
222
223static void wii_shutdown(void)
224{
225	hlwd_quiesce();
226	flipper_quiesce();
227}
228
229#ifdef CONFIG_KEXEC
230static int wii_machine_kexec_prepare(struct kimage *image)
231{
232	return 0;
233}
234#endif /* CONFIG_KEXEC */
235
236define_machine(wii) {
237	.name			= "wii",
238	.probe			= wii_probe,
239	.init_early		= wii_init_early,
240	.setup_arch		= wii_setup_arch,
241	.restart		= wii_restart,
242	.power_off		= wii_power_off,
243	.halt			= wii_halt,
244	.init_IRQ		= wii_pic_probe,
245	.get_irq		= flipper_pic_get_irq,
246	.calibrate_decr		= generic_calibrate_decr,
247	.progress		= udbg_progress,
248	.machine_shutdown	= wii_shutdown,
249#ifdef CONFIG_KEXEC
250	.machine_kexec_prepare	= wii_machine_kexec_prepare,
251#endif
252};
253
254static struct of_device_id wii_of_bus[] = {
255	{ .compatible = "nintendo,hollywood", },
256	{ },
257};
258
259static int __init wii_device_probe(void)
260{
261	if (!machine_is(wii))
262		return 0;
263
264	of_platform_bus_probe(NULL, wii_of_bus, NULL);
265	return 0;
266}
267device_initcall(wii_device_probe);
268