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