Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * LED driver for WM8350 driven LEDS.
4 *
5 * Copyright(C) 2007, 2008 Wolfson Microelectronics PLC.
6 */
7
8#include <linux/kernel.h>
9#include <linux/platform_device.h>
10#include <linux/leds.h>
11#include <linux/err.h>
12#include <linux/mfd/wm8350/pmic.h>
13#include <linux/regulator/consumer.h>
14#include <linux/slab.h>
15#include <linux/module.h>
16
17/* Microamps */
18static const int isink_cur[] = {
19 4,
20 5,
21 6,
22 7,
23 8,
24 10,
25 11,
26 14,
27 16,
28 19,
29 23,
30 27,
31 32,
32 39,
33 46,
34 54,
35 65,
36 77,
37 92,
38 109,
39 130,
40 154,
41 183,
42 218,
43 259,
44 308,
45 367,
46 436,
47 518,
48 616,
49 733,
50 872,
51 1037,
52 1233,
53 1466,
54 1744,
55 2073,
56 2466,
57 2933,
58 3487,
59 4147,
60 4932,
61 5865,
62 6975,
63 8294,
64 9864,
65 11730,
66 13949,
67 16589,
68 19728,
69 23460,
70 27899,
71 33178,
72 39455,
73 46920,
74 55798,
75 66355,
76 78910,
77 93840,
78 111596,
79 132710,
80 157820,
81 187681,
82 223191
83};
84
85#define to_wm8350_led(led_cdev) \
86 container_of(led_cdev, struct wm8350_led, cdev)
87
88static int wm8350_led_enable(struct wm8350_led *led)
89{
90 int ret = 0;
91
92 if (led->enabled)
93 return ret;
94
95 ret = regulator_enable(led->isink);
96 if (ret != 0) {
97 dev_err(led->cdev.dev, "Failed to enable ISINK: %d\n", ret);
98 return ret;
99 }
100
101 ret = regulator_enable(led->dcdc);
102 if (ret != 0) {
103 dev_err(led->cdev.dev, "Failed to enable DCDC: %d\n", ret);
104 regulator_disable(led->isink);
105 return ret;
106 }
107
108 led->enabled = 1;
109
110 return ret;
111}
112
113static int wm8350_led_disable(struct wm8350_led *led)
114{
115 int ret = 0;
116
117 if (!led->enabled)
118 return ret;
119
120 ret = regulator_disable(led->dcdc);
121 if (ret != 0) {
122 dev_err(led->cdev.dev, "Failed to disable DCDC: %d\n", ret);
123 return ret;
124 }
125
126 ret = regulator_disable(led->isink);
127 if (ret != 0) {
128 dev_err(led->cdev.dev, "Failed to disable ISINK: %d\n", ret);
129 ret = regulator_enable(led->dcdc);
130 if (ret != 0)
131 dev_err(led->cdev.dev, "Failed to reenable DCDC: %d\n",
132 ret);
133 return ret;
134 }
135
136 led->enabled = 0;
137
138 return ret;
139}
140
141static int wm8350_led_set(struct led_classdev *led_cdev,
142 enum led_brightness value)
143{
144 struct wm8350_led *led = to_wm8350_led(led_cdev);
145 unsigned long flags;
146 int ret;
147 int uA;
148
149 led->value = value;
150
151 spin_lock_irqsave(&led->value_lock, flags);
152
153 if (led->value == LED_OFF) {
154 spin_unlock_irqrestore(&led->value_lock, flags);
155 return wm8350_led_disable(led);
156 }
157
158 /* This scales linearly into the index of valid current
159 * settings which results in a linear scaling of perceived
160 * brightness due to the non-linear current settings provided
161 * by the hardware.
162 */
163 uA = (led->max_uA_index * led->value) / LED_FULL;
164 spin_unlock_irqrestore(&led->value_lock, flags);
165 BUG_ON(uA >= ARRAY_SIZE(isink_cur));
166
167 ret = regulator_set_current_limit(led->isink, isink_cur[uA],
168 isink_cur[uA]);
169 if (ret != 0) {
170 dev_err(led->cdev.dev, "Failed to set %duA: %d\n",
171 isink_cur[uA], ret);
172 return ret;
173 }
174
175 return wm8350_led_enable(led);
176}
177
178static void wm8350_led_shutdown(struct platform_device *pdev)
179{
180 struct wm8350_led *led = platform_get_drvdata(pdev);
181
182 led->value = LED_OFF;
183 wm8350_led_disable(led);
184}
185
186static int wm8350_led_probe(struct platform_device *pdev)
187{
188 struct regulator *isink, *dcdc;
189 struct wm8350_led *led;
190 struct wm8350_led_platform_data *pdata = dev_get_platdata(&pdev->dev);
191 int i;
192
193 if (pdata == NULL) {
194 dev_err(&pdev->dev, "no platform data\n");
195 return -ENODEV;
196 }
197
198 if (pdata->max_uA < isink_cur[0]) {
199 dev_err(&pdev->dev, "Invalid maximum current %duA\n",
200 pdata->max_uA);
201 return -EINVAL;
202 }
203
204 isink = devm_regulator_get(&pdev->dev, "led_isink");
205 if (IS_ERR(isink)) {
206 dev_err(&pdev->dev, "%s: can't get ISINK\n", __func__);
207 return PTR_ERR(isink);
208 }
209
210 dcdc = devm_regulator_get(&pdev->dev, "led_vcc");
211 if (IS_ERR(dcdc)) {
212 dev_err(&pdev->dev, "%s: can't get DCDC\n", __func__);
213 return PTR_ERR(dcdc);
214 }
215
216 led = devm_kzalloc(&pdev->dev, sizeof(*led), GFP_KERNEL);
217 if (led == NULL)
218 return -ENOMEM;
219
220 led->cdev.brightness_set_blocking = wm8350_led_set;
221 led->cdev.default_trigger = pdata->default_trigger;
222 led->cdev.name = pdata->name;
223 led->cdev.flags |= LED_CORE_SUSPENDRESUME;
224 led->enabled = regulator_is_enabled(isink);
225 led->isink = isink;
226 led->dcdc = dcdc;
227
228 for (i = 0; i < ARRAY_SIZE(isink_cur) - 1; i++)
229 if (isink_cur[i] >= pdata->max_uA)
230 break;
231 led->max_uA_index = i;
232 if (pdata->max_uA != isink_cur[i])
233 dev_warn(&pdev->dev,
234 "Maximum current %duA is not directly supported,"
235 " check platform data\n",
236 pdata->max_uA);
237
238 spin_lock_init(&led->value_lock);
239 led->value = LED_OFF;
240 platform_set_drvdata(pdev, led);
241
242 return led_classdev_register(&pdev->dev, &led->cdev);
243}
244
245static void wm8350_led_remove(struct platform_device *pdev)
246{
247 struct wm8350_led *led = platform_get_drvdata(pdev);
248
249 led_classdev_unregister(&led->cdev);
250 wm8350_led_disable(led);
251}
252
253static struct platform_driver wm8350_led_driver = {
254 .driver = {
255 .name = "wm8350-led",
256 },
257 .probe = wm8350_led_probe,
258 .remove_new = wm8350_led_remove,
259 .shutdown = wm8350_led_shutdown,
260};
261
262module_platform_driver(wm8350_led_driver);
263
264MODULE_AUTHOR("Mark Brown");
265MODULE_DESCRIPTION("WM8350 LED driver");
266MODULE_LICENSE("GPL");
267MODULE_ALIAS("platform:wm8350-led");
1/*
2 * LED driver for WM8350 driven LEDS.
3 *
4 * Copyright(C) 2007, 2008 Wolfson Microelectronics PLC.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 */
11
12#include <linux/kernel.h>
13#include <linux/init.h>
14#include <linux/platform_device.h>
15#include <linux/leds.h>
16#include <linux/err.h>
17#include <linux/mfd/wm8350/pmic.h>
18#include <linux/regulator/consumer.h>
19#include <linux/slab.h>
20
21/* Microamps */
22static const int isink_cur[] = {
23 4,
24 5,
25 6,
26 7,
27 8,
28 10,
29 11,
30 14,
31 16,
32 19,
33 23,
34 27,
35 32,
36 39,
37 46,
38 54,
39 65,
40 77,
41 92,
42 109,
43 130,
44 154,
45 183,
46 218,
47 259,
48 308,
49 367,
50 436,
51 518,
52 616,
53 733,
54 872,
55 1037,
56 1233,
57 1466,
58 1744,
59 2073,
60 2466,
61 2933,
62 3487,
63 4147,
64 4932,
65 5865,
66 6975,
67 8294,
68 9864,
69 11730,
70 13949,
71 16589,
72 19728,
73 23460,
74 27899,
75 33178,
76 39455,
77 46920,
78 55798,
79 66355,
80 78910,
81 93840,
82 111596,
83 132710,
84 157820,
85 187681,
86 223191
87};
88
89#define to_wm8350_led(led_cdev) \
90 container_of(led_cdev, struct wm8350_led, cdev)
91
92static void wm8350_led_enable(struct wm8350_led *led)
93{
94 int ret;
95
96 if (led->enabled)
97 return;
98
99 ret = regulator_enable(led->isink);
100 if (ret != 0) {
101 dev_err(led->cdev.dev, "Failed to enable ISINK: %d\n", ret);
102 return;
103 }
104
105 ret = regulator_enable(led->dcdc);
106 if (ret != 0) {
107 dev_err(led->cdev.dev, "Failed to enable DCDC: %d\n", ret);
108 regulator_disable(led->isink);
109 return;
110 }
111
112 led->enabled = 1;
113}
114
115static void wm8350_led_disable(struct wm8350_led *led)
116{
117 int ret;
118
119 if (!led->enabled)
120 return;
121
122 ret = regulator_disable(led->dcdc);
123 if (ret != 0) {
124 dev_err(led->cdev.dev, "Failed to disable DCDC: %d\n", ret);
125 return;
126 }
127
128 ret = regulator_disable(led->isink);
129 if (ret != 0) {
130 dev_err(led->cdev.dev, "Failed to disable ISINK: %d\n", ret);
131 regulator_enable(led->dcdc);
132 return;
133 }
134
135 led->enabled = 0;
136}
137
138static void led_work(struct work_struct *work)
139{
140 struct wm8350_led *led = container_of(work, struct wm8350_led, work);
141 int ret;
142 int uA;
143 unsigned long flags;
144
145 mutex_lock(&led->mutex);
146
147 spin_lock_irqsave(&led->value_lock, flags);
148
149 if (led->value == LED_OFF) {
150 spin_unlock_irqrestore(&led->value_lock, flags);
151 wm8350_led_disable(led);
152 goto out;
153 }
154
155 /* This scales linearly into the index of valid current
156 * settings which results in a linear scaling of perceived
157 * brightness due to the non-linear current settings provided
158 * by the hardware.
159 */
160 uA = (led->max_uA_index * led->value) / LED_FULL;
161 spin_unlock_irqrestore(&led->value_lock, flags);
162 BUG_ON(uA >= ARRAY_SIZE(isink_cur));
163
164 ret = regulator_set_current_limit(led->isink, isink_cur[uA],
165 isink_cur[uA]);
166 if (ret != 0)
167 dev_err(led->cdev.dev, "Failed to set %duA: %d\n",
168 isink_cur[uA], ret);
169
170 wm8350_led_enable(led);
171
172out:
173 mutex_unlock(&led->mutex);
174}
175
176static void wm8350_led_set(struct led_classdev *led_cdev,
177 enum led_brightness value)
178{
179 struct wm8350_led *led = to_wm8350_led(led_cdev);
180 unsigned long flags;
181
182 spin_lock_irqsave(&led->value_lock, flags);
183 led->value = value;
184 schedule_work(&led->work);
185 spin_unlock_irqrestore(&led->value_lock, flags);
186}
187
188static void wm8350_led_shutdown(struct platform_device *pdev)
189{
190 struct wm8350_led *led = platform_get_drvdata(pdev);
191
192 mutex_lock(&led->mutex);
193 led->value = LED_OFF;
194 wm8350_led_disable(led);
195 mutex_unlock(&led->mutex);
196}
197
198static int wm8350_led_probe(struct platform_device *pdev)
199{
200 struct regulator *isink, *dcdc;
201 struct wm8350_led *led;
202 struct wm8350_led_platform_data *pdata = pdev->dev.platform_data;
203 int ret, i;
204
205 if (pdata == NULL) {
206 dev_err(&pdev->dev, "no platform data\n");
207 return -ENODEV;
208 }
209
210 if (pdata->max_uA < isink_cur[0]) {
211 dev_err(&pdev->dev, "Invalid maximum current %duA\n",
212 pdata->max_uA);
213 return -EINVAL;
214 }
215
216 isink = regulator_get(&pdev->dev, "led_isink");
217 if (IS_ERR(isink)) {
218 printk(KERN_ERR "%s: can't get ISINK\n", __func__);
219 return PTR_ERR(isink);
220 }
221
222 dcdc = regulator_get(&pdev->dev, "led_vcc");
223 if (IS_ERR(dcdc)) {
224 printk(KERN_ERR "%s: can't get DCDC\n", __func__);
225 ret = PTR_ERR(dcdc);
226 goto err_isink;
227 }
228
229 led = kzalloc(sizeof(*led), GFP_KERNEL);
230 if (led == NULL) {
231 ret = -ENOMEM;
232 goto err_dcdc;
233 }
234
235 led->cdev.brightness_set = wm8350_led_set;
236 led->cdev.default_trigger = pdata->default_trigger;
237 led->cdev.name = pdata->name;
238 led->cdev.flags |= LED_CORE_SUSPENDRESUME;
239 led->enabled = regulator_is_enabled(isink);
240 led->isink = isink;
241 led->dcdc = dcdc;
242
243 for (i = 0; i < ARRAY_SIZE(isink_cur) - 1; i++)
244 if (isink_cur[i] >= pdata->max_uA)
245 break;
246 led->max_uA_index = i;
247 if (pdata->max_uA != isink_cur[i])
248 dev_warn(&pdev->dev,
249 "Maximum current %duA is not directly supported,"
250 " check platform data\n",
251 pdata->max_uA);
252
253 spin_lock_init(&led->value_lock);
254 mutex_init(&led->mutex);
255 INIT_WORK(&led->work, led_work);
256 led->value = LED_OFF;
257 platform_set_drvdata(pdev, led);
258
259 ret = led_classdev_register(&pdev->dev, &led->cdev);
260 if (ret < 0)
261 goto err_led;
262
263 return 0;
264
265 err_led:
266 kfree(led);
267 err_dcdc:
268 regulator_put(dcdc);
269 err_isink:
270 regulator_put(isink);
271 return ret;
272}
273
274static int wm8350_led_remove(struct platform_device *pdev)
275{
276 struct wm8350_led *led = platform_get_drvdata(pdev);
277
278 led_classdev_unregister(&led->cdev);
279 flush_work_sync(&led->work);
280 wm8350_led_disable(led);
281 regulator_put(led->dcdc);
282 regulator_put(led->isink);
283 kfree(led);
284 return 0;
285}
286
287static struct platform_driver wm8350_led_driver = {
288 .driver = {
289 .name = "wm8350-led",
290 .owner = THIS_MODULE,
291 },
292 .probe = wm8350_led_probe,
293 .remove = wm8350_led_remove,
294 .shutdown = wm8350_led_shutdown,
295};
296
297static int __devinit wm8350_led_init(void)
298{
299 return platform_driver_register(&wm8350_led_driver);
300}
301module_init(wm8350_led_init);
302
303static void wm8350_led_exit(void)
304{
305 platform_driver_unregister(&wm8350_led_driver);
306}
307module_exit(wm8350_led_exit);
308
309MODULE_AUTHOR("Mark Brown");
310MODULE_DESCRIPTION("WM8350 LED driver");
311MODULE_LICENSE("GPL");
312MODULE_ALIAS("platform:wm8350-led");