/* * LED Kernel Timer Trigger * * Copyright 2005-2006 Openedhand Ltd. * * Author: Richard Purdie * * 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 #include #include #include #include #include #include #include #include #include #include "leds.h" struct timer_trig_data { unsigned long delay_on; /* milliseconds on */ unsigned long delay_off; /* milliseconds off */ struct timer_list timer; }; static void led_timer_function(unsigned long data) { struct led_classdev *led_cdev = (struct led_classdev *) data; struct timer_trig_data *timer_data = led_cdev->trigger_data; unsigned long brightness = LED_OFF; unsigned long delay = timer_data->delay_off; if (!timer_data->delay_on || !timer_data->delay_off) { led_set_brightness(led_cdev, LED_OFF); return; } if (!led_cdev->brightness) { brightness = LED_FULL; delay = timer_data->delay_on; } led_set_brightness(led_cdev, brightness); mod_timer(&timer_data->timer, jiffies + msecs_to_jiffies(delay)); } static ssize_t led_delay_on_show(struct class_device *dev, char *buf) { struct led_classdev *led_cdev = class_get_devdata(dev); struct timer_trig_data *timer_data = led_cdev->trigger_data; sprintf(buf, "%lu\n", timer_data->delay_on); return strlen(buf) + 1; } static ssize_t led_delay_on_store(struct class_device *dev, const char *buf, size_t size) { struct led_classdev *led_cdev = class_get_devdata(dev); struct timer_trig_data *timer_data = led_cdev->trigger_data; int ret = -EINVAL; char *after; unsigned long state = simple_strtoul(buf, &after, 10); size_t count = after - buf; if (*after && isspace(*after)) count++; if (count == size) { timer_data->delay_on = state; mod_timer(&timer_data->timer, jiffies + 1); ret = count; } return ret; } static ssize_t led_delay_off_show(struct class_device *dev, char *buf) { struct led_classdev *led_cdev = class_get_devdata(dev); struct timer_trig_data *timer_data = led_cdev->trigger_data; sprintf(buf, "%lu\n", timer_data->delay_off); return strlen(buf) + 1; } static ssize_t led_delay_off_store(struct class_device *dev, const char *buf, size_t size) { struct led_classdev *led_cdev = class_get_devdata(dev); struct timer_trig_data *timer_data = led_cdev->trigger_data; int ret = -EINVAL; char *after; unsigned long state = simple_strtoul(buf, &after, 10); size_t count = after - buf; if (*after && isspace(*after)) count++; if (count == size) { timer_data->delay_off = state; mod_timer(&timer_data->timer, jiffies + 1); ret = count; } return ret; } static CLASS_DEVICE_ATTR(delay_on, 0644, led_delay_on_show, led_delay_on_store); static CLASS_DEVICE_ATTR(delay_off, 0644, led_delay_off_show, led_delay_off_store); static void timer_trig_activate(struct led_classdev *led_cdev) { struct timer_trig_data *timer_data; timer_data = kzalloc(sizeof(struct timer_trig_data), GFP_KERNEL); if (!timer_data) return; led_cdev->trigger_data = timer_data; init_timer(&timer_data->timer); timer_data->timer.function = led_timer_function; timer_data->timer.data = (unsigned long) led_cdev; class_device_create_file(led_cdev->class_dev, &class_device_attr_delay_on); class_device_create_file(led_cdev->class_dev, &class_device_attr_delay_off); } static void timer_trig_deactivate(struct led_classdev *led_cdev) { struct timer_trig_data *timer_data = led_cdev->trigger_data; if (timer_data) { class_device_remove_file(led_cdev->class_dev, &class_device_attr_delay_on); class_device_remove_file(led_cdev->class_dev, &class_device_attr_delay_off); del_timer_sync(&timer_data->timer); kfree(timer_data); } } static struct led_trigger timer_led_trigger = { .name = "timer", .activate = timer_trig_activate, .deactivate = timer_trig_deactivate, }; static int __init timer_trig_init(void) { return led_trigger_register(&timer_led_trigger); } static void __exit timer_trig_exit(void) { led_trigger_unregister(&timer_led_trigger); } module_init(timer_trig_init); module_exit(timer_trig_exit); MODULE_AUTHOR("Richard Purdie "); MODULE_DESCRIPTION("Timer LED trigger"); MODULE_LICENSE("GPL");