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/