Commit | Line | Data |
---|---|---|
7fdcef8a | 1 | /* |
a59ce658 | 2 | * LEDs driver for Freescale MC13783/MC13892/MC34708 |
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 | struct mc13xxx_led_devtype { |
27 | int led_min; | |
28 | int led_max; | |
29 | int num_regs; | |
a59ce658 | 30 | u32 ledctrl_base; |
9d263813 AS |
31 | }; |
32 | ||
33 | struct mc13xxx_led { | |
7fdcef8a PR |
34 | struct led_classdev cdev; |
35 | struct work_struct work; | |
7fdcef8a PR |
36 | enum led_brightness new_brightness; |
37 | int id; | |
a59ce658 | 38 | struct mc13xxx_leds *leds; |
7fdcef8a PR |
39 | }; |
40 | ||
9d263813 | 41 | struct mc13xxx_leds { |
a59ce658 | 42 | struct mc13xxx *master; |
9d263813 AS |
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 | 50 | struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work); |
a59ce658 AS |
51 | struct mc13xxx_leds *leds = led->leds; |
52 | unsigned int reg, mask, value, bank, off, shift; | |
7fdcef8a PR |
53 | |
54 | switch (led->id) { | |
55 | case MC13783_LED_MD: | |
7fdcef8a | 56 | case MC13783_LED_AD: |
7fdcef8a | 57 | case MC13783_LED_KP: |
a59ce658 AS |
58 | reg = 2; |
59 | shift = 9 + (led->id - MC13783_LED_MD) * 4; | |
9d263813 AS |
60 | mask = 0x0f; |
61 | value = led->new_brightness >> 4; | |
7fdcef8a PR |
62 | break; |
63 | case MC13783_LED_R1: | |
64 | case MC13783_LED_G1: | |
65 | case MC13783_LED_B1: | |
66 | case MC13783_LED_R2: | |
67 | case MC13783_LED_G2: | |
68 | case MC13783_LED_B2: | |
69 | case MC13783_LED_R3: | |
70 | case MC13783_LED_G3: | |
71 | case MC13783_LED_B3: | |
72 | off = led->id - MC13783_LED_R1; | |
9d263813 | 73 | bank = off / 3; |
a59ce658 | 74 | reg = 3 + bank; |
9d263813 AS |
75 | shift = (off - bank * 3) * 5 + 6; |
76 | value = led->new_brightness >> 3; | |
77 | mask = 0x1f; | |
7fdcef8a | 78 | break; |
ae6cdb03 | 79 | case MC13892_LED_MD: |
ae6cdb03 | 80 | case MC13892_LED_AD: |
ae6cdb03 | 81 | case MC13892_LED_KP: |
a59ce658 AS |
82 | reg = (led->id - MC13892_LED_MD) / 2; |
83 | shift = 3 + (led->id - MC13892_LED_MD) * 12; | |
ae6cdb03 AS |
84 | mask = 0x3f; |
85 | value = led->new_brightness >> 2; | |
86 | break; | |
87 | case MC13892_LED_R: | |
88 | case MC13892_LED_G: | |
89 | case MC13892_LED_B: | |
90 | off = led->id - MC13892_LED_R; | |
91 | bank = off / 2; | |
a59ce658 | 92 | reg = 2 + bank; |
ae6cdb03 AS |
93 | shift = (off - bank * 2) * 12 + 3; |
94 | value = led->new_brightness >> 2; | |
95 | mask = 0x3f; | |
96 | break; | |
a59ce658 AS |
97 | case MC34708_LED_R: |
98 | case MC34708_LED_G: | |
99 | reg = 0; | |
100 | shift = 3 + (led->id - MC34708_LED_R) * 12; | |
101 | value = led->new_brightness >> 2; | |
102 | mask = 0x3f; | |
103 | break; | |
9d263813 AS |
104 | default: |
105 | BUG(); | |
7fdcef8a PR |
106 | } |
107 | ||
a59ce658 AS |
108 | mc13xxx_reg_rmw(leds->master, leds->devtype->ledctrl_base + reg, |
109 | mask << shift, value << shift); | |
7fdcef8a PR |
110 | } |
111 | ||
9d263813 AS |
112 | static void mc13xxx_led_set(struct led_classdev *led_cdev, |
113 | enum led_brightness value) | |
7fdcef8a | 114 | { |
9d263813 AS |
115 | struct mc13xxx_led *led = |
116 | container_of(led_cdev, struct mc13xxx_led, cdev); | |
7fdcef8a | 117 | |
7fdcef8a PR |
118 | led->new_brightness = value; |
119 | schedule_work(&led->work); | |
120 | } | |
121 | ||
9d263813 | 122 | static int __init mc13xxx_led_probe(struct platform_device *pdev) |
7fdcef8a | 123 | { |
a59ce658 AS |
124 | struct device *dev = &pdev->dev; |
125 | struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(dev); | |
126 | struct mc13xxx *mcdev = dev_get_drvdata(dev->parent); | |
9d263813 AS |
127 | struct mc13xxx_led_devtype *devtype = |
128 | (struct mc13xxx_led_devtype *)pdev->id_entry->driver_data; | |
129 | struct mc13xxx_leds *leds; | |
cf3b1c2b | 130 | int i, id, num_leds, ret = -ENODATA; |
a59ce658 | 131 | u32 init_led = 0; |
9d263813 AS |
132 | |
133 | if (!pdata) { | |
a59ce658 | 134 | dev_err(dev, "Missing platform data\n"); |
7fdcef8a PR |
135 | return -ENODEV; |
136 | } | |
137 | ||
9d263813 AS |
138 | num_leds = pdata->num_leds; |
139 | ||
140 | if ((num_leds < 1) || | |
141 | (num_leds > (devtype->led_max - devtype->led_min + 1))) { | |
a59ce658 | 142 | dev_err(dev, "Invalid LED count %d\n", num_leds); |
7fdcef8a PR |
143 | return -EINVAL; |
144 | } | |
145 | ||
a59ce658 | 146 | leds = devm_kzalloc(dev, num_leds * sizeof(struct mc13xxx_led) + |
9d263813 AS |
147 | sizeof(struct mc13xxx_leds), GFP_KERNEL); |
148 | if (!leds) | |
7fdcef8a | 149 | return -ENOMEM; |
9d263813 AS |
150 | |
151 | leds->devtype = devtype; | |
152 | leds->num_leds = num_leds; | |
a59ce658 | 153 | leds->master = mcdev; |
9d263813 AS |
154 | platform_set_drvdata(pdev, leds); |
155 | ||
9d263813 | 156 | for (i = 0; i < devtype->num_regs; i++) { |
a59ce658 AS |
157 | ret = mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i, |
158 | pdata->led_control[i]); | |
9d263813 | 159 | if (ret) |
3df22c06 | 160 | return ret; |
7fdcef8a PR |
161 | } |
162 | ||
9d263813 AS |
163 | for (i = 0; i < num_leds; i++) { |
164 | const char *name, *trig; | |
7fdcef8a | 165 | |
9d263813 AS |
166 | ret = -EINVAL; |
167 | ||
168 | id = pdata->led[i].id; | |
169 | name = pdata->led[i].name; | |
170 | trig = pdata->led[i].default_trigger; | |
9d263813 AS |
171 | |
172 | if ((id > devtype->led_max) || (id < devtype->led_min)) { | |
a59ce658 | 173 | dev_err(dev, "Invalid ID %i\n", id); |
9d263813 | 174 | break; |
7fdcef8a PR |
175 | } |
176 | ||
9d263813 | 177 | if (init_led & (1 << id)) { |
a59ce658 | 178 | dev_warn(dev, "LED %i already initialized\n", id); |
9d263813 | 179 | break; |
7fdcef8a PR |
180 | } |
181 | ||
9d263813 AS |
182 | init_led |= 1 << id; |
183 | leds->led[i].id = id; | |
a59ce658 | 184 | leds->led[i].leds = leds; |
9d263813 AS |
185 | leds->led[i].cdev.name = name; |
186 | leds->led[i].cdev.default_trigger = trig; | |
187 | leds->led[i].cdev.brightness_set = mc13xxx_led_set; | |
188 | leds->led[i].cdev.brightness = LED_OFF; | |
7fdcef8a | 189 | |
9d263813 | 190 | INIT_WORK(&leds->led[i].work, mc13xxx_led_work); |
7fdcef8a | 191 | |
a59ce658 | 192 | ret = led_classdev_register(dev->parent, &leds->led[i].cdev); |
7fdcef8a | 193 | if (ret) { |
a59ce658 | 194 | dev_err(dev, "Failed to register LED %i\n", id); |
9d263813 | 195 | break; |
7fdcef8a PR |
196 | } |
197 | } | |
198 | ||
9d263813 AS |
199 | if (ret) |
200 | while (--i >= 0) { | |
201 | led_classdev_unregister(&leds->led[i].cdev); | |
202 | cancel_work_sync(&leds->led[i].work); | |
203 | } | |
7fdcef8a | 204 | |
7fdcef8a PR |
205 | return ret; |
206 | } | |
207 | ||
9d263813 | 208 | static int mc13xxx_led_remove(struct platform_device *pdev) |
7fdcef8a | 209 | { |
9d263813 | 210 | struct mc13xxx_leds *leds = platform_get_drvdata(pdev); |
a59ce658 | 211 | struct mc13xxx *mcdev = leds->master; |
7fdcef8a PR |
212 | int i; |
213 | ||
9d263813 AS |
214 | for (i = 0; i < leds->num_leds; i++) { |
215 | led_classdev_unregister(&leds->led[i].cdev); | |
216 | cancel_work_sync(&leds->led[i].work); | |
7fdcef8a PR |
217 | } |
218 | ||
9d263813 | 219 | for (i = 0; i < leds->devtype->num_regs; i++) |
a59ce658 | 220 | mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i, 0); |
7fdcef8a | 221 | |
7fdcef8a PR |
222 | return 0; |
223 | } | |
224 | ||
9d263813 AS |
225 | static const struct mc13xxx_led_devtype mc13783_led_devtype = { |
226 | .led_min = MC13783_LED_MD, | |
227 | .led_max = MC13783_LED_B3, | |
228 | .num_regs = 6, | |
a59ce658 | 229 | .ledctrl_base = 51, |
9d263813 AS |
230 | }; |
231 | ||
ae6cdb03 AS |
232 | static const struct mc13xxx_led_devtype mc13892_led_devtype = { |
233 | .led_min = MC13892_LED_MD, | |
234 | .led_max = MC13892_LED_B, | |
235 | .num_regs = 4, | |
a59ce658 AS |
236 | .ledctrl_base = 51, |
237 | }; | |
238 | ||
239 | static const struct mc13xxx_led_devtype mc34708_led_devtype = { | |
240 | .led_min = MC34708_LED_R, | |
241 | .led_max = MC34708_LED_G, | |
242 | .num_regs = 1, | |
243 | .ledctrl_base = 54, | |
ae6cdb03 AS |
244 | }; |
245 | ||
9d263813 AS |
246 | static const struct platform_device_id mc13xxx_led_id_table[] = { |
247 | { "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, }, | |
ae6cdb03 | 248 | { "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, }, |
a59ce658 | 249 | { "mc34708-led", (kernel_ulong_t)&mc34708_led_devtype, }, |
9d263813 AS |
250 | { } |
251 | }; | |
252 | MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table); | |
253 | ||
254 | static struct platform_driver mc13xxx_led_driver = { | |
7fdcef8a | 255 | .driver = { |
9d263813 | 256 | .name = "mc13xxx-led", |
7fdcef8a PR |
257 | .owner = THIS_MODULE, |
258 | }, | |
9d263813 AS |
259 | .remove = mc13xxx_led_remove, |
260 | .id_table = mc13xxx_led_id_table, | |
7fdcef8a | 261 | }; |
9d263813 | 262 | module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe); |
7fdcef8a | 263 | |
9d263813 | 264 | MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC"); |
7fdcef8a PR |
265 | MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>"); |
266 | MODULE_LICENSE("GPL"); |