Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 1 | /* |
| 2 | * LED Kernel Timer Trigger |
| 3 | * |
| 4 | * Copyright 2005-2006 Openedhand Ltd. |
| 5 | * |
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License version 2 as |
| 10 | * published by the Free Software Foundation. |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 11 | */ |
| 12 | |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 13 | #include <linux/module.h> |
| 14 | #include <linux/kernel.h> |
| 15 | #include <linux/init.h> |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 16 | #include <linux/device.h> |
Richard Purdie | 3dc7b82 | 2006-05-15 09:44:17 -0700 | [diff] [blame] | 17 | #include <linux/ctype.h> |
Krzysztof Kozlowski | 0f85e849 | 2019-01-09 15:44:49 +0100 | [diff] [blame] | 18 | #include <linux/slab.h> |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 19 | #include <linux/leds.h> |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 20 | |
Németh Márton | 4d404fd | 2008-03-09 20:59:57 +0000 | [diff] [blame] | 21 | static ssize_t led_delay_on_show(struct device *dev, |
Richard Purdie | f8a7c6f | 2007-07-08 23:19:31 +0100 | [diff] [blame] | 22 | struct device_attribute *attr, char *buf) |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 23 | { |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 24 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 25 | |
Johannes Berg | 5ada28b | 2010-11-11 14:05:21 -0800 | [diff] [blame] | 26 | return sprintf(buf, "%lu\n", led_cdev->blink_delay_on); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 27 | } |
| 28 | |
Németh Márton | 4d404fd | 2008-03-09 20:59:57 +0000 | [diff] [blame] | 29 | static ssize_t led_delay_on_store(struct device *dev, |
Richard Purdie | f8a7c6f | 2007-07-08 23:19:31 +0100 | [diff] [blame] | 30 | struct device_attribute *attr, const char *buf, size_t size) |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 31 | { |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 32 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 33 | unsigned long state; |
| 34 | ssize_t ret = -EINVAL; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 35 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 36 | ret = kstrtoul(buf, 10, &state); |
| 37 | if (ret) |
| 38 | return ret; |
Richard Purdie | 3dc7b82 | 2006-05-15 09:44:17 -0700 | [diff] [blame] | 39 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 40 | led_blink_set(led_cdev, &state, &led_cdev->blink_delay_off); |
| 41 | led_cdev->blink_delay_on = state; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 42 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 43 | return size; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 44 | } |
| 45 | |
Németh Márton | 4d404fd | 2008-03-09 20:59:57 +0000 | [diff] [blame] | 46 | static ssize_t led_delay_off_show(struct device *dev, |
Richard Purdie | f8a7c6f | 2007-07-08 23:19:31 +0100 | [diff] [blame] | 47 | struct device_attribute *attr, char *buf) |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 48 | { |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 49 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 50 | |
Johannes Berg | 5ada28b | 2010-11-11 14:05:21 -0800 | [diff] [blame] | 51 | return sprintf(buf, "%lu\n", led_cdev->blink_delay_off); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 52 | } |
| 53 | |
Németh Márton | 4d404fd | 2008-03-09 20:59:57 +0000 | [diff] [blame] | 54 | static ssize_t led_delay_off_store(struct device *dev, |
Richard Purdie | f8a7c6f | 2007-07-08 23:19:31 +0100 | [diff] [blame] | 55 | struct device_attribute *attr, const char *buf, size_t size) |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 56 | { |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 57 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 58 | unsigned long state; |
| 59 | ssize_t ret = -EINVAL; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 60 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 61 | ret = kstrtoul(buf, 10, &state); |
| 62 | if (ret) |
| 63 | return ret; |
Richard Purdie | 3dc7b82 | 2006-05-15 09:44:17 -0700 | [diff] [blame] | 64 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 65 | led_blink_set(led_cdev, &led_cdev->blink_delay_on, &state); |
| 66 | led_cdev->blink_delay_off = state; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 67 | |
Shuah Khan | 872b86b | 2012-05-29 15:07:26 -0700 | [diff] [blame] | 68 | return size; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 69 | } |
| 70 | |
Richard Purdie | f8a7c6f | 2007-07-08 23:19:31 +0100 | [diff] [blame] | 71 | static DEVICE_ATTR(delay_on, 0644, led_delay_on_show, led_delay_on_store); |
| 72 | static DEVICE_ATTR(delay_off, 0644, led_delay_off_show, led_delay_off_store); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 73 | |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 74 | static struct attribute *timer_trig_attrs[] = { |
| 75 | &dev_attr_delay_on.attr, |
| 76 | &dev_attr_delay_off.attr, |
| 77 | NULL |
| 78 | }; |
| 79 | ATTRIBUTE_GROUPS(timer_trig); |
| 80 | |
Krzysztof Kozlowski | 0f85e849 | 2019-01-09 15:44:49 +0100 | [diff] [blame] | 81 | static void pattern_init(struct led_classdev *led_cdev) |
| 82 | { |
| 83 | u32 *pattern; |
| 84 | unsigned int size = 0; |
| 85 | |
| 86 | pattern = led_get_default_pattern(led_cdev, &size); |
| 87 | if (!pattern) |
| 88 | return; |
| 89 | |
| 90 | if (size != 2) { |
| 91 | dev_warn(led_cdev->dev, |
| 92 | "Expected 2 but got %u values for delays pattern\n", |
| 93 | size); |
| 94 | goto out; |
| 95 | } |
| 96 | |
| 97 | led_cdev->blink_delay_on = pattern[0]; |
| 98 | led_cdev->blink_delay_off = pattern[1]; |
| 99 | /* led_blink_set() called by caller */ |
| 100 | |
| 101 | out: |
| 102 | kfree(pattern); |
| 103 | } |
| 104 | |
Uwe Kleine-König | 2282e125 | 2018-07-02 22:05:21 +0200 | [diff] [blame] | 105 | static int timer_trig_activate(struct led_classdev *led_cdev) |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 106 | { |
Krzysztof Kozlowski | 0f85e849 | 2019-01-09 15:44:49 +0100 | [diff] [blame] | 107 | if (led_cdev->flags & LED_INIT_DEFAULT_TRIGGER) { |
| 108 | pattern_init(led_cdev); |
| 109 | /* |
| 110 | * Mark as initialized even on pattern_init() error because |
| 111 | * any consecutive call to it would produce the same error. |
| 112 | */ |
| 113 | led_cdev->flags &= ~LED_INIT_DEFAULT_TRIGGER; |
| 114 | } |
| 115 | |
Pavel Machek | 8c0f693 | 2019-05-26 09:38:55 +0200 | [diff] [blame^] | 116 | /* |
| 117 | * If "set brightness to 0" is pending in workqueue, we don't |
| 118 | * want that to be reordered after blink_set() |
| 119 | */ |
| 120 | flush_work(&led_cdev->set_brightness_work); |
Esben Haabendal | fff26f8 | 2011-05-24 17:13:22 -0700 | [diff] [blame] | 121 | led_blink_set(led_cdev, &led_cdev->blink_delay_on, |
| 122 | &led_cdev->blink_delay_off); |
Uwe Kleine-König | 2282e125 | 2018-07-02 22:05:21 +0200 | [diff] [blame] | 123 | |
| 124 | return 0; |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 125 | } |
| 126 | |
| 127 | static void timer_trig_deactivate(struct led_classdev *led_cdev) |
| 128 | { |
Johannes Berg | 5ada28b | 2010-11-11 14:05:21 -0800 | [diff] [blame] | 129 | /* Stop blinking */ |
Shuah Khan | 19cd67e | 2012-06-14 04:34:30 +0800 | [diff] [blame] | 130 | led_set_brightness(led_cdev, LED_OFF); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 131 | } |
| 132 | |
| 133 | static struct led_trigger timer_led_trigger = { |
| 134 | .name = "timer", |
| 135 | .activate = timer_trig_activate, |
| 136 | .deactivate = timer_trig_deactivate, |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 137 | .groups = timer_trig_groups, |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 138 | }; |
Uwe Kleine-König | 2b7b6d4 | 2018-07-02 22:05:27 +0200 | [diff] [blame] | 139 | module_led_trigger(timer_led_trigger); |
Richard Purdie | 6655c6f | 2006-03-31 02:31:07 -0800 | [diff] [blame] | 140 | |
| 141 | MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>"); |
| 142 | MODULE_DESCRIPTION("Timer LED trigger"); |
Uwe Kleine-König | 033692e | 2018-07-02 22:05:20 +0200 | [diff] [blame] | 143 | MODULE_LICENSE("GPL v2"); |