target/linux/ixp4xx/patches-2.6.24/030-ixp4xx_fsg_board_support.patch

   1 Index: linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-pci.c
   2 ===================================================================
   3 --- /dev/null   1970-01-01 00:00:00.000000000 +0000
   4 +++ linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-pci.c        2008-01-11 17:06:33.000000000 +1030
   5 @@ -0,0 +1,71 @@
   6 +/*
   7 + * arch/arch/mach-ixp4xx/fsg-pci.c
   8 + *
   9 + * FSG board-level PCI initialization
  10 + *
  11 + * Author: Rod Whitby <rod@whitby.id.au>
  12 + * Maintainer: http://www.nslu2-linux.org/
  13 + *
  14 + * based on ixdp425-pci.c:
  15 + *     Copyright (C) 2002 Intel Corporation.
  16 + *     Copyright (C) 2003-2004 MontaVista Software, Inc.
  17 + *
  18 + * This program is free software; you can redistribute it and/or modify
  19 + * it under the terms of the GNU General Public License version 2 as
  20 + * published by the Free Software Foundation.
  21 + *
  22 + */
  23 +
  24 +#include <linux/pci.h>
  25 +#include <linux/init.h>
  26 +#include <linux/irq.h>
  27 +
  28 +#include <asm/mach/pci.h>
  29 +#include <asm/mach-types.h>
  30 +
  31 +void __init fsg_pci_preinit(void)
  32 +{
  33 +       set_irq_type(IRQ_FSG_PCI_INTA, IRQT_LOW);
  34 +       set_irq_type(IRQ_FSG_PCI_INTB, IRQT_LOW);
  35 +       set_irq_type(IRQ_FSG_PCI_INTC, IRQT_LOW);
  36 +
  37 +       ixp4xx_pci_preinit();
  38 +}
  39 +
  40 +static int __init fsg_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
  41 +{
  42 +       static int pci_irq_table[FSG_PCI_IRQ_LINES] = {
  43 +               IRQ_FSG_PCI_INTC,
  44 +               IRQ_FSG_PCI_INTB,
  45 +               IRQ_FSG_PCI_INTA,
  46 +       };
  47 +
  48 +       int irq = -1;
  49 +       slot = slot - 11;
  50 +
  51 +       if (slot >= 1 && slot <= FSG_PCI_MAX_DEV &&
  52 +               pin >= 1 && pin <= FSG_PCI_IRQ_LINES) {
  53 +                       irq = pci_irq_table[(slot - 1)];
  54 +       }
  55 +        printk("%s: Mapped slot %d pin %d to IRQ %d\n", __FUNCTION__,slot, pin, irq);
  56 +
  57 +        return irq;
  58 +}
  59 +
  60 +struct hw_pci fsg_pci __initdata = {
  61 +       .nr_controllers = 1,
  62 +       .preinit =        fsg_pci_preinit,
  63 +       .swizzle =        pci_std_swizzle,
  64 +       .setup =          ixp4xx_setup,
  65 +       .scan =           ixp4xx_scan_bus,
  66 +       .map_irq =        fsg_map_irq,
  67 +};
  68 +
  69 +int __init fsg_pci_init(void)
  70 +{
  71 +       if (machine_is_fsg())
  72 +               pci_common_init(&fsg_pci);
  73 +       return 0;
  74 +}
  75 +
  76 +subsys_initcall(fsg_pci_init);
  77 Index: linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-setup.c
  78 ===================================================================
  79 --- /dev/null   1970-01-01 00:00:00.000000000 +0000
  80 +++ linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-setup.c      2008-01-11 17:06:33.000000000 +1030
  81 @@ -0,0 +1,220 @@
  82 +/*
  83 + * arch/arm/mach-ixp4xx/fsg-setup.c
  84 + *
  85 + * FSG board-setup
  86 + *
  87 + * based ixdp425-setup.c:
  88 + *      Copyright (C) 2003-2004 MontaVista Software, Inc.
  89 + *
  90 + * Author: Rod Whitby <rod@whitby.id.au>
  91 + * Maintainers: http://www.nslu2-linux.org/
  92 + *
  93 + */
  94 +
  95 +#include <linux/kernel.h>
  96 +#include <linux/serial.h>
  97 +#include <linux/serial_8250.h>
  98 +#include <linux/leds.h>
  99 +#include <linux/reboot.h>
 100 +#include <linux/i2c-gpio.h>
 101 +
 102 +#include <asm/mach-types.h>
 103 +#include <asm/mach/arch.h>
 104 +#include <asm/mach/flash.h>
 105 +#include <asm/io.h>
 106 +
 107 +static struct flash_platform_data fsg_flash_data = {
 108 +       .map_name               = "cfi_probe",
 109 +       .width                  = 2,
 110 +};
 111 +
 112 +static struct resource fsg_flash_resource = {
 113 +       .flags                  = IORESOURCE_MEM,
 114 +};
 115 +
 116 +static struct platform_device fsg_flash = {
 117 +       .name                   = "IXP4XX-Flash",
 118 +       .id                     = 0,
 119 +       .dev.platform_data      = &fsg_flash_data,
 120 +       .num_resources          = 1,
 121 +       .resource               = &fsg_flash_resource,
 122 +};
 123 +
 124 +static struct i2c_gpio_platform_data fsg_i2c_gpio_data = {
 125 +       .sda_pin                = FSG_SDA_PIN,
 126 +       .scl_pin                = FSG_SCL_PIN,
 127 +};
 128 +
 129 +static struct platform_device fsg_i2c_gpio = {
 130 +       .name                   = "i2c-gpio",
 131 +       .id                     = 0,
 132 +       .dev     = {
 133 +               .platform_data  = &fsg_i2c_gpio_data,
 134 +       },
 135 +};
 136 +
 137 +static struct resource fsg_uart_resources[] = {
 138 +       {
 139 +               .start          = IXP4XX_UART1_BASE_PHYS,
 140 +               .end            = IXP4XX_UART1_BASE_PHYS + 0x0fff,
 141 +               .flags          = IORESOURCE_MEM,
 142 +       },
 143 +       {
 144 +               .start          = IXP4XX_UART2_BASE_PHYS,
 145 +               .end            = IXP4XX_UART2_BASE_PHYS + 0x0fff,
 146 +               .flags          = IORESOURCE_MEM,
 147 +       }
 148 +};
 149 +
 150 +static struct plat_serial8250_port fsg_uart_data[] = {
 151 +       {
 152 +               .mapbase        = IXP4XX_UART1_BASE_PHYS,
 153 +               .membase        = (char *)IXP4XX_UART1_BASE_VIRT + REG_OFFSET,
 154 +               .irq            = IRQ_IXP4XX_UART1,
 155 +               .flags          = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
 156 +               .iotype         = UPIO_MEM,
 157 +               .regshift       = 2,
 158 +               .uartclk        = IXP4XX_UART_XTAL,
 159 +       },
 160 +       {
 161 +               .mapbase        = IXP4XX_UART2_BASE_PHYS,
 162 +               .membase        = (char *)IXP4XX_UART2_BASE_VIRT + REG_OFFSET,
 163 +               .irq            = IRQ_IXP4XX_UART2,
 164 +               .flags          = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
 165 +               .iotype         = UPIO_MEM,
 166 +               .regshift       = 2,
 167 +               .uartclk        = IXP4XX_UART_XTAL,
 168 +       },
 169 +       { }
 170 +};
 171 +
 172 +static struct platform_device fsg_uart = {
 173 +       .name                   = "serial8250",
 174 +       .id                     = PLAT8250_DEV_PLATFORM,
 175 +       .dev.platform_data      = fsg_uart_data,
 176 +       .num_resources          = ARRAY_SIZE(fsg_uart_resources),
 177 +       .resource               = fsg_uart_resources,
 178 +};
 179 +
 180 +static struct platform_device fsg_leds = {
 181 +       .name           = "fsg-led",
 182 +       .id             = -1,
 183 +};
 184 +
 185 +/* Built-in 10/100 Ethernet MAC interfaces */
 186 +static struct eth_plat_info fsg_plat_eth[] = {
 187 +        {
 188 +                .phy            = 5,
 189 +                .rxq            = 3,
 190 +               .txreadyq       = 20,
 191 +        }, {
 192 +                .phy            = 4,
 193 +                .rxq            = 4,
 194 +               .txreadyq       = 21,
 195 +        }
 196 +};
 197 +
 198 +static struct platform_device fsg_eth[] = {
 199 +        {
 200 +                .name                   = "ixp4xx_eth",
 201 +                .id                     = IXP4XX_ETH_NPEB,
 202 +                .dev.platform_data      = fsg_plat_eth,
 203 +        }, {
 204 +                .name                   = "ixp4xx_eth",
 205 +                .id                     = IXP4XX_ETH_NPEC,
 206 +                .dev.platform_data      = fsg_plat_eth + 1,
 207 +        }
 208 +};
 209 +
 210 +static struct platform_device *fsg_devices[] __initdata = {
 211 +       &fsg_i2c_gpio,
 212 +       &fsg_flash,
 213 +       &fsg_leds,
 214 +       &fsg_eth[0],
 215 +       &fsg_eth[1],
 216 +};
 217 +
 218 +static void fsg_power_off(void)
 219 +{
 220 +       printk("Restarting system.\n");
 221 +       machine_restart(NULL);
 222 +}
 223 +
 224 +static void __init fsg_init(void)
 225 +{
 226 +       uint8_t __iomem *f;
 227 +       int i;
 228 +
 229 +       ixp4xx_sys_init();
 230 +
 231 +       pm_power_off = fsg_power_off;
 232 +
 233 +       fsg_flash_resource.start = IXP4XX_EXP_BUS_BASE(0);
 234 +       fsg_flash_resource.end =
 235 +               IXP4XX_EXP_BUS_BASE(0) + ixp4xx_exp_bus_size - 1;
 236 +
 237 +        *IXP4XX_EXP_CS0 |= IXP4XX_FLASH_WRITABLE;
 238 +        *IXP4XX_EXP_CS1 = *IXP4XX_EXP_CS0;
 239 +
 240 +       /* Configure CS2 for operation, 8bit and writable */
 241 +       *IXP4XX_EXP_CS2 = 0xbfff0002;
 242 +
 243 +       /* This is only useful on a modified machine, but it is valuable
 244 +        * to have it first in order to see debug messages, and so that
 245 +        * it does *not* get removed if platform_add_devices fails!
 246 +        */
 247 +       (void)platform_device_register(&fsg_uart);
 248 +
 249 +       platform_add_devices(fsg_devices, ARRAY_SIZE(fsg_devices));
 250 +
 251 +
 252 +       /*
 253 +        * Map in a portion of the flash and read the MAC addresses.
 254 +        * Since it is stored in BE in the flash itself, we need to
 255 +        * byteswap it if we're in LE mode.
 256 +        */
 257 +       if ((f = ioremap(IXP4XX_EXP_BUS_BASE(0), 0x400000))) {
 258 +#ifdef __ARMEB__
 259 +               for (i = 0; i < 6; i++) {
 260 +                       fsg_plat_eth[0].hwaddr[i] = readb(f + 0x3C0422 + i);
 261 +                       fsg_plat_eth[1].hwaddr[i] = readb(f + 0x3C043B + i);
 262 +               }
 263 +#else
 264 +               fsg_plat_eth[0].hwaddr[0] = readb(f + 0x3C0422 + 3);
 265 +               fsg_plat_eth[0].hwaddr[1] = readb(f + 0x3C0422 + 2);
 266 +               fsg_plat_eth[0].hwaddr[2] = readb(f + 0x3C0422 + 1);
 267 +               fsg_plat_eth[0].hwaddr[3] = readb(f + 0x3C0422 + 0);
 268 +               fsg_plat_eth[0].hwaddr[4] = readb(f + 0x3C0422 + 7);
 269 +               fsg_plat_eth[0].hwaddr[5] = readb(f + 0x3C0422 + 6);
 270 +
 271 +               fsg_plat_eth[1].hwaddr[0] = readb(f + 0x3C0422 + 3);
 272 +               fsg_plat_eth[1].hwaddr[1] = readb(f + 0x3C0422 + 2);
 273 +               fsg_plat_eth[1].hwaddr[2] = readb(f + 0x3C0422 + 1);
 274 +               fsg_plat_eth[1].hwaddr[3] = readb(f + 0x3C0422 + 0);
 275 +               fsg_plat_eth[1].hwaddr[4] = readb(f + 0x3C0422 + 7);
 276 +               fsg_plat_eth[1].hwaddr[5] = readb(f + 0x3C0422 + 6);
 277 +#endif
 278 +               iounmap(f);
 279 +       }
 280 +       printk(KERN_INFO "FSG: Using MAC address %.2x:%.2x:%.2x:%.2x:%.2x:%.2x for port 0\n",
 281 +              fsg_plat_eth[0].hwaddr[0], fsg_plat_eth[0].hwaddr[1],
 282 +              fsg_plat_eth[0].hwaddr[2], fsg_plat_eth[0].hwaddr[3],
 283 +              fsg_plat_eth[0].hwaddr[4], fsg_plat_eth[0].hwaddr[5]);
 284 +       printk(KERN_INFO "FSG: Using MAC address %.2x:%.2x:%.2x:%.2x:%.2x:%.2x for port 1\n",
 285 +              fsg_plat_eth[1].hwaddr[0], fsg_plat_eth[1].hwaddr[1],
 286 +              fsg_plat_eth[1].hwaddr[2], fsg_plat_eth[1].hwaddr[3],
 287 +              fsg_plat_eth[1].hwaddr[4], fsg_plat_eth[1].hwaddr[5]);
 288 +
 289 +}
 290 +
 291 +MACHINE_START(FSG, "Freecom FSG-3")
 292 +       /* Maintainer: www.nslu2-linux.org */
 293 +       .phys_io        = IXP4XX_PERIPHERAL_BASE_PHYS,
 294 +       .io_pg_offst    = ((IXP4XX_PERIPHERAL_BASE_VIRT) >> 18) & 0xfffc,
 295 +       .map_io         = ixp4xx_map_io,
 296 +       .init_irq       = ixp4xx_init_irq,
 297 +       .timer          = &ixp4xx_timer,
 298 +       .boot_params    = 0x0100,
 299 +       .init_machine   = fsg_init,
 300 +MACHINE_END
 301 +
 302 Index: linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/Kconfig
 303 ===================================================================
 304 --- linux-2.6.23.12-armeb.orig/arch/arm/mach-ixp4xx/Kconfig     2008-01-11 17:05:08.000000000 +1030
 305 +++ linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/Kconfig  2008-01-11 17:06:33.000000000 +1030
 306 @@ -125,6 +125,15 @@
 307         depends on ARCH_IXDP425 || MACH_IXDP465 || MACH_KIXRP435
 308         default y
 309
 310 +config MACH_FSG
 311 +       bool
 312 +       prompt "Freecom FSG-3"
 313 +       select PCI
 314 +       help
 315 +         Say 'Y' here if you want your kernel to support Freecom's
 316 +         FSG-3 device. For more information on this platform,
 317 +         see http://www.nslu2-linux.org/wiki/FSG3/HomePage
 318 +
 319  #
 320  # Certain registers and IRQs are only enabled if supporting IXP465 CPUs
 321  #
 322 Index: linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/Makefile
 323 ===================================================================
 324 --- linux-2.6.23.12-armeb.orig/arch/arm/mach-ixp4xx/Makefile    2008-01-11 17:05:08.000000000 +1030
 325 +++ linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/Makefile 2008-01-11 17:06:33.000000000 +1030
 326 @@ -15,6 +15,7 @@
 327  obj-pci-$(CONFIG_MACH_DSMG600)         += dsmg600-pci.o
 328  obj-pci-$(CONFIG_MACH_GATEWAY7001)     += gateway7001-pci.o
 329  obj-pci-$(CONFIG_MACH_WG302V2)         += wg302v2-pci.o
 330 +obj-pci-$(CONFIG_MACH_FSG)             += fsg-pci.o
 331
 332  obj-y  += common.o
 333
 334 @@ -28,6 +29,7 @@
 335  obj-$(CONFIG_MACH_DSMG600)      += dsmg600-setup.o dsmg600-power.o
 336  obj-$(CONFIG_MACH_GATEWAY7001) += gateway7001-setup.o
 337  obj-$(CONFIG_MACH_WG302V2)     += wg302v2-setup.o
 338 +obj-$(CONFIG_MACH_FSG)         += fsg-setup.o fsg-power.o
 339
 340  obj-$(CONFIG_PCI)              += $(obj-pci-$(CONFIG_PCI)) common-pci.o
 341  obj-$(CONFIG_IXP4XX_QMGR)      += ixp4xx_qmgr.o
 342 Index: linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/fsg.h
 343 ===================================================================
 344 --- /dev/null   1970-01-01 00:00:00.000000000 +0000
 345 +++ linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/fsg.h     2008-01-11 17:06:33.000000000 +1030
 346 @@ -0,0 +1,50 @@
 347 +/*
 348 + * include/asm-arm/arch-ixp4xx/fsg.h
 349 + *
 350 + * Freecom FSG-3 platform specific definitions
 351 + *
 352 + * Author: Rod Whitby <rod@whitby.id.au>
 353 + * Author: Tomasz Chmielewski <mangoo@wpkg.org>
 354 + * Maintainers: http://www.nslu2-linux.org
 355 + *
 356 + * Based on coyote.h by
 357 + * Copyright 2004 (c) MontaVista, Software, Inc.
 358 + *
 359 + * This file is licensed under  the terms of the GNU General Public
 360 + * License version 2. This program is licensed "as is" without any
 361 + * warranty of any kind, whether express or implied.
 362 + */
 363 +
 364 +#ifndef __ASM_ARCH_HARDWARE_H__
 365 +#error "Do not include this directly, instead #include <asm/hardware.h>"
 366 +#endif
 367 +
 368 +#define FSG_SDA_PIN            12
 369 +#define FSG_SCL_PIN            13
 370 +
 371 +/*
 372 + * FSG PCI IRQs
 373 + */
 374 +#define FSG_PCI_MAX_DEV                3
 375 +#define FSG_PCI_IRQ_LINES      3
 376 +
 377 +
 378 +/* PCI controller GPIO to IRQ pin mappings */
 379 +#define FSG_PCI_INTA_PIN       6
 380 +#define FSG_PCI_INTB_PIN       7
 381 +#define FSG_PCI_INTC_PIN       5
 382 +
 383 +/* Buttons */
 384 +
 385 +#define FSG_SB_GPIO            4       /* sync button */
 386 +#define FSG_RB_GPIO            9       /* reset button */
 387 +#define FSG_UB_GPIO            10      /* usb button */
 388 +
 389 +/* LEDs */
 390 +
 391 +#define FSG_LED_WLAN_BIT       0
 392 +#define FSG_LED_WAN_BIT                1
 393 +#define FSG_LED_SATA_BIT       2
 394 +#define FSG_LED_USB_BIT                4
 395 +#define FSG_LED_RING_BIT       5
 396 +#define FSG_LED_SYNC_BIT       7
 397 Index: linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/hardware.h
 398 ===================================================================
 399 --- linux-2.6.23.12-armeb.orig/include/asm-arm/arch-ixp4xx/hardware.h   2008-01-11 17:05:08.000000000 +1030
 400 +++ linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/hardware.h        2008-01-11 17:06:33.000000000 +1030
 401 @@ -45,5 +45,6 @@
 402  #include "nslu2.h"
 403  #include "nas100d.h"
 404  #include "dsmg600.h"
 405 +#include "fsg.h"
 406
 407  #endif  /* _ASM_ARCH_HARDWARE_H */
 408 Index: linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/irqs.h
 409 ===================================================================
 410 --- linux-2.6.23.12-armeb.orig/include/asm-arm/arch-ixp4xx/irqs.h       2008-01-11 17:05:08.000000000 +1030
 411 +++ linux-2.6.23.12-armeb/include/asm-arm/arch-ixp4xx/irqs.h    2008-01-11 17:06:33.000000000 +1030
 412 @@ -128,4 +128,11 @@
 413  #define        IRQ_DSMG600_PCI_INTE    IRQ_IXP4XX_GPIO7
 414  #define        IRQ_DSMG600_PCI_INTF    IRQ_IXP4XX_GPIO6
 415
 416 +/*
 417 + * Freecom FSG-3 Board IRQs
 418 + */
 419 +#define        IRQ_FSG_PCI_INTA        IRQ_IXP4XX_GPIO6
 420 +#define        IRQ_FSG_PCI_INTB        IRQ_IXP4XX_GPIO7
 421 +#define        IRQ_FSG_PCI_INTC        IRQ_IXP4XX_GPIO5
 422 +
 423  #endif
 424 Index: linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-power.c
 425 ===================================================================
 426 --- /dev/null   1970-01-01 00:00:00.000000000 +0000
 427 +++ linux-2.6.23.12-armeb/arch/arm/mach-ixp4xx/fsg-power.c      2008-01-11 17:06:33.000000000 +1030
 428 @@ -0,0 +1,89 @@
 429 +/*
 430 + * arch/arm/mach-ixp4xx/fsg-power.c
 431 + *
 432 + * FSG Power/Reset driver
 433 + *
 434 + * Copyright (C) 2008 Rod Whitby <rod@whitby.id.au>
 435 + *
 436 + * based on nslu2-power.c
 437 + *  Copyright (C) 2005 Tower Technologies
 438 + *
 439 + * This program is free software; you can redistribute it and/or modify
 440 + * it under the terms of the GNU General Public License version 2 as
 441 + * published by the Free Software Foundation.
 442 + *
 443 + */
 444 +
 445 +#include <linux/module.h>
 446 +#include <linux/reboot.h>
 447 +#include <linux/interrupt.h>
 448 +#include <linux/irq.h>
 449 +#include <linux/jiffies.h>
 450 +#include <linux/timer.h>
 451 +
 452 +#include <asm/gpio.h>
 453 +#include <asm/mach-types.h>
 454 +
 455 +static irqreturn_t fsg_power_handler(int irq, void *dev_id)
 456 +{
 457 +       /* Signal init to do the ctrlaltdel action, this will bypass init if
 458 +        * it hasn't started and do a kernel_restart.
 459 +        */
 460 +       ctrl_alt_del();
 461 +
 462 +       return IRQ_HANDLED;
 463 +}
 464 +
 465 +static irqreturn_t fsg_reset_handler(int irq, void *dev_id)
 466 +{
 467 +       /* This is the paper-clip reset, it shuts the machine down directly.
 468 +        */
 469 +       machine_power_off();
 470 +
 471 +       return IRQ_HANDLED;
 472 +}
 473 +
 474 +static int __init fsg_power_init(void)
 475 +{
 476 +       if (!(machine_is_fsg()))
 477 +               return 0;
 478 +
 479 +       set_irq_type(gpio_to_irq(FSG_RB_GPIO), IRQT_LOW);
 480 +       set_irq_type(gpio_to_irq(FSG_SB_GPIO), IRQT_LOW);
 481 +
 482 +       if (request_irq(gpio_to_irq(FSG_RB_GPIO), &fsg_reset_handler,
 483 +               IRQF_DISABLED, "FSG reset button", NULL) < 0) {
 484 +
 485 +               printk(KERN_DEBUG "Reset Button IRQ %d not available\n",
 486 +                       gpio_to_irq(FSG_RB_GPIO));
 487 +
 488 +               return -EIO;
 489 +       }
 490 +
 491 +       if (request_irq(gpio_to_irq(FSG_SB_GPIO), &fsg_power_handler,
 492 +               IRQF_DISABLED, "FSG power button", NULL) < 0) {
 493 +
 494 +               printk(KERN_DEBUG "Power Button IRQ %d not available\n",
 495 +                       gpio_to_irq(FSG_SB_GPIO));
 496 +
 497 +               return -EIO;
 498 +       }
 499 +
 500 +       return 0;
 501 +}
 502 +
 503 +static void __exit fsg_power_exit(void)
 504 +{
 505 +       if (!(machine_is_fsg()))
 506 +               return;
 507 +
 508 +       free_irq(gpio_to_irq(FSG_SB_GPIO), NULL);
 509 +       free_irq(gpio_to_irq(FSG_RB_GPIO), NULL);
 510 +}
 511 +
 512 +module_init(fsg_power_init);
 513 +module_exit(fsg_power_exit);
 514 +
 515 +MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
 516 +MODULE_DESCRIPTION("FSG Power/Reset driver");
 517 +MODULE_LICENSE("GPL");
 518 Index: linux-2.6.23.12-armeb/drivers/leds/Kconfig
 519 ===================================================================
 520 --- linux-2.6.23.12-armeb.orig/drivers/leds/Kconfig     2008-01-11 17:05:08.000000000 +1030
 521 +++ linux-2.6.23.12-armeb/drivers/leds/Kconfig  2008-01-11 17:06:33.000000000 +1030
 522 @@ -48,6 +48,12 @@
 523           particular board must have LEDs and they must be connected
 524           to the GPIO lines.  If unsure, say Y.
 525
 526 +config LEDS_FSG
 527 +       tristate "LED Support for the Freecom FSG-3"
 528 +       depends on LEDS_CLASS && MACH_FSG
 529 +       help
 530 +         This option enables support for the LEDs on the Freecom FSG-3.
 531 +
 532  config LEDS_TOSA
 533         tristate "LED Support for the Sharp SL-6000 series"
 534         depends on LEDS_CLASS && PXA_SHARPSL
 535 Index: linux-2.6.23.12-armeb/drivers/leds/Makefile
 536 ===================================================================
 537 --- linux-2.6.23.12-armeb.orig/drivers/leds/Makefile    2008-01-11 17:05:08.000000000 +1030
 538 +++ linux-2.6.23.12-armeb/drivers/leds/Makefile 2008-01-11 17:06:33.000000000 +1030
 539 @@ -9,6 +9,7 @@
 540  obj-$(CONFIG_LEDS_LOCOMO)              += leds-locomo.o
 541  obj-$(CONFIG_LEDS_SPITZ)               += leds-spitz.o
 542  obj-$(CONFIG_LEDS_IXP4XX)              += leds-ixp4xx-gpio.o
 543 +obj-$(CONFIG_LEDS_FSG)                 += leds-fsg.o
 544  obj-$(CONFIG_LEDS_TOSA)                        += leds-tosa.o
 545  obj-$(CONFIG_LEDS_S3C24XX)             += leds-s3c24xx.o
 546  obj-$(CONFIG_LEDS_AMS_DELTA)           += leds-ams-delta.o
 547 Index: linux-2.6.23.12-armeb/drivers/leds/leds-fsg.c
 548 ===================================================================
 549 --- /dev/null   1970-01-01 00:00:00.000000000 +0000
 550 +++ linux-2.6.23.12-armeb/drivers/leds/leds-fsg.c       2008-01-11 17:06:33.000000000 +1030
 551 @@ -0,0 +1,243 @@
 552 +/*
 553 + * LED Driver for the Freecom FSG-3
 554 + *
 555 + * Copyright (c) 2008 Rod Whitby <rod@whitby.id.au>
 556 + *
 557 + * Author: Rod Whitby <rod@whitby.id.au>
 558 + *
 559 + * Based on leds-spitz.c
 560 + * Copyright 2005-2006 Openedhand Ltd.
 561 + * Author: Richard Purdie <rpurdie@openedhand.com>
 562 + *
 563 + * This program is free software; you can redistribute it and/or modify
 564 + * it under the terms of the GNU General Public License version 2 as
 565 + * published by the Free Software Foundation.
 566 + *
 567 + */
 568 +
 569 +#include <linux/kernel.h>
 570 +#include <linux/init.h>
 571 +#include <linux/platform_device.h>
 572 +#include <linux/leds.h>
 573 +#include <asm/arch/hardware.h>
 574 +#include <asm/io.h>
 575 +
 576 +static short __iomem *latch_address;
 577 +static unsigned short latch_value;
 578 +
 579 +
 580 +static void fsg_led_wlan_set(struct led_classdev *led_cdev, enum led_brightness value)
 581 +{
 582 +       if (value) {
 583 +               latch_value &= ~(1 << FSG_LED_WLAN_BIT);
 584 +               *latch_address = latch_value;
 585 +       }
 586 +       else {
 587 +               latch_value |=  (1 << FSG_LED_WLAN_BIT);
 588 +               *latch_address = latch_value;
 589 +       }
 590 +}
 591 +
 592 +static void fsg_led_wan_set(struct led_classdev *led_cdev, enum led_brightness value)
 593 +{
 594 +       if (value) {
 595 +               latch_value &= ~(1 << FSG_LED_WAN_BIT);
 596 +               *latch_address = latch_value;
 597 +       }
 598 +       else {
 599 +               latch_value |=  (1 << FSG_LED_WAN_BIT);
 600 +               *latch_address = latch_value;
 601 +       }
 602 +}
 603 +
 604 +static void fsg_led_sata_set(struct led_classdev *led_cdev, enum led_brightness value)
 605 +{
 606 +       if (value) {
 607 +               latch_value &= ~(1 << FSG_LED_SATA_BIT);
 608 +               *latch_address = latch_value;
 609 +       }
 610 +       else {
 611 +               latch_value |=  (1 << FSG_LED_SATA_BIT);
 612 +               *latch_address = latch_value;
 613 +       }
 614 +}
 615 +
 616 +static void fsg_led_usb_set(struct led_classdev *led_cdev, enum led_brightness value)
 617 +{
 618 +       if (value) {
 619 +               latch_value &= ~(1 << FSG_LED_USB_BIT);
 620 +               *latch_address = latch_value;
 621 +       }
 622 +       else {
 623 +               latch_value |=  (1 << FSG_LED_USB_BIT);
 624 +               *latch_address = latch_value;
 625 +       }
 626 +}
 627 +
 628 +static void fsg_led_sync_set(struct led_classdev *led_cdev, enum led_brightness value)
 629 +{
 630 +       if (value) {
 631 +               latch_value &= ~(1 << FSG_LED_SYNC_BIT);
 632 +               *latch_address = latch_value;
 633 +       }
 634 +       else {
 635 +               latch_value |=  (1 << FSG_LED_SYNC_BIT);
 636 +               *latch_address = latch_value;
 637 +       }
 638 +}
 639 +
 640 +static void fsg_led_ring_set(struct led_classdev *led_cdev, enum led_brightness value)
 641 +{
 642 +       if (value) {
 643 +               latch_value &= ~(1 << FSG_LED_RING_BIT);
 644 +               *latch_address = latch_value;
 645 +       }
 646 +       else {
 647 +               latch_value |=  (1 << FSG_LED_RING_BIT);
 648 +               *latch_address = latch_value;
 649 +       }
 650 +}
 651 +
 652 +
 653 +
 654 +static struct led_classdev fsg_wlan_led = {
 655 +       .name                   = "fsg:wlan",
 656 +       .brightness_set         = fsg_led_wlan_set,
 657 +};
 658 +
 659 +static struct led_classdev fsg_wan_led = {
 660 +       .name                   = "fsg:wan",
 661 +       .brightness_set         = fsg_led_wan_set,
 662 +};
 663 +
 664 +static struct led_classdev fsg_sata_led = {
 665 +       .name                   = "fsg:sata",
 666 +       .brightness_set         = fsg_led_sata_set,
 667 +};
 668 +
 669 +static struct led_classdev fsg_usb_led = {
 670 +       .name                   = "fsg:usb",
 671 +       .brightness_set         = fsg_led_usb_set,
 672 +};
 673 +
 674 +static struct led_classdev fsg_sync_led = {
 675 +       .name                   = "fsg:sync",
 676 +       .brightness_set         = fsg_led_sync_set,
 677 +};
 678 +
 679 +static struct led_classdev fsg_ring_led = {
 680 +       .name                   = "fsg:ring",
 681 +       .brightness_set         = fsg_led_ring_set,
 682 +};
 683 +
 684 +
 685 +
 686 +#ifdef CONFIG_PM
 687 +static int fsg_led_suspend(struct platform_device *dev, pm_message_t state)
 688 +{
 689 +       led_classdev_suspend(&fsg_wlan_led);
 690 +       led_classdev_suspend(&fsg_wan_led);
 691 +       led_classdev_suspend(&fsg_sata_led);
 692 +       led_classdev_suspend(&fsg_usb_led);
 693 +       led_classdev_suspend(&fsg_sync_led);
 694 +       led_classdev_suspend(&fsg_ring_led);
 695 +       return 0;
 696 +}
 697 +
 698 +static int fsg_led_resume(struct platform_device *dev)
 699 +{
 700 +       led_classdev_resume(&fsg_wlan_led);
 701 +       led_classdev_resume(&fsg_wan_led);
 702 +       led_classdev_resume(&fsg_sata_led);
 703 +       led_classdev_resume(&fsg_usb_led);
 704 +       led_classdev_resume(&fsg_sync_led);
 705 +       led_classdev_resume(&fsg_ring_led);
 706 +       return 0;
 707 +}
 708 +#endif
 709 +
 710 +
 711 +static int fsg_led_probe(struct platform_device *pdev)
 712 +{
 713 +       int ret;
 714 +
 715 +       /* FIXME: Need to work out how to handle failure below */
 716 +
 717 +       ret = led_classdev_register(&pdev->dev, &fsg_wlan_led);
 718 +       if (ret < 0)
 719 +               return ret;
 720 +
 721 +       ret = led_classdev_register(&pdev->dev, &fsg_wan_led);
 722 +       if (ret < 0)
 723 +               return ret;
 724 +
 725 +       ret = led_classdev_register(&pdev->dev, &fsg_sata_led);
 726 +       if (ret < 0)
 727 +               return ret;
 728 +
 729 +       ret = led_classdev_register(&pdev->dev, &fsg_usb_led);
 730 +       if (ret < 0)
 731 +               return ret;
 732 +
 733 +       ret = led_classdev_register(&pdev->dev, &fsg_sync_led);
 734 +       if (ret < 0)
 735 +               return ret;
 736 +
 737 +       ret = led_classdev_register(&pdev->dev, &fsg_ring_led);
 738 +       if (ret < 0)
 739 +               return ret;
 740 +
 741 +       return ret;
 742 +}
 743 +
 744 +static int fsg_led_remove(struct platform_device *pdev)
 745 +{
 746 +       led_classdev_unregister(&fsg_wlan_led);
 747 +       led_classdev_unregister(&fsg_wan_led);
 748 +       led_classdev_unregister(&fsg_sata_led);
 749 +       led_classdev_unregister(&fsg_usb_led);
 750 +       led_classdev_unregister(&fsg_sync_led);
 751 +       led_classdev_unregister(&fsg_ring_led);
 752 +
 753 +       return 0;
 754 +}
 755 +
 756 +
 757 +static struct platform_driver fsg_led_driver = {
 758 +       .probe          = fsg_led_probe,
 759 +       .remove         = fsg_led_remove,
 760 +#ifdef CONFIG_PM
 761 +       .suspend        = fsg_led_suspend,
 762 +       .resume         = fsg_led_resume,
 763 +#endif
 764 +       .driver         = {
 765 +               .name           = "fsg-led",
 766 +       },
 767 +};
 768 +
 769 +
 770 +static int __init fsg_led_init(void)
 771 +{
 772 +       /* Map the LED chip select address space */
 773 +       latch_address = (unsigned short *) ioremap(IXP4XX_EXP_BUS_BASE(2), 512);
 774 +       if (!latch_address)
 775 +               return -ENOMEM;
 776 +       latch_value = 0xffff;
 777 +       *latch_address = latch_value;
 778 +       /* FIXME: We leak memory if the next line fails */
 779 +       return platform_driver_register(&fsg_led_driver);
 780 +}
 781 +
 782 +static void __exit fsg_led_exit(void)
 783 +{
 784 +       platform_driver_unregister(&fsg_led_driver);
 785 +       iounmap(latch_address);
 786 +}
 787 +
 788 +
 789 +module_init(fsg_led_init);
 790 +module_exit(fsg_led_exit);
 791 +
 792 +MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
 793 +MODULE_DESCRIPTION("Freecom FSG-3 LED driver");
 794 +MODULE_LICENSE("GPL");