Hi!

> > tristate "Keyboard blink driver"
> > 
> > ...drivers are not expected to act on their own. I was expecting to
> > get nice /sys/class/led* interface to my keyboard leds.
> > 
> > BTW ... I still believe we should have /sys/class/led* interface to
> > those leds. I'd like to make them blink with hdd activity on some
> > machines... of course, that needs non-buggy KBC.
> 
> I'll take patches. Ofcourse we'll have to keep the current EV_LED interface
> for compatibility.

Actually here's one that does not immediately oops when I plug USB
keyboard in.

Signed-off-by: Pavel Machek <[EMAIL PROTECTED]>

diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
index 87d2046..716620c 100644
--- a/drivers/leds/Kconfig
+++ b/drivers/leds/Kconfig
@@ -95,6 +95,13 @@ config LEDS_COBALT
        help
          This option enables support for the front LED on Cobalt Server
 
+config LEDS_INPUT
+       tristate "LED Support for input layer keyboards"
+       depends on LEDS_CLASS
+       help
+         This option enables support for LEDs on keyboards handled by
+         input layer.
+
 comment "LED Triggers"
 
 config LEDS_TRIGGERS
diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile
index aa2c18e..ea58020 100644
--- a/drivers/leds/Makefile
+++ b/drivers/leds/Makefile
@@ -16,8 +16,10 @@ obj-$(CONFIG_LEDS_NET48XX)           += leds-net4
 obj-$(CONFIG_LEDS_WRAP)                        += leds-wrap.o
 obj-$(CONFIG_LEDS_H1940)               += leds-h1940.o
 obj-$(CONFIG_LEDS_COBALT)              += leds-cobalt.o
+obj-$(CONFIG_LEDS_INPUT)               += leds-input.o
 
 # LED Triggers
 obj-$(CONFIG_LEDS_TRIGGER_TIMER)       += ledtrig-timer.o
 obj-$(CONFIG_LEDS_TRIGGER_IDE_DISK)    += ledtrig-ide-disk.o
 obj-$(CONFIG_LEDS_TRIGGER_HEARTBEAT)   += ledtrig-heartbeat.o
+
diff --git a/drivers/leds/leds-input.c b/drivers/leds/leds-input.c
new file mode 100644
index 0000000..8caca35
--- /dev/null
+++ b/drivers/leds/leds-input.c
@@ -0,0 +1,153 @@
+/*
+ * LED <-> input subsystem glue
+ *
+ * Copyright 2007 Pavel Machek <[EMAIL PROTECTED]>
+ * Copyright 2007 Dmitry Torokhov
+ * Copyright 2005-2006 Openedhand Ltd.
+ *
+ * Author: Pavel Machek <[EMAIL PROTECTED]>
+ * Based on code by: Richard Purdie <[EMAIL PROTECTED]>
+ *                  
+ *
+ * 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/kernel.h>
+#include <linux/init.h>
+#include <linux/platform_device.h>
+#include <linux/leds.h>
+
+#include <linux/module.h>
+#include <linux/input.h>
+#include <linux/slab.h>
+#include <linux/workqueue.h>
+#include <linux/init.h>
+
+struct blinker {
+       struct delayed_work work;
+       struct input_handle handle;
+       int state;
+
+       struct led_classdev dev;
+};
+
+struct blinker *blinker;
+
+static void inputled_set(struct led_classdev *led_cdev, enum led_brightness 
value)
+{
+       struct blinker *blinker = container_of(led_cdev, struct blinker, dev);
+       blinker->state = value;
+       schedule_delayed_work(&blinker->work, 0);
+}
+
+static void blink_task_handler(struct work_struct *work)
+{
+       struct blinker *blinker = container_of(work, struct blinker, work.work);
+       printk("Setting led to %d\n", blinker->state);
+       input_inject_event(&blinker->handle, EV_LED, LED_CAPSL, 
!!blinker->state);
+}
+
+static void blink_event(struct input_handle *handle, unsigned int type,
+                       unsigned int code, int down)
+{
+       /*
+        * This is a very rare handler that does not process any input
+        * events; just injects them.
+        */
+}
+
+static int blink_connect(struct input_handler *handler, struct input_dev *dev,
+                         const struct input_device_id *id)
+{
+       struct input_handle *handle;
+       struct led_classdev *led_dev;
+       static int counter;
+       int error;
+
+       blinker = kzalloc(sizeof(struct blinker), GFP_KERNEL);
+       if (!blinker) {
+               return -ENOMEM;
+       }
+
+       INIT_DELAYED_WORK(&blinker->work, blink_task_handler);
+
+       led_dev = &blinker->dev;
+       led_dev->name = kmalloc(10, GFP_KERNEL);
+       sprintf(led_dev->name, "input%d", counter++);
+       led_dev->brightness_set = inputled_set;
+
+       handle = &blinker->handle;
+       handle->dev = dev;
+       handle->handler = handler;
+       handle->name = "blink";
+       handle->private = blinker;
+
+       error = input_register_handle(handle);
+       if (error)
+               goto err_free_handle;
+
+       error = input_open_device(handle);
+       if (error)
+               goto err_unregister_handle;
+
+       error = led_classdev_register(NULL, led_dev);
+       if (error < 0)
+               goto err_input_close_device;
+
+       return 0;
+
+ err_input_close_device:
+       input_close_device(handle);
+ err_unregister_handle:
+       input_unregister_handle(handle);
+ err_free_handle:
+       kfree(handle);
+       return error;
+}
+
+static void blink_disconnect(struct input_handle *handle)
+{
+       struct blinker *blinker = handle->private;
+
+       led_classdev_unregister(&blinker->dev);
+       cancel_rearming_delayed_work(&blinker->work);
+       input_close_device(handle);
+       input_unregister_handle(handle);
+       kfree(blinker);
+}
+
+static const struct input_device_id blink_ids[] = {
+       {
+               .flags = INPUT_DEVICE_ID_MATCH_EVBIT | 
INPUT_DEVICE_ID_MATCH_LEDBIT,
+               .evbit = { BIT(EV_LED) },
+               .ledbit = { [LONG(LED_CAPSL)] = BIT(LED_CAPSL) },
+       },
+       { }
+};
+
+static struct input_handler blink_handler = {
+       .event          = blink_event,
+       .connect        = blink_connect,
+       .disconnect     = blink_disconnect,
+       .name           = "blink",
+       .id_table       = blink_ids,
+};
+
+static int __init blink_handler_init(void)
+{
+       return input_register_handler(&blink_handler);
+}
+
+static void __exit blink_handler_exit(void)
+{
+       input_unregister_handler(&blink_handler);
+       flush_scheduled_work();
+}
+
+module_init(blink_handler_init);
+module_exit(blink_handler_exit);
+
+
diff --git a/drivers/leds/leds-spitz.c b/drivers/leds/leds-spitz.c
index 126d09c..8d10274 100644
--- a/drivers/leds/leds-spitz.c
+++ b/drivers/leds/leds-spitz.c
@@ -1,5 +1,5 @@
 /*
- * LED Triggers Core
+ * SPITZ LED Driver
  *
  * Copyright 2005-2006 Openedhand Ltd.
  *






-- 
(english) http://www.livejournal.com/~pavelmachek
(cesky, pictures) 
http://atrey.karlin.mff.cuni.cz/~pavel/picture/horses/blog.html
-
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to [EMAIL PROTECTED]
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to