| .. | .. |
|---|
| 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 | |
|---|