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

   1 Index: linux-2.6.23.17/arch/arm/mach-ixp4xx/fsg-pci.c
   2 ===================================================================
   3 --- /dev/null
   4 +++ linux-2.6.23.17/arch/arm/mach-ixp4xx/fsg-pci.c
   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.17/arch/arm/mach-ixp4xx/fsg-setup.c
  78 ===================================================================
  79 --- /dev/null
  80 +++ linux-2.6.23.17/arch/arm/mach-ixp4xx/fsg-setup.c
  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.17/arch/arm/mach-ixp4xx/Kconfig
 303 ===================================================================
 304 --- linux-2.6.23.17.orig/arch/arm/mach-ixp4xx/Kconfig
 305 +++ linux-2.6.23.17/arch/arm/mach-ixp4xx/Kconfig
 306 @@ -125,6 +125,15 @@ config     ARCH_IXDP4XX
 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.17/arch/arm/mach-ixp4xx/Makefile
 323 ===================================================================
 324 --- linux-2.6.23.17.orig/arch/arm/mach-ixp4xx/Makefile
 325 +++ linux-2.6.23.17/arch/arm/mach-ixp4xx/Makefile
 326 @@ -15,6 +15,7 @@ obj-pci-$(CONFIG_MACH_NAS100D)                += nas10
 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,5 +29,6 @@ obj-$(CONFIG_MACH_NAS100D)    += nas100d-se
 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 Index: linux-2.6.23.17/include/asm-arm/arch-ixp4xx/fsg.h
 342 ===================================================================
 343 --- /dev/null
 344 +++ linux-2.6.23.17/include/asm-arm/arch-ixp4xx/fsg.h
 345 @@ -0,0 +1,50 @@
 346 +/*
 347 + * include/asm-arm/arch-ixp4xx/fsg.h
 348 + *
 349 + * Freecom FSG-3 platform specific definitions
 350 + *
 351 + * Author: Rod Whitby <rod@whitby.id.au>
 352 + * Author: Tomasz Chmielewski <mangoo@wpkg.org>
 353 + * Maintainers: http://www.nslu2-linux.org
 354 + *
 355 + * Based on coyote.h by
 356 + * Copyright 2004 (c) MontaVista, Software, Inc.
 357 + *
 358 + * This file is licensed under  the terms of the GNU General Public
 359 + * License version 2. This program is licensed "as is" without any
 360 + * warranty of any kind, whether express or implied.
 361 + */
 362 +
 363 +#ifndef __ASM_ARCH_HARDWARE_H__
 364 +#error "Do not include this directly, instead #include <asm/hardware.h>"
 365 +#endif
 366 +
 367 +#define FSG_SDA_PIN            12
 368 +#define FSG_SCL_PIN            13
 369 +
 370 +/*
 371 + * FSG PCI IRQs
 372 + */
 373 +#define FSG_PCI_MAX_DEV                3
 374 +#define FSG_PCI_IRQ_LINES      3
 375 +
 376 +
 377 +/* PCI controller GPIO to IRQ pin mappings */
 378 +#define FSG_PCI_INTA_PIN       6
 379 +#define FSG_PCI_INTB_PIN       7
 380 +#define FSG_PCI_INTC_PIN       5
 381 +
 382 +/* Buttons */
 383 +
 384 +#define FSG_SB_GPIO            4       /* sync button */
 385 +#define FSG_RB_GPIO            9       /* reset button */
 386 +#define FSG_UB_GPIO            10      /* usb button */
 387 +
 388 +/* LEDs */
 389 +
 390 +#define FSG_LED_WLAN_BIT       0
 391 +#define FSG_LED_WAN_BIT                1
 392 +#define FSG_LED_SATA_BIT       2
 393 +#define FSG_LED_USB_BIT                4
 394 +#define FSG_LED_RING_BIT       5
 395 +#define FSG_LED_SYNC_BIT       7
 396 Index: linux-2.6.23.17/include/asm-arm/arch-ixp4xx/hardware.h
 397 ===================================================================
 398 --- linux-2.6.23.17.orig/include/asm-arm/arch-ixp4xx/hardware.h
 399 +++ linux-2.6.23.17/include/asm-arm/arch-ixp4xx/hardware.h
 400 @@ -45,5 +45,6 @@
 401  #include "nslu2.h"
 402  #include "nas100d.h"
 403  #include "dsmg600.h"
 404 +#include "fsg.h"
 405
 406  #endif  /* _ASM_ARCH_HARDWARE_H */
 407 Index: linux-2.6.23.17/include/asm-arm/arch-ixp4xx/irqs.h
 408 ===================================================================
 409 --- linux-2.6.23.17.orig/include/asm-arm/arch-ixp4xx/irqs.h
 410 +++ linux-2.6.23.17/include/asm-arm/arch-ixp4xx/irqs.h
 411 @@ -128,4 +128,11 @@
 412  #define        IRQ_DSMG600_PCI_INTE    IRQ_IXP4XX_GPIO7
 413  #define        IRQ_DSMG600_PCI_INTF    IRQ_IXP4XX_GPIO6
 414
 415 +/*
 416 + * Freecom FSG-3 Board IRQs
 417 + */
 418 +#define        IRQ_FSG_PCI_INTA        IRQ_IXP4XX_GPIO6
 419 +#define        IRQ_FSG_PCI_INTB        IRQ_IXP4XX_GPIO7
 420 +#define        IRQ_FSG_PCI_INTC        IRQ_IXP4XX_GPIO5
 421 +
 422  #endif
 423 Index: linux-2.6.23.17/arch/arm/mach-ixp4xx/fsg-power.c
 424 ===================================================================
 425 --- /dev/null
 426 +++ linux-2.6.23.17/arch/arm/mach-ixp4xx/fsg-power.c
 427 @@ -0,0 +1,89 @@
 428 +/*
 429 + * arch/arm/mach-ixp4xx/fsg-power.c
 430 + *
 431 + * FSG Power/Reset driver
 432 + *
 433 + * Copyright (C) 2008 Rod Whitby <rod@whitby.id.au>
 434 + *
 435 + * based on nslu2-power.c
 436 + *  Copyright (C) 2005 Tower Technologies
 437 + *
 438 + * This program is free software; you can redistribute it and/or modify
 439 + * it under the terms of the GNU General Public License version 2 as
 440 + * published by the Free Software Foundation.
 441 + *
 442 + */
 443 +
 444 +#include <linux/module.h>
 445 +#include <linux/reboot.h>
 446 +#include <linux/interrupt.h>
 447 +#include <linux/irq.h>
 448 +#include <linux/jiffies.h>
 449 +#include <linux/timer.h>
 450 +
 451 +#include <asm/gpio.h>
 452 +#include <asm/mach-types.h>
 453 +
 454 +static irqreturn_t fsg_power_handler(int irq, void *dev_id)
 455 +{
 456 +       /* Signal init to do the ctrlaltdel action, this will bypass init if
 457 +        * it hasn't started and do a kernel_restart.
 458 +        */
 459 +       ctrl_alt_del();
 460 +
 461 +       return IRQ_HANDLED;
 462 +}
 463 +
 464 +static irqreturn_t fsg_reset_handler(int irq, void *dev_id)
 465 +{
 466 +       /* This is the paper-clip reset, it shuts the machine down directly.
 467 +        */
 468 +       machine_power_off();
 469 +
 470 +       return IRQ_HANDLED;
 471 +}
 472 +
 473 +static int __init fsg_power_init(void)
 474 +{
 475 +       if (!(machine_is_fsg()))
 476 +               return 0;
 477 +
 478 +       set_irq_type(gpio_to_irq(FSG_RB_GPIO), IRQT_LOW);
 479 +       set_irq_type(gpio_to_irq(FSG_SB_GPIO), IRQT_LOW);
 480 +
 481 +       if (request_irq(gpio_to_irq(FSG_RB_GPIO), &fsg_reset_handler,
 482 +               IRQF_DISABLED, "FSG reset button", NULL) < 0) {
 483 +
 484 +               printk(KERN_DEBUG "Reset Button IRQ %d not available\n",
 485 +                       gpio_to_irq(FSG_RB_GPIO));
 486 +
 487 +               return -EIO;
 488 +       }
 489 +
 490 +       if (request_irq(gpio_to_irq(FSG_SB_GPIO), &fsg_power_handler,
 491 +               IRQF_DISABLED, "FSG power button", NULL) < 0) {
 492 +
 493 +               printk(KERN_DEBUG "Power Button IRQ %d not available\n",
 494 +                       gpio_to_irq(FSG_SB_GPIO));
 495 +
 496 +               return -EIO;
 497 +       }
 498 +
 499 +       return 0;
 500 +}
 501 +
 502 +static void __exit fsg_power_exit(void)
 503 +{
 504 +       if (!(machine_is_fsg()))
 505 +               return;
 506 +
 507 +       free_irq(gpio_to_irq(FSG_SB_GPIO), NULL);
 508 +       free_irq(gpio_to_irq(FSG_RB_GPIO), NULL);
 509 +}
 510 +
 511 +module_init(fsg_power_init);
 512 +module_exit(fsg_power_exit);
 513 +
 514 +MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
 515 +MODULE_DESCRIPTION("FSG Power/Reset driver");
 516 +MODULE_LICENSE("GPL");
 517 Index: linux-2.6.23.17/drivers/leds/Kconfig
 518 ===================================================================
 519 --- linux-2.6.23.17.orig/drivers/leds/Kconfig
 520 +++ linux-2.6.23.17/drivers/leds/Kconfig
 521 @@ -48,6 +48,12 @@ config LEDS_IXP4XX
 522           particular board must have LEDs and they must be connected
 523           to the GPIO lines.  If unsure, say Y.
 524
 525 +config LEDS_FSG
 526 +       tristate "LED Support for the Freecom FSG-3"
 527 +       depends on LEDS_CLASS && MACH_FSG
 528 +       help
 529 +         This option enables support for the LEDs on the Freecom FSG-3.
 530 +
 531  config LEDS_TOSA
 532         tristate "LED Support for the Sharp SL-6000 series"
 533         depends on LEDS_CLASS && PXA_SHARPSL
 534 Index: linux-2.6.23.17/drivers/leds/Makefile
 535 ===================================================================
 536 --- linux-2.6.23.17.orig/drivers/leds/Makefile
 537 +++ linux-2.6.23.17/drivers/leds/Makefile
 538 @@ -9,6 +9,7 @@ obj-$(CONFIG_LEDS_CORGI)                += leds-corgi.
 539  obj-$(CONFIG_LEDS_LOCOMO)              += leds-locomo.o
 540  obj-$(CONFIG_LEDS_SPITZ)               += leds-spitz.o
 541  obj-$(CONFIG_LEDS_IXP4XX)              += leds-ixp4xx-gpio.o
 542 +obj-$(CONFIG_LEDS_FSG)                 += leds-fsg.o
 543  obj-$(CONFIG_LEDS_TOSA)                        += leds-tosa.o
 544  obj-$(CONFIG_LEDS_S3C24XX)             += leds-s3c24xx.o
 545  obj-$(CONFIG_LEDS_AMS_DELTA)           += leds-ams-delta.o
 546 Index: linux-2.6.23.17/drivers/leds/leds-fsg.c
 547 ===================================================================
 548 --- /dev/null
 549 +++ linux-2.6.23.17/drivers/leds/leds-fsg.c
 550 @@ -0,0 +1,243 @@
 551 +/*
 552 + * LED Driver for the Freecom FSG-3
 553 + *
 554 + * Copyright (c) 2008 Rod Whitby <rod@whitby.id.au>
 555 + *
 556 + * Author: Rod Whitby <rod@whitby.id.au>
 557 + *
 558 + * Based on leds-spitz.c
 559 + * Copyright 2005-2006 Openedhand Ltd.
 560 + * Author: Richard Purdie <rpurdie@openedhand.com>
 561 + *
 562 + * This program is free software; you can redistribute it and/or modify
 563 + * it under the terms of the GNU General Public License version 2 as
 564 + * published by the Free Software Foundation.
 565 + *
 566 + */
 567 +
 568 +#include <linux/kernel.h>
 569 +#include <linux/init.h>
 570 +#include <linux/platform_device.h>
 571 +#include <linux/leds.h>
 572 +#include <asm/arch/hardware.h>
 573 +#include <asm/io.h>
 574 +
 575 +static short __iomem *latch_address;
 576 +static unsigned short latch_value;
 577 +
 578 +
 579 +static void fsg_led_wlan_set(struct led_classdev *led_cdev, enum led_brightness value)
 580 +{
 581 +       if (value) {
 582 +               latch_value &= ~(1 << FSG_LED_WLAN_BIT);
 583 +               *latch_address = latch_value;
 584 +       }
 585 +       else {
 586 +               latch_value |=  (1 << FSG_LED_WLAN_BIT);
 587 +               *latch_address = latch_value;
 588 +       }
 589 +}
 590 +
 591 +static void fsg_led_wan_set(struct led_classdev *led_cdev, enum led_brightness value)
 592 +{
 593 +       if (value) {
 594 +               latch_value &= ~(1 << FSG_LED_WAN_BIT);
 595 +               *latch_address = latch_value;
 596 +       }
 597 +       else {
 598 +               latch_value |=  (1 << FSG_LED_WAN_BIT);
 599 +               *latch_address = latch_value;
 600 +       }
 601 +}
 602 +
 603 +static void fsg_led_sata_set(struct led_classdev *led_cdev, enum led_brightness value)
 604 +{
 605 +       if (value) {
 606 +               latch_value &= ~(1 << FSG_LED_SATA_BIT);
 607 +               *latch_address = latch_value;
 608 +       }
 609 +       else {
 610 +               latch_value |=  (1 << FSG_LED_SATA_BIT);
 611 +               *latch_address = latch_value;
 612 +       }
 613 +}
 614 +
 615 +static void fsg_led_usb_set(struct led_classdev *led_cdev, enum led_brightness value)
 616 +{
 617 +       if (value) {
 618 +               latch_value &= ~(1 << FSG_LED_USB_BIT);
 619 +               *latch_address = latch_value;
 620 +       }
 621 +       else {
 622 +               latch_value |=  (1 << FSG_LED_USB_BIT);
 623 +               *latch_address = latch_value;
 624 +       }
 625 +}
 626 +
 627 +static void fsg_led_sync_set(struct led_classdev *led_cdev, enum led_brightness value)
 628 +{
 629 +       if (value) {
 630 +               latch_value &= ~(1 << FSG_LED_SYNC_BIT);
 631 +               *latch_address = latch_value;
 632 +       }
 633 +       else {
 634 +               latch_value |=  (1 << FSG_LED_SYNC_BIT);
 635 +               *latch_address = latch_value;
 636 +       }
 637 +}
 638 +
 639 +static void fsg_led_ring_set(struct led_classdev *led_cdev, enum led_brightness value)
 640 +{
 641 +       if (value) {
 642 +               latch_value &= ~(1 << FSG_LED_RING_BIT);
 643 +               *latch_address = latch_value;
 644 +       }
 645 +       else {
 646 +               latch_value |=  (1 << FSG_LED_RING_BIT);
 647 +               *latch_address = latch_value;
 648 +       }
 649 +}
 650 +
 651 +
 652 +
 653 +static struct led_classdev fsg_wlan_led = {
 654 +       .name                   = "fsg:wlan",
 655 +       .brightness_set         = fsg_led_wlan_set,
 656 +};
 657 +
 658 +static struct led_classdev fsg_wan_led = {
 659 +       .name                   = "fsg:wan",
 660 +       .brightness_set         = fsg_led_wan_set,
 661 +};
 662 +
 663 +static struct led_classdev fsg_sata_led = {
 664 +       .name                   = "fsg:sata",
 665 +       .brightness_set         = fsg_led_sata_set,
 666 +};
 667 +
 668 +static struct led_classdev fsg_usb_led = {
 669 +       .name                   = "fsg:usb",
 670 +       .brightness_set         = fsg_led_usb_set,
 671 +};
 672 +
 673 +static struct led_classdev fsg_sync_led = {
 674 +       .name                   = "fsg:sync",
 675 +       .brightness_set         = fsg_led_sync_set,
 676 +};
 677 +
 678 +static struct led_classdev fsg_ring_led = {
 679 +       .name                   = "fsg:ring",
 680 +       .brightness_set         = fsg_led_ring_set,
 681 +};
 682 +
 683 +
 684 +
 685 +#ifdef CONFIG_PM
 686 +static int fsg_led_suspend(struct platform_device *dev, pm_message_t state)
 687 +{
 688 +       led_classdev_suspend(&fsg_wlan_led);
 689 +       led_classdev_suspend(&fsg_wan_led);
 690 +       led_classdev_suspend(&fsg_sata_led);
 691 +       led_classdev_suspend(&fsg_usb_led);
 692 +       led_classdev_suspend(&fsg_sync_led);
 693 +       led_classdev_suspend(&fsg_ring_led);
 694 +       return 0;
 695 +}
 696 +
 697 +static int fsg_led_resume(struct platform_device *dev)
 698 +{
 699 +       led_classdev_resume(&fsg_wlan_led);
 700 +       led_classdev_resume(&fsg_wan_led);
 701 +       led_classdev_resume(&fsg_sata_led);
 702 +       led_classdev_resume(&fsg_usb_led);
 703 +       led_classdev_resume(&fsg_sync_led);
 704 +       led_classdev_resume(&fsg_ring_led);
 705 +       return 0;
 706 +}
 707 +#endif
 708 +
 709 +
 710 +static int fsg_led_probe(struct platform_device *pdev)
 711 +{
 712 +       int ret;
 713 +
 714 +       /* FIXME: Need to work out how to handle failure below */
 715 +
 716 +       ret = led_classdev_register(&pdev->dev, &fsg_wlan_led);
 717 +       if (ret < 0)
 718 +               return ret;
 719 +
 720 +       ret = led_classdev_register(&pdev->dev, &fsg_wan_led);
 721 +       if (ret < 0)
 722 +               return ret;
 723 +
 724 +       ret = led_classdev_register(&pdev->dev, &fsg_sata_led);
 725 +       if (ret < 0)
 726 +               return ret;
 727 +
 728 +       ret = led_classdev_register(&pdev->dev, &fsg_usb_led);
 729 +       if (ret < 0)
 730 +               return ret;
 731 +
 732 +       ret = led_classdev_register(&pdev->dev, &fsg_sync_led);
 733 +       if (ret < 0)
 734 +               return ret;
 735 +
 736 +       ret = led_classdev_register(&pdev->dev, &fsg_ring_led);
 737 +       if (ret < 0)
 738 +               return ret;
 739 +
 740 +       return ret;
 741 +}
 742 +
 743 +static int fsg_led_remove(struct platform_device *pdev)
 744 +{
 745 +       led_classdev_unregister(&fsg_wlan_led);
 746 +       led_classdev_unregister(&fsg_wan_led);
 747 +       led_classdev_unregister(&fsg_sata_led);
 748 +       led_classdev_unregister(&fsg_usb_led);
 749 +       led_classdev_unregister(&fsg_sync_led);
 750 +       led_classdev_unregister(&fsg_ring_led);
 751 +
 752 +       return 0;
 753 +}
 754 +
 755 +
 756 +static struct platform_driver fsg_led_driver = {
 757 +       .probe          = fsg_led_probe,
 758 +       .remove         = fsg_led_remove,
 759 +#ifdef CONFIG_PM
 760 +       .suspend        = fsg_led_suspend,
 761 +       .resume         = fsg_led_resume,
 762 +#endif
 763 +       .driver         = {
 764 +               .name           = "fsg-led",
 765 +       },
 766 +};
 767 +
 768 +
 769 +static int __init fsg_led_init(void)
 770 +{
 771 +       /* Map the LED chip select address space */
 772 +       latch_address = (unsigned short *) ioremap(IXP4XX_EXP_BUS_BASE(2), 512);
 773 +       if (!latch_address)
 774 +               return -ENOMEM;
 775 +       latch_value = 0xffff;
 776 +       *latch_address = latch_value;
 777 +       /* FIXME: We leak memory if the next line fails */
 778 +       return platform_driver_register(&fsg_led_driver);
 779 +}
 780 +
 781 +static void __exit fsg_led_exit(void)
 782 +{
 783 +       platform_driver_unregister(&fsg_led_driver);
 784 +       iounmap(latch_address);
 785 +}
 786 +
 787 +
 788 +module_init(fsg_led_init);
 789 +module_exit(fsg_led_exit);
 790 +
 791 +MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
 792 +MODULE_DESCRIPTION("Freecom FSG-3 LED driver");
 793 +MODULE_LICENSE("GPL");