Commit | Line | Data |
---|---|---|
7fdcef8a | 1 | /* |
ae6cdb03 | 2 | * LEDs driver for Freescale MC13783/MC13892 |
7fdcef8a PR |
3 | * |
4 | * Copyright (C) 2010 Philippe Rétornaz | |
5 | * | |
6 | * Based on leds-da903x: | |
7 | * Copyright (C) 2008 Compulab, Ltd. | |
8 | * Mike Rapoport <mike@compulab.co.il> | |
9 | * | |
10 | * Copyright (C) 2006-2008 Marvell International Ltd. | |
11 | * Eric Miao <eric.miao@marvell.com> | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify | |
14 | * it under the terms of the GNU General Public License version 2 as | |
15 | * published by the Free Software Foundation. | |
16 | */ | |
17 | ||
18 | #include <linux/module.h> | |
19 | #include <linux/kernel.h> | |
20 | #include <linux/init.h> | |
21 | #include <linux/platform_device.h> | |
22 | #include <linux/leds.h> | |
23 | #include <linux/workqueue.h> | |
f3ca0782 | 24 | #include <linux/mfd/mc13xxx.h> |
7fdcef8a | 25 | |
9d263813 AS |
26 | #define MC13XXX_REG_LED_CONTROL(x) (51 + (x)) |
27 | ||
28 | struct mc13xxx_led_devtype { | |
29 | int led_min; | |
30 | int led_max; | |
31 | int num_regs; | |
32 | }; | |
33 | ||
34 | struct mc13xxx_led { | |
7fdcef8a PR |
35 | struct led_classdev cdev; |
36 | struct work_struct work; | |
f3ca0782 | 37 | struct mc13xxx *master; |
7fdcef8a PR |
38 | enum led_brightness new_brightness; |
39 | int id; | |
40 | }; | |
41 | ||
9d263813 AS |
42 | struct mc13xxx_leds { |
43 | struct mc13xxx_led_devtype *devtype; | |
44 | int num_leds; | |
45 | struct mc13xxx_led led[0]; | |
46 | }; | |
47 | ||
48 | static void mc13xxx_led_work(struct work_struct *work) | |
7fdcef8a | 49 | { |
9d263813 AS |
50 | struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work); |
51 | int reg, mask, value, bank, off, shift; | |
7fdcef8a PR |
52 | |
53 | switch (led->id) { | |
54 | case MC13783_LED_MD: | |
9d263813 AS |
55 | reg = MC13XXX_REG_LED_CONTROL(2); |
56 | shift = 9; | |
57 | mask = 0x0f; | |
58 | value = led->new_brightness >> 4; | |
7fdcef8a PR |
59 | break; |
60 | case MC13783_LED_AD: | |
9d263813 AS |
61 | reg = MC13XXX_REG_LED_CONTROL(2); |
62 | shift = 13; | |
63 | mask = 0x0f; | |
64 | value = led->new_brightness >> 4; | |
7fdcef8a PR |
65 | break; |
66 | case MC13783_LED_KP: | |
9d263813 AS |
67 | reg = MC13XXX_REG_LED_CONTROL(2); |
68 | shift = 17; | |
69 | mask = 0x0f; | |
70 | value = led->new_brightness >> 4; | |
7fdcef8a PR |
71 | break; |
72 | case MC13783_LED_R1: | |
73 | case MC13783_LED_G1: | |
74 | case MC13783_LED_B1: | |
75 | case MC13783_LED_R2: | |
76 | case MC13783_LED_G2: | |
77 | case MC13783_LED_B2: | |
78 | case MC13783_LED_R3: | |
79 | case MC13783_LED_G3: | |
80 | case MC13783_LED_B3: | |
81 | off = led->id - MC13783_LED_R1; | |
9d263813 AS |
82 | bank = off / 3; |
83 | reg = MC13XXX_REG_LED_CONTROL(3) + bank; | |
84 | shift = (off - bank * 3) * 5 + 6; | |
85 | value = led->new_brightness >> 3; | |
86 | mask = 0x1f; | |
7fdcef8a | 87 | break; |
ae6cdb03 AS |
88 | case MC13892_LED_MD: |
89 | reg = MC13XXX_REG_LED_CONTROL(0); | |
90 | shift = 3; | |
91 | mask = 0x3f; | |
92 | value = led->new_brightness >> 2; | |
93 | break; | |
94 | case MC13892_LED_AD: | |
95 | reg = MC13XXX_REG_LED_CONTROL(0); | |
96 | shift = 15; | |
97 | mask = 0x3f; | |
98 | value = led->new_brightness >> 2; | |
99 | break; | |
100 | case MC13892_LED_KP: | |
101 | reg = MC13XXX_REG_LED_CONTROL(1); | |
102 | shift = 3; | |
103 | mask = 0x3f; | |
104 | value = led->new_brightness >> 2; | |
105 | break; | |
106 | case MC13892_LED_R: | |
107 | case MC13892_LED_G: | |
108 | case MC13892_LED_B: | |
109 | off = led->id - MC13892_LED_R; | |
110 | bank = off / 2; | |
111 | reg = MC13XXX_REG_LED_CONTROL(2) + bank; | |
112 | shift = (off - bank * 2) * 12 + 3; | |
113 | value = led->new_brightness >> 2; | |
114 | mask = 0x3f; | |
115 | break; | |
9d263813 AS |
116 | default: |
117 | BUG(); | |
7fdcef8a PR |
118 | } |
119 | ||
f3ca0782 | 120 | mc13xxx_lock(led->master); |
9d263813 | 121 | mc13xxx_reg_rmw(led->master, reg, mask << shift, value << shift); |
f3ca0782 | 122 | mc13xxx_unlock(led->master); |
7fdcef8a PR |
123 | } |
124 | ||
9d263813 AS |
125 | static void mc13xxx_led_set(struct led_classdev *led_cdev, |
126 | enum led_brightness value) | |
7fdcef8a | 127 | { |
9d263813 AS |
128 | struct mc13xxx_led *led = |
129 | container_of(led_cdev, struct mc13xxx_led, cdev); | |
7fdcef8a | 130 | |
7fdcef8a PR |
131 | led->new_brightness = value; |
132 | schedule_work(&led->work); | |
133 | } | |
134 | ||
9d263813 | 135 | static int __init mc13xxx_led_setup(struct mc13xxx_led *led, int max_current) |
7fdcef8a | 136 | { |
9d263813 | 137 | int shift, mask, reg, ret, bank; |
7fdcef8a PR |
138 | |
139 | switch (led->id) { | |
140 | case MC13783_LED_MD: | |
9d263813 AS |
141 | reg = MC13XXX_REG_LED_CONTROL(2); |
142 | shift = 0; | |
143 | mask = 0x07; | |
7fdcef8a PR |
144 | break; |
145 | case MC13783_LED_AD: | |
9d263813 AS |
146 | reg = MC13XXX_REG_LED_CONTROL(2); |
147 | shift = 3; | |
148 | mask = 0x07; | |
7fdcef8a PR |
149 | break; |
150 | case MC13783_LED_KP: | |
9d263813 AS |
151 | reg = MC13XXX_REG_LED_CONTROL(2); |
152 | shift = 6; | |
153 | mask = 0x07; | |
7fdcef8a PR |
154 | break; |
155 | case MC13783_LED_R1: | |
156 | case MC13783_LED_G1: | |
157 | case MC13783_LED_B1: | |
158 | case MC13783_LED_R2: | |
159 | case MC13783_LED_G2: | |
160 | case MC13783_LED_B2: | |
161 | case MC13783_LED_R3: | |
162 | case MC13783_LED_G3: | |
163 | case MC13783_LED_B3: | |
9d263813 AS |
164 | bank = (led->id - MC13783_LED_R1) / 3; |
165 | reg = MC13XXX_REG_LED_CONTROL(3) + bank; | |
7fdcef8a | 166 | shift = ((led->id - MC13783_LED_R1) - bank * 3) * 2; |
9d263813 | 167 | mask = 0x03; |
7fdcef8a | 168 | break; |
ae6cdb03 AS |
169 | case MC13892_LED_MD: |
170 | reg = MC13XXX_REG_LED_CONTROL(0); | |
171 | shift = 9; | |
172 | mask = 0x07; | |
173 | break; | |
174 | case MC13892_LED_AD: | |
175 | reg = MC13XXX_REG_LED_CONTROL(0); | |
176 | shift = 21; | |
177 | mask = 0x07; | |
178 | break; | |
179 | case MC13892_LED_KP: | |
180 | reg = MC13XXX_REG_LED_CONTROL(1); | |
181 | shift = 9; | |
182 | mask = 0x07; | |
183 | break; | |
184 | case MC13892_LED_R: | |
185 | case MC13892_LED_G: | |
186 | case MC13892_LED_B: | |
187 | bank = (led->id - MC13892_LED_R) / 2; | |
188 | reg = MC13XXX_REG_LED_CONTROL(2) + bank; | |
189 | shift = ((led->id - MC13892_LED_R) - bank * 2) * 12 + 9; | |
190 | mask = 0x07; | |
191 | break; | |
9d263813 AS |
192 | default: |
193 | BUG(); | |
7fdcef8a PR |
194 | } |
195 | ||
f3ca0782 | 196 | mc13xxx_lock(led->master); |
f3ca0782 | 197 | ret = mc13xxx_reg_rmw(led->master, reg, mask << shift, |
9d263813 | 198 | max_current << shift); |
f3ca0782 | 199 | mc13xxx_unlock(led->master); |
7fdcef8a | 200 | |
7fdcef8a PR |
201 | return ret; |
202 | } | |
203 | ||
9d263813 | 204 | static int __init mc13xxx_led_probe(struct platform_device *pdev) |
7fdcef8a | 205 | { |
52b7ad3a | 206 | struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(&pdev->dev); |
9d263813 AS |
207 | struct mc13xxx *mcdev = dev_get_drvdata(pdev->dev.parent); |
208 | struct mc13xxx_led_devtype *devtype = | |
209 | (struct mc13xxx_led_devtype *)pdev->id_entry->driver_data; | |
210 | struct mc13xxx_leds *leds; | |
cf3b1c2b | 211 | int i, id, num_leds, ret = -ENODATA; |
9d263813 AS |
212 | u32 reg, init_led = 0; |
213 | ||
214 | if (!pdata) { | |
215 | dev_err(&pdev->dev, "Missing platform data\n"); | |
7fdcef8a PR |
216 | return -ENODEV; |
217 | } | |
218 | ||
9d263813 AS |
219 | num_leds = pdata->num_leds; |
220 | ||
221 | if ((num_leds < 1) || | |
222 | (num_leds > (devtype->led_max - devtype->led_min + 1))) { | |
223 | dev_err(&pdev->dev, "Invalid LED count %d\n", num_leds); | |
7fdcef8a PR |
224 | return -EINVAL; |
225 | } | |
226 | ||
9d263813 AS |
227 | leds = devm_kzalloc(&pdev->dev, num_leds * sizeof(struct mc13xxx_led) + |
228 | sizeof(struct mc13xxx_leds), GFP_KERNEL); | |
229 | if (!leds) | |
7fdcef8a | 230 | return -ENOMEM; |
9d263813 AS |
231 | |
232 | leds->devtype = devtype; | |
233 | leds->num_leds = num_leds; | |
234 | platform_set_drvdata(pdev, leds); | |
235 | ||
236 | mc13xxx_lock(mcdev); | |
237 | for (i = 0; i < devtype->num_regs; i++) { | |
238 | reg = pdata->led_control[i]; | |
239 | WARN_ON(reg >= (1 << 24)); | |
240 | ret = mc13xxx_reg_write(mcdev, MC13XXX_REG_LED_CONTROL(i), reg); | |
241 | if (ret) | |
242 | break; | |
7fdcef8a | 243 | } |
9d263813 | 244 | mc13xxx_unlock(mcdev); |
7fdcef8a | 245 | |
7fdcef8a | 246 | if (ret) { |
9d263813 | 247 | dev_err(&pdev->dev, "Unable to init LED driver\n"); |
a44cdd2c | 248 | return ret; |
7fdcef8a PR |
249 | } |
250 | ||
9d263813 AS |
251 | for (i = 0; i < num_leds; i++) { |
252 | const char *name, *trig; | |
253 | char max_current; | |
7fdcef8a | 254 | |
9d263813 AS |
255 | ret = -EINVAL; |
256 | ||
257 | id = pdata->led[i].id; | |
258 | name = pdata->led[i].name; | |
259 | trig = pdata->led[i].default_trigger; | |
260 | max_current = pdata->led[i].max_current; | |
261 | ||
262 | if ((id > devtype->led_max) || (id < devtype->led_min)) { | |
263 | dev_err(&pdev->dev, "Invalid ID %i\n", id); | |
264 | break; | |
7fdcef8a PR |
265 | } |
266 | ||
9d263813 AS |
267 | if (init_led & (1 << id)) { |
268 | dev_warn(&pdev->dev, | |
269 | "LED %i already initialized\n", id); | |
270 | break; | |
7fdcef8a PR |
271 | } |
272 | ||
9d263813 AS |
273 | init_led |= 1 << id; |
274 | leds->led[i].id = id; | |
275 | leds->led[i].master = mcdev; | |
276 | leds->led[i].cdev.name = name; | |
277 | leds->led[i].cdev.default_trigger = trig; | |
278 | leds->led[i].cdev.brightness_set = mc13xxx_led_set; | |
279 | leds->led[i].cdev.brightness = LED_OFF; | |
7fdcef8a | 280 | |
9d263813 | 281 | INIT_WORK(&leds->led[i].work, mc13xxx_led_work); |
7fdcef8a | 282 | |
9d263813 | 283 | ret = mc13xxx_led_setup(&leds->led[i], max_current); |
7fdcef8a | 284 | if (ret) { |
9d263813 AS |
285 | dev_err(&pdev->dev, "Unable to setup LED %i\n", id); |
286 | break; | |
7fdcef8a | 287 | } |
9d263813 AS |
288 | ret = led_classdev_register(pdev->dev.parent, |
289 | &leds->led[i].cdev); | |
7fdcef8a | 290 | if (ret) { |
9d263813 AS |
291 | dev_err(&pdev->dev, "Failed to register LED %i\n", id); |
292 | break; | |
7fdcef8a PR |
293 | } |
294 | } | |
295 | ||
9d263813 AS |
296 | if (ret) |
297 | while (--i >= 0) { | |
298 | led_classdev_unregister(&leds->led[i].cdev); | |
299 | cancel_work_sync(&leds->led[i].work); | |
300 | } | |
7fdcef8a | 301 | |
7fdcef8a PR |
302 | return ret; |
303 | } | |
304 | ||
9d263813 | 305 | static int mc13xxx_led_remove(struct platform_device *pdev) |
7fdcef8a | 306 | { |
9d263813 AS |
307 | struct mc13xxx *mcdev = dev_get_drvdata(pdev->dev.parent); |
308 | struct mc13xxx_leds *leds = platform_get_drvdata(pdev); | |
7fdcef8a PR |
309 | int i; |
310 | ||
9d263813 AS |
311 | for (i = 0; i < leds->num_leds; i++) { |
312 | led_classdev_unregister(&leds->led[i].cdev); | |
313 | cancel_work_sync(&leds->led[i].work); | |
7fdcef8a PR |
314 | } |
315 | ||
9d263813 AS |
316 | mc13xxx_lock(mcdev); |
317 | for (i = 0; i < leds->devtype->num_regs; i++) | |
318 | mc13xxx_reg_write(mcdev, MC13XXX_REG_LED_CONTROL(i), 0); | |
319 | mc13xxx_unlock(mcdev); | |
7fdcef8a | 320 | |
7fdcef8a PR |
321 | return 0; |
322 | } | |
323 | ||
9d263813 AS |
324 | static const struct mc13xxx_led_devtype mc13783_led_devtype = { |
325 | .led_min = MC13783_LED_MD, | |
326 | .led_max = MC13783_LED_B3, | |
327 | .num_regs = 6, | |
328 | }; | |
329 | ||
ae6cdb03 AS |
330 | static const struct mc13xxx_led_devtype mc13892_led_devtype = { |
331 | .led_min = MC13892_LED_MD, | |
332 | .led_max = MC13892_LED_B, | |
333 | .num_regs = 4, | |
334 | }; | |
335 | ||
9d263813 AS |
336 | static const struct platform_device_id mc13xxx_led_id_table[] = { |
337 | { "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, }, | |
ae6cdb03 | 338 | { "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, }, |
9d263813 AS |
339 | { } |
340 | }; | |
341 | MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table); | |
342 | ||
343 | static struct platform_driver mc13xxx_led_driver = { | |
7fdcef8a | 344 | .driver = { |
9d263813 | 345 | .name = "mc13xxx-led", |
7fdcef8a PR |
346 | .owner = THIS_MODULE, |
347 | }, | |
9d263813 AS |
348 | .remove = mc13xxx_led_remove, |
349 | .id_table = mc13xxx_led_id_table, | |
7fdcef8a | 350 | }; |
9d263813 | 351 | module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe); |
7fdcef8a | 352 | |
9d263813 | 353 | MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC"); |
7fdcef8a PR |
354 | MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>"); |
355 | MODULE_LICENSE("GPL"); |