[PATCH] LED: add device support for tosa

Adds LED drivers for LEDs found on the Sharp Zaurus c6000 model (tosa).

Signed-off-by: Dirk Opfer <dirk@opfer-online.de>
Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
Cc: Russell King <rmk@arm.linux.org.uk>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>

diff --git a/arch/arm/mach-pxa/tosa.c b/arch/arm/mach-pxa/tosa.c
index 66ec717..76c0e7f 100644 (file)
--- a/arch/arm/mach-pxa/tosa.c
+++ b/arch/arm/mach-pxa/tosa.c
@@ -251,10 +251,19 @@ static struct platform_device tosakbd_device = {
        .id             = -1,
 };
 
        .id             = -1,
 };
 

+/*
+ * Tosa LEDs
+ */
+static struct platform_device tosaled_device = {
+    .name   = "tosa-led",
+    .id     = -1,
+};
+

 static struct platform_device *devices[] __initdata = {
        &tosascoop_device,
        &tosascoop_jc_device,
        &tosakbd_device,
 static struct platform_device *devices[] __initdata = {
        &tosascoop_device,
        &tosascoop_jc_device,
        &tosakbd_device,

+       &tosaled_device,

 };
 
 static void __init tosa_init(void)
 };
 
 static void __init tosa_init(void)

diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
index d9e2f98..64dcdd3 100644 (file)
--- a/drivers/leds/Kconfig
+++ b/drivers/leds/Kconfig
@@ -52,6 +52,13 @@ config LEDS_IXP4XX
          particular board must have LEDs and they must be connected
          to the GPIO lines.  If unsure, say Y.
 
          particular board must have LEDs and they must be connected
          to the GPIO lines.  If unsure, say Y.
 

+config LEDS_TOSA
+       tristate "LED Support for the Sharp SL-6000 series"
+       depends LEDS_CLASS && PXA_SHARPSL
+       help
+         This option enables support for the LEDs on Sharp Zaurus
+         SL-6000 series.
+

 config LEDS_TRIGGER_TIMER
        tristate "LED Timer Trigger"
        depends LEDS_TRIGGERS
 config LEDS_TRIGGER_TIMER
        tristate "LED Timer Trigger"
        depends LEDS_TRIGGERS

diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile
index b1187c0..9d2930f 100644 (file)
--- a/drivers/leds/Makefile
+++ b/drivers/leds/Makefile
@@ -9,6 +9,7 @@ obj-$(CONFIG_LEDS_CORGI)                += leds-corgi.o
 obj-$(CONFIG_LEDS_LOCOMO)              += leds-locomo.o
 obj-$(CONFIG_LEDS_SPITZ)               += leds-spitz.o
 obj-$(CONFIG_LEDS_IXP4XX)              += leds-ixp4xx-gpio.o
 obj-$(CONFIG_LEDS_LOCOMO)              += leds-locomo.o
 obj-$(CONFIG_LEDS_SPITZ)               += leds-spitz.o
 obj-$(CONFIG_LEDS_IXP4XX)              += leds-ixp4xx-gpio.o

+obj-$(CONFIG_LEDS_TOSA)                        += leds-tosa.o

 
 # LED Triggers
 obj-$(CONFIG_LEDS_TRIGGER_TIMER)       += ledtrig-timer.o
 
 # LED Triggers
 obj-$(CONFIG_LEDS_TRIGGER_TIMER)       += ledtrig-timer.o

diff --git a/drivers/leds/leds-tosa.c b/drivers/leds/leds-tosa.c
new file mode 100644 (file)
index 0000000..c9e8cc1
--- /dev/null
+++ b/drivers/leds/leds-tosa.c
@@ -0,0 +1,131 @@
+/*
+ * LED Triggers Core
+ *
+ * Copyright 2005 Dirk Opfer
+ *
+ * Author: Dirk Opfer <Dirk@Opfer-Online.de>
+ *     based on spitz.c
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ */
+
+#include <linux/config.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/platform_device.h>
+#include <linux/leds.h>
+#include <asm/hardware/scoop.h>
+#include <asm/mach-types.h>
+#include <asm/arch/hardware.h>
+#include <asm/arch/pxa-regs.h>
+#include <asm/arch/tosa.h>
+
+static void tosaled_amber_set(struct led_classdev *led_cdev,
+                               enum led_brightness value)
+{
+       if (value)
+               set_scoop_gpio(&tosascoop_jc_device.dev,
+                               TOSA_SCOOP_JC_CHRG_ERR_LED);
+       else
+               reset_scoop_gpio(&tosascoop_jc_device.dev,
+                               TOSA_SCOOP_JC_CHRG_ERR_LED);
+}
+
+static void tosaled_green_set(struct led_classdev *led_cdev,
+                               enum led_brightness value)
+{
+       if (value)
+               set_scoop_gpio(&tosascoop_jc_device.dev,
+                               TOSA_SCOOP_JC_NOTE_LED);
+       else
+               reset_scoop_gpio(&tosascoop_jc_device.dev,
+                               TOSA_SCOOP_JC_NOTE_LED);
+}
+
+static struct led_classdev tosa_amber_led = {
+       .name                   = "tosa:amber",
+       .default_trigger        = "sharpsl-charge",
+       .brightness_set         = tosaled_amber_set,
+};
+
+static struct led_classdev tosa_green_led = {
+       .name                   = "tosa:green",
+       .default_trigger        = "nand-disk",
+       .brightness_set         = tosaled_green_set,
+};
+
+#ifdef CONFIG_PM
+static int tosaled_suspend(struct platform_device *dev, pm_message_t state)
+{
+#ifdef CONFIG_LEDS_TRIGGERS
+       if (tosa_amber_led.trigger && strcmp(tosa_amber_led.trigger->name,
+                                               "sharpsl-charge"))
+#endif
+               led_classdev_suspend(&tosa_amber_led);
+       led_classdev_suspend(&tosa_green_led);
+       return 0;
+}
+
+static int tosaled_resume(struct platform_device *dev)
+{
+       led_classdev_resume(&tosa_amber_led);
+       led_classdev_resume(&tosa_green_led);
+       return 0;
+}
+#else
+#define tosaled_suspend NULL
+#define tosaled_resume NULL
+#endif
+
+static int tosaled_probe(struct platform_device *pdev)
+{
+       int ret;
+
+       ret = led_classdev_register(&pdev->dev, &tosa_amber_led);
+       if (ret < 0)
+               return ret;
+
+       ret = led_classdev_register(&pdev->dev, &tosa_green_led);
+       if (ret < 0)
+               led_classdev_unregister(&tosa_amber_led);
+
+       return ret;
+}
+
+static int tosaled_remove(struct platform_device *pdev)
+{
+       led_classdev_unregister(&tosa_amber_led);
+       led_classdev_unregister(&tosa_green_led);
+
+       return 0;
+}
+
+static struct platform_driver tosaled_driver = {
+       .probe          = tosaled_probe,
+       .remove         = tosaled_remove,
+       .suspend        = tosaled_suspend,
+       .resume         = tosaled_resume,
+       .driver         = {
+               .name           = "tosa-led",
+       },
+};
+
+static int __init tosaled_init(void)
+{
+       return platform_driver_register(&tosaled_driver);
+}
+
+static void __exit tosaled_exit(void)
+{
+       platform_driver_unregister(&tosaled_driver);
+}
+
+module_init(tosaled_init);
+module_exit(tosaled_exit);
+
+MODULE_AUTHOR("Dirk Opfer <Dirk@Opfer-Online.de>");
+MODULE_DESCRIPTION("Tosa LED driver");
+MODULE_LICENSE("GPL");