projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
bcm47xx: Remove FIXME
[openwrt.git] / target / linux / ixp4xx / patches-2.6.23 / 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");
Personal OpenWRT clone
This page took 0.081699 seconds and 5 git commands to generate.