.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
---|
1 | 2 | /* |
---|
2 | 3 | * LED Kernel Timer Trigger |
---|
3 | 4 | * |
---|
4 | 5 | * Copyright 2005-2006 Openedhand Ltd. |
---|
5 | 6 | * |
---|
6 | 7 | * 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. |
---|
11 | 8 | */ |
---|
12 | 9 | |
---|
13 | 10 | #include <linux/module.h> |
---|
.. | .. |
---|
15 | 12 | #include <linux/init.h> |
---|
16 | 13 | #include <linux/device.h> |
---|
17 | 14 | #include <linux/ctype.h> |
---|
| 15 | +#include <linux/slab.h> |
---|
18 | 16 | #include <linux/leds.h> |
---|
19 | 17 | |
---|
20 | 18 | static ssize_t led_delay_on_show(struct device *dev, |
---|
.. | .. |
---|
30 | 28 | { |
---|
31 | 29 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
---|
32 | 30 | unsigned long state; |
---|
33 | | - ssize_t ret = -EINVAL; |
---|
| 31 | + ssize_t ret; |
---|
34 | 32 | |
---|
35 | 33 | ret = kstrtoul(buf, 10, &state); |
---|
36 | 34 | if (ret) |
---|
.. | .. |
---|
55 | 53 | { |
---|
56 | 54 | struct led_classdev *led_cdev = led_trigger_get_led(dev); |
---|
57 | 55 | unsigned long state; |
---|
58 | | - ssize_t ret = -EINVAL; |
---|
| 56 | + ssize_t ret; |
---|
59 | 57 | |
---|
60 | 58 | ret = kstrtoul(buf, 10, &state); |
---|
61 | 59 | if (ret) |
---|
.. | .. |
---|
77 | 75 | }; |
---|
78 | 76 | ATTRIBUTE_GROUPS(timer_trig); |
---|
79 | 77 | |
---|
| 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 | + |
---|
80 | 102 | static int timer_trig_activate(struct led_classdev *led_cdev) |
---|
81 | 103 | { |
---|
| 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 | + |
---|
| 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); |
---|
82 | 118 | led_blink_set(led_cdev, &led_cdev->blink_delay_on, |
---|
83 | 119 | &led_cdev->blink_delay_off); |
---|
84 | 120 | |
---|