release/src-rt-6.x.4708/linux/linux-2.6.36/arch/powerpc/platforms/embedded6xx/wii.c

   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/memblock.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
  54 static void __iomem *hw_ctrl;
  55 static void __iomem *hw_gpio;
  56
  57 unsigned long wii_hole_start;
  58 unsigned long wii_hole_size;
  59
  60
  61 static int __init page_aligned(unsigned long x)
  62 {
  63         return !(x & (PAGE_SIZE-1));
  64 }
  65
  66 void __init wii_memory_fixups(void)
  67 {
  68         struct memblock_property *p = memblock.memory.region;
  69
  70
  71         BUG_ON(memblock.memory.cnt != 2);
  72         BUG_ON(!page_aligned(p[0].base) || !page_aligned(p[1].base));
  73
  74         p[0].size = _ALIGN_DOWN(p[0].size, PAGE_SIZE);
  75         p[1].size = _ALIGN_DOWN(p[1].size, PAGE_SIZE);
  76
  77         wii_hole_start = p[0].base + p[0].size;
  78         wii_hole_size = p[1].base - wii_hole_start;
  79
  80         pr_info("MEM1: <%08llx %08llx>\n", p[0].base, p[0].size);
  81         pr_info("HOLE: <%08lx %08lx>\n", wii_hole_start, wii_hole_size);
  82         pr_info("MEM2: <%08llx %08llx>\n", p[1].base, p[1].size);
  83
  84         p[0].size += wii_hole_size + p[1].size;
  85
  86         memblock.memory.cnt = 1;
  87         memblock_analyze();
  88
  89         /* reserve the hole */
  90         memblock_reserve(wii_hole_start, wii_hole_size);
  91
  92         /* allow ioremapping the address space in the hole */
  93         __allow_ioremap_reserved = 1;
  94 }
  95
  96 unsigned long __init wii_mmu_mapin_mem2(unsigned long top)
  97 {
  98         unsigned long delta, size, bl;
  99         unsigned long max_size = (256<<20);
 100
 101         /* MEM2 64MB@0x10000000 */
 102         delta = wii_hole_start + wii_hole_size;
 103         size = top - delta;
 104         for (bl = 128<<10; bl < max_size; bl <<= 1) {
 105                 if (bl * 2 > size)
 106                         break;
 107         }
 108         setbat(4, PAGE_OFFSET+delta, delta, bl, PAGE_KERNEL_X);
 109         return delta + bl;
 110 }
 111
 112 static void wii_spin(void)
 113 {
 114         local_irq_disable();
 115         for (;;)
 116                 cpu_relax();
 117 }
 118
 119 static void __iomem *wii_ioremap_hw_regs(char *name, char *compatible)
 120 {
 121         void __iomem *hw_regs = NULL;
 122         struct device_node *np;
 123         struct resource res;
 124         int error = -ENODEV;
 125
 126         np = of_find_compatible_node(NULL, NULL, compatible);
 127         if (!np) {
 128                 pr_err("no compatible node found for %s\n", compatible);
 129                 goto out;
 130         }
 131         error = of_address_to_resource(np, 0, &res);
 132         if (error) {
 133                 pr_err("no valid reg found for %s\n", np->name);
 134                 goto out_put;
 135         }
 136
 137         hw_regs = ioremap(res.start, resource_size(&res));
 138         if (hw_regs) {
 139                 pr_info("%s at 0x%08x mapped to 0x%p\n", name,
 140                         res.start, hw_regs);
 141         }
 142
 143 out_put:
 144         of_node_put(np);
 145 out:
 146         return hw_regs;
 147 }
 148
 149 static void __init wii_setup_arch(void)
 150 {
 151         hw_ctrl = wii_ioremap_hw_regs("hw_ctrl", HW_CTRL_COMPATIBLE);
 152         hw_gpio = wii_ioremap_hw_regs("hw_gpio", HW_GPIO_COMPATIBLE);
 153         if (hw_gpio) {
 154                 /* turn off the front blue led and IR light */
 155                 clrbits32(hw_gpio + HW_GPIO_OUT(0),
 156                           HW_GPIO_SLOT_LED | HW_GPIO_SENSOR_BAR);
 157         }
 158 }
 159
 160 static void wii_restart(char *cmd)
 161 {
 162         local_irq_disable();
 163
 164         if (hw_ctrl) {
 165                 /* clear the system reset pin to cause a reset */
 166                 clrbits32(hw_ctrl + HW_CTRL_RESETS, HW_CTRL_RESETS_SYS);
 167         }
 168         wii_spin();
 169 }
 170
 171 static void wii_power_off(void)
 172 {
 173         local_irq_disable();
 174
 175         if (hw_gpio) {
 176                 /* make sure that the poweroff GPIO is configured as output */
 177                 setbits32(hw_gpio + HW_GPIO_DIR(1), HW_GPIO_SHUTDOWN);
 178
 179                 /* drive the poweroff GPIO high */
 180                 setbits32(hw_gpio + HW_GPIO_OUT(1), HW_GPIO_SHUTDOWN);
 181         }
 182         wii_spin();
 183 }
 184
 185 static void wii_halt(void)
 186 {
 187         if (ppc_md.restart)
 188                 ppc_md.restart(NULL);
 189         wii_spin();
 190 }
 191
 192 static void __init wii_init_early(void)
 193 {
 194         ug_udbg_init();
 195 }
 196
 197 static void __init wii_pic_probe(void)
 198 {
 199         flipper_pic_probe();
 200         hlwd_pic_probe();
 201 }
 202
 203 static int __init wii_probe(void)
 204 {
 205         unsigned long dt_root;
 206
 207         dt_root = of_get_flat_dt_root();
 208         if (!of_flat_dt_is_compatible(dt_root, "nintendo,wii"))
 209                 return 0;
 210
 211         return 1;
 212 }
 213
 214 static void wii_shutdown(void)
 215 {
 216         hlwd_quiesce();
 217         flipper_quiesce();
 218 }
 219
 220 #ifdef CONFIG_KEXEC
 221 static int wii_machine_kexec_prepare(struct kimage *image)
 222 {
 223         return 0;
 224 }
 225 #endif /* CONFIG_KEXEC */
 226
 227 define_machine(wii) {
 228         .name                   = "wii",
 229         .probe                  = wii_probe,
 230         .init_early             = wii_init_early,
 231         .setup_arch             = wii_setup_arch,
 232         .restart                = wii_restart,
 233         .power_off              = wii_power_off,
 234         .halt                   = wii_halt,
 235         .init_IRQ               = wii_pic_probe,
 236         .get_irq                = flipper_pic_get_irq,
 237         .calibrate_decr         = generic_calibrate_decr,
 238         .progress               = udbg_progress,
 239         .machine_shutdown       = wii_shutdown,
 240 #ifdef CONFIG_KEXEC
 241         .machine_kexec_prepare  = wii_machine_kexec_prepare,
 242 #endif
 243 };
 244
 245 static struct of_device_id wii_of_bus[] = {
 246         { .compatible = "nintendo,hollywood", },
 247         { },
 248 };
 249
 250 static int __init wii_device_probe(void)
 251 {
 252         if (!machine_is(wii))
 253                 return 0;
 254
 255         of_platform_bus_probe(NULL, wii_of_bus, NULL);
 256         return 0;
 257 }
 258 device_initcall(wii_device_probe);