Commit | Line | Data |
---|---|---|
75cb2e1d PM |
1 | /* |
2 | * Copyright 2011 bct electronic GmbH | |
af67384f | 3 | * Copyright 2013 Qtechnology/AS |
75cb2e1d PM |
4 | * |
5 | * Author: Peter Meerwald <p.meerwald@bct-electronic.com> | |
af67384f | 6 | * Author: Ricardo Ribalda <ricardo.ribalda@gmail.com> |
75cb2e1d PM |
7 | * |
8 | * Based on leds-pca955x.c | |
9 | * | |
10 | * This file is subject to the terms and conditions of version 2 of | |
11 | * the GNU General Public License. See the file COPYING in the main | |
12 | * directory of this archive for more details. | |
13 | * | |
14 | * LED driver for the PCA9633 I2C LED driver (7-bit slave address 0x62) | |
3dfedb9d | 15 | * LED driver for the PCA9634/5 I2C LED driver (7-bit slave address set by hw.) |
75cb2e1d | 16 | * |
8465b018 MG |
17 | * Note that hardware blinking violates the leds infrastructure driver |
18 | * interface since the hardware only supports blinking all LEDs with the | |
19 | * same delay_on/delay_off rates. That is, only the LEDs that are set to | |
20 | * blink will actually blink but all LEDs that are set to blink will blink | |
21 | * in identical fashion. The delay_on/delay_off values of the last LED | |
22 | * that is set to blink will be used for all of the blinking LEDs. | |
23 | * Hardware blinking is disabled by default but can be enabled by setting | |
56a1740c | 24 | * the 'blink_type' member in the platform_data struct to 'PCA963X_HW_BLINK' |
8465b018 | 25 | * or by adding the 'nxp,hw-blink' property to the DTS. |
75cb2e1d PM |
26 | */ |
27 | ||
f26dab9f | 28 | #include <linux/acpi.h> |
75cb2e1d PM |
29 | #include <linux/module.h> |
30 | #include <linux/delay.h> | |
31 | #include <linux/string.h> | |
32 | #include <linux/ctype.h> | |
33 | #include <linux/leds.h> | |
34 | #include <linux/err.h> | |
35 | #include <linux/i2c.h> | |
75cb2e1d | 36 | #include <linux/slab.h> |
81d22878 | 37 | #include <linux/of.h> |
56a1740c | 38 | #include <linux/platform_data/leds-pca963x.h> |
75cb2e1d PM |
39 | |
40 | /* LED select registers determine the source that drives LED outputs */ | |
56a1740c RRD |
41 | #define PCA963X_LED_OFF 0x0 /* LED driver off */ |
42 | #define PCA963X_LED_ON 0x1 /* LED driver on */ | |
43 | #define PCA963X_LED_PWM 0x2 /* Controlled through PWM */ | |
44 | #define PCA963X_LED_GRP_PWM 0x3 /* Controlled through PWM/GRPPWM */ | |
75cb2e1d | 45 | |
56a1740c | 46 | #define PCA963X_MODE2_DMBLNK 0x20 /* Enable blinking */ |
8465b018 | 47 | |
56a1740c RRD |
48 | #define PCA963X_MODE1 0x00 |
49 | #define PCA963X_MODE2 0x01 | |
50 | #define PCA963X_PWM_BASE 0x02 | |
af67384f | 51 | |
56a1740c | 52 | enum pca963x_type { |
af67384f RRD |
53 | pca9633, |
54 | pca9634, | |
3dfedb9d | 55 | pca9635, |
af67384f RRD |
56 | }; |
57 | ||
56a1740c | 58 | struct pca963x_chipdef { |
af67384f RRD |
59 | u8 grppwm; |
60 | u8 grpfreq; | |
61 | u8 ledout_base; | |
62 | int n_leds; | |
35c7d301 | 63 | unsigned int scaling; |
af67384f RRD |
64 | }; |
65 | ||
56a1740c | 66 | static struct pca963x_chipdef pca963x_chipdefs[] = { |
af67384f RRD |
67 | [pca9633] = { |
68 | .grppwm = 0x6, | |
69 | .grpfreq = 0x7, | |
70 | .ledout_base = 0x8, | |
71 | .n_leds = 4, | |
72 | }, | |
73 | [pca9634] = { | |
74 | .grppwm = 0xa, | |
75 | .grpfreq = 0xb, | |
76 | .ledout_base = 0xc, | |
77 | .n_leds = 8, | |
78 | }, | |
3dfedb9d PM |
79 | [pca9635] = { |
80 | .grppwm = 0x12, | |
81 | .grpfreq = 0x13, | |
82 | .ledout_base = 0x14, | |
83 | .n_leds = 16, | |
84 | }, | |
af67384f | 85 | }; |
75cb2e1d | 86 | |
8465b018 | 87 | /* Total blink period in milliseconds */ |
56a1740c RRD |
88 | #define PCA963X_BLINK_PERIOD_MIN 42 |
89 | #define PCA963X_BLINK_PERIOD_MAX 10667 | |
8465b018 | 90 | |
56a1740c | 91 | static const struct i2c_device_id pca963x_id[] = { |
af67384f RRD |
92 | { "pca9632", pca9633 }, |
93 | { "pca9633", pca9633 }, | |
94 | { "pca9634", pca9634 }, | |
3dfedb9d | 95 | { "pca9635", pca9635 }, |
75cb2e1d PM |
96 | { } |
97 | }; | |
56a1740c | 98 | MODULE_DEVICE_TABLE(i2c, pca963x_id); |
75cb2e1d | 99 | |
f26dab9f TH |
100 | static const struct acpi_device_id pca963x_acpi_ids[] = { |
101 | { "PCA9632", pca9633 }, | |
102 | { "PCA9633", pca9633 }, | |
103 | { "PCA9634", pca9634 }, | |
104 | { "PCA9635", pca9635 }, | |
105 | { } | |
106 | }; | |
107 | MODULE_DEVICE_TABLE(acpi, pca963x_acpi_ids); | |
108 | ||
56a1740c | 109 | struct pca963x_led; |
a7d0e988 | 110 | |
56a1740c RRD |
111 | struct pca963x { |
112 | struct pca963x_chipdef *chipdef; | |
a7d0e988 RRD |
113 | struct mutex mutex; |
114 | struct i2c_client *client; | |
56a1740c | 115 | struct pca963x_led *leds; |
a8c170b0 | 116 | unsigned long leds_on; |
a7d0e988 RRD |
117 | }; |
118 | ||
56a1740c RRD |
119 | struct pca963x_led { |
120 | struct pca963x *chip; | |
75cb2e1d | 121 | struct led_classdev led_cdev; |
3dfedb9d | 122 | int led_num; /* 0 .. 15 potentially */ |
75cb2e1d | 123 | char name[32]; |
8465b018 MG |
124 | u8 gdc; |
125 | u8 gfrq; | |
75cb2e1d PM |
126 | }; |
127 | ||
5029a2e3 AL |
128 | static int pca963x_brightness(struct pca963x_led *pca963x, |
129 | enum led_brightness brightness) | |
75cb2e1d | 130 | { |
56a1740c RRD |
131 | u8 ledout_addr = pca963x->chip->chipdef->ledout_base |
132 | + (pca963x->led_num / 4); | |
af67384f | 133 | u8 ledout; |
56a1740c | 134 | int shift = 2 * (pca963x->led_num % 4); |
75cb2e1d | 135 | u8 mask = 0x3 << shift; |
5029a2e3 | 136 | int ret; |
75cb2e1d | 137 | |
56a1740c | 138 | ledout = i2c_smbus_read_byte_data(pca963x->chip->client, ledout_addr); |
5029a2e3 | 139 | switch (brightness) { |
75cb2e1d | 140 | case LED_FULL: |
5029a2e3 AL |
141 | ret = i2c_smbus_write_byte_data(pca963x->chip->client, |
142 | ledout_addr, | |
56a1740c | 143 | (ledout & ~mask) | (PCA963X_LED_ON << shift)); |
75cb2e1d PM |
144 | break; |
145 | case LED_OFF: | |
5029a2e3 AL |
146 | ret = i2c_smbus_write_byte_data(pca963x->chip->client, |
147 | ledout_addr, ledout & ~mask); | |
75cb2e1d PM |
148 | break; |
149 | default: | |
5029a2e3 | 150 | ret = i2c_smbus_write_byte_data(pca963x->chip->client, |
56a1740c | 151 | PCA963X_PWM_BASE + pca963x->led_num, |
5029a2e3 AL |
152 | brightness); |
153 | if (ret < 0) | |
a8c170b0 | 154 | return ret; |
5029a2e3 AL |
155 | ret = i2c_smbus_write_byte_data(pca963x->chip->client, |
156 | ledout_addr, | |
56a1740c | 157 | (ledout & ~mask) | (PCA963X_LED_PWM << shift)); |
75cb2e1d PM |
158 | break; |
159 | } | |
a8c170b0 | 160 | |
5029a2e3 | 161 | return ret; |
75cb2e1d PM |
162 | } |
163 | ||
5029a2e3 | 164 | static void pca963x_blink(struct pca963x_led *pca963x) |
8465b018 | 165 | { |
56a1740c RRD |
166 | u8 ledout_addr = pca963x->chip->chipdef->ledout_base + |
167 | (pca963x->led_num / 4); | |
a7d0e988 | 168 | u8 ledout; |
56a1740c RRD |
169 | u8 mode2 = i2c_smbus_read_byte_data(pca963x->chip->client, |
170 | PCA963X_MODE2); | |
171 | int shift = 2 * (pca963x->led_num % 4); | |
8465b018 MG |
172 | u8 mask = 0x3 << shift; |
173 | ||
56a1740c RRD |
174 | i2c_smbus_write_byte_data(pca963x->chip->client, |
175 | pca963x->chip->chipdef->grppwm, pca963x->gdc); | |
8465b018 | 176 | |
56a1740c RRD |
177 | i2c_smbus_write_byte_data(pca963x->chip->client, |
178 | pca963x->chip->chipdef->grpfreq, pca963x->gfrq); | |
8465b018 | 179 | |
56a1740c RRD |
180 | if (!(mode2 & PCA963X_MODE2_DMBLNK)) |
181 | i2c_smbus_write_byte_data(pca963x->chip->client, PCA963X_MODE2, | |
182 | mode2 | PCA963X_MODE2_DMBLNK); | |
8465b018 | 183 | |
56a1740c RRD |
184 | mutex_lock(&pca963x->chip->mutex); |
185 | ledout = i2c_smbus_read_byte_data(pca963x->chip->client, ledout_addr); | |
186 | if ((ledout & mask) != (PCA963X_LED_GRP_PWM << shift)) | |
187 | i2c_smbus_write_byte_data(pca963x->chip->client, ledout_addr, | |
188 | (ledout & ~mask) | (PCA963X_LED_GRP_PWM << shift)); | |
189 | mutex_unlock(&pca963x->chip->mutex); | |
8465b018 MG |
190 | } |
191 | ||
a8c170b0 MR |
192 | static int pca963x_power_state(struct pca963x_led *pca963x) |
193 | { | |
194 | unsigned long *leds_on = &pca963x->chip->leds_on; | |
195 | unsigned long cached_leds = pca963x->chip->leds_on; | |
196 | ||
197 | if (pca963x->led_cdev.brightness) | |
198 | set_bit(pca963x->led_num, leds_on); | |
199 | else | |
200 | clear_bit(pca963x->led_num, leds_on); | |
201 | ||
202 | if (!(*leds_on) != !cached_leds) | |
203 | return i2c_smbus_write_byte_data(pca963x->chip->client, | |
204 | PCA963X_MODE1, *leds_on ? 0 : BIT(4)); | |
205 | ||
206 | return 0; | |
207 | } | |
208 | ||
5029a2e3 | 209 | static int pca963x_led_set(struct led_classdev *led_cdev, |
75cb2e1d PM |
210 | enum led_brightness value) |
211 | { | |
56a1740c | 212 | struct pca963x_led *pca963x; |
a8c170b0 | 213 | int ret; |
75cb2e1d | 214 | |
56a1740c | 215 | pca963x = container_of(led_cdev, struct pca963x_led, led_cdev); |
75cb2e1d | 216 | |
a8c170b0 MR |
217 | mutex_lock(&pca963x->chip->mutex); |
218 | ||
219 | ret = pca963x_brightness(pca963x, value); | |
220 | if (ret < 0) | |
221 | goto unlock; | |
222 | ret = pca963x_power_state(pca963x); | |
223 | ||
224 | unlock: | |
225 | mutex_unlock(&pca963x->chip->mutex); | |
226 | return ret; | |
75cb2e1d PM |
227 | } |
228 | ||
35c7d301 MR |
229 | static unsigned int pca963x_period_scale(struct pca963x_led *pca963x, |
230 | unsigned int val) | |
231 | { | |
232 | unsigned int scaling = pca963x->chip->chipdef->scaling; | |
233 | ||
234 | return scaling ? DIV_ROUND_CLOSEST(val * scaling, 1000) : val; | |
235 | } | |
236 | ||
56a1740c | 237 | static int pca963x_blink_set(struct led_classdev *led_cdev, |
8465b018 MG |
238 | unsigned long *delay_on, unsigned long *delay_off) |
239 | { | |
56a1740c | 240 | struct pca963x_led *pca963x; |
8465b018 MG |
241 | unsigned long time_on, time_off, period; |
242 | u8 gdc, gfrq; | |
243 | ||
56a1740c | 244 | pca963x = container_of(led_cdev, struct pca963x_led, led_cdev); |
8465b018 MG |
245 | |
246 | time_on = *delay_on; | |
247 | time_off = *delay_off; | |
248 | ||
249 | /* If both zero, pick reasonable defaults of 500ms each */ | |
250 | if (!time_on && !time_off) { | |
251 | time_on = 500; | |
252 | time_off = 500; | |
253 | } | |
254 | ||
35c7d301 | 255 | period = pca963x_period_scale(pca963x, time_on + time_off); |
8465b018 MG |
256 | |
257 | /* If period not supported by hardware, default to someting sane. */ | |
56a1740c RRD |
258 | if ((period < PCA963X_BLINK_PERIOD_MIN) || |
259 | (period > PCA963X_BLINK_PERIOD_MAX)) { | |
8465b018 MG |
260 | time_on = 500; |
261 | time_off = 500; | |
35c7d301 | 262 | period = pca963x_period_scale(pca963x, 1000); |
8465b018 MG |
263 | } |
264 | ||
265 | /* | |
266 | * From manual: duty cycle = (GDC / 256) -> | |
267 | * (time_on / period) = (GDC / 256) -> | |
268 | * GDC = ((time_on * 256) / period) | |
269 | */ | |
35c7d301 | 270 | gdc = (pca963x_period_scale(pca963x, time_on) * 256) / period; |
8465b018 MG |
271 | |
272 | /* | |
273 | * From manual: period = ((GFRQ + 1) / 24) in seconds. | |
274 | * So, period (in ms) = (((GFRQ + 1) / 24) * 1000) -> | |
275 | * GFRQ = ((period * 24 / 1000) - 1) | |
276 | */ | |
277 | gfrq = (period * 24 / 1000) - 1; | |
278 | ||
56a1740c RRD |
279 | pca963x->gdc = gdc; |
280 | pca963x->gfrq = gfrq; | |
8465b018 | 281 | |
5029a2e3 | 282 | pca963x_blink(pca963x); |
8465b018 MG |
283 | |
284 | *delay_on = time_on; | |
285 | *delay_off = time_off; | |
286 | ||
287 | return 0; | |
288 | } | |
289 | ||
81d22878 | 290 | #if IS_ENABLED(CONFIG_OF) |
56a1740c RRD |
291 | static struct pca963x_platform_data * |
292 | pca963x_dt_init(struct i2c_client *client, struct pca963x_chipdef *chip) | |
81d22878 TL |
293 | { |
294 | struct device_node *np = client->dev.of_node, *child; | |
56a1740c RRD |
295 | struct pca963x_platform_data *pdata; |
296 | struct led_info *pca963x_leds; | |
81d22878 TL |
297 | int count; |
298 | ||
299 | count = of_get_child_count(np); | |
af67384f | 300 | if (!count || count > chip->n_leds) |
81d22878 TL |
301 | return ERR_PTR(-ENODEV); |
302 | ||
56a1740c | 303 | pca963x_leds = devm_kzalloc(&client->dev, |
af67384f | 304 | sizeof(struct led_info) * chip->n_leds, GFP_KERNEL); |
56a1740c | 305 | if (!pca963x_leds) |
81d22878 TL |
306 | return ERR_PTR(-ENOMEM); |
307 | ||
308 | for_each_child_of_node(np, child) { | |
a44b0f5e | 309 | struct led_info led = {}; |
81d22878 TL |
310 | u32 reg; |
311 | int res; | |
312 | ||
8a6acd64 RRD |
313 | res = of_property_read_u32(child, "reg", ®); |
314 | if ((res != 0) || (reg >= chip->n_leds)) | |
315 | continue; | |
81d22878 TL |
316 | led.name = |
317 | of_get_property(child, "label", NULL) ? : child->name; | |
318 | led.default_trigger = | |
319 | of_get_property(child, "linux,default-trigger", NULL); | |
56a1740c | 320 | pca963x_leds[reg] = led; |
81d22878 TL |
321 | } |
322 | pdata = devm_kzalloc(&client->dev, | |
56a1740c | 323 | sizeof(struct pca963x_platform_data), GFP_KERNEL); |
81d22878 TL |
324 | if (!pdata) |
325 | return ERR_PTR(-ENOMEM); | |
326 | ||
56a1740c | 327 | pdata->leds.leds = pca963x_leds; |
8a6acd64 | 328 | pdata->leds.num_leds = chip->n_leds; |
81d22878 TL |
329 | |
330 | /* default to open-drain unless totem pole (push-pull) is specified */ | |
331 | if (of_property_read_bool(np, "nxp,totem-pole")) | |
56a1740c | 332 | pdata->outdrv = PCA963X_TOTEM_POLE; |
81d22878 | 333 | else |
56a1740c | 334 | pdata->outdrv = PCA963X_OPEN_DRAIN; |
81d22878 | 335 | |
8465b018 MG |
336 | /* default to software blinking unless hardware blinking is specified */ |
337 | if (of_property_read_bool(np, "nxp,hw-blink")) | |
56a1740c | 338 | pdata->blink_type = PCA963X_HW_BLINK; |
8465b018 | 339 | else |
56a1740c | 340 | pdata->blink_type = PCA963X_SW_BLINK; |
8465b018 | 341 | |
35c7d301 MR |
342 | if (of_property_read_u32(np, "nxp,period-scale", &chip->scaling)) |
343 | chip->scaling = 1000; | |
344 | ||
bb29b9cc AD |
345 | /* default to non-inverted output, unless inverted is specified */ |
346 | if (of_property_read_bool(np, "nxp,inverted-out")) | |
347 | pdata->dir = PCA963X_INVERTED; | |
348 | else | |
349 | pdata->dir = PCA963X_NORMAL; | |
350 | ||
81d22878 TL |
351 | return pdata; |
352 | } | |
353 | ||
56a1740c | 354 | static const struct of_device_id of_pca963x_match[] = { |
af67384f RRD |
355 | { .compatible = "nxp,pca9632", }, |
356 | { .compatible = "nxp,pca9633", }, | |
357 | { .compatible = "nxp,pca9634", }, | |
3dfedb9d | 358 | { .compatible = "nxp,pca9635", }, |
81d22878 TL |
359 | {}, |
360 | }; | |
4d59ed85 | 361 | MODULE_DEVICE_TABLE(of, of_pca963x_match); |
81d22878 | 362 | #else |
56a1740c RRD |
363 | static struct pca963x_platform_data * |
364 | pca963x_dt_init(struct i2c_client *client, struct pca963x_chipdef *chip) | |
81d22878 TL |
365 | { |
366 | return ERR_PTR(-ENODEV); | |
367 | } | |
368 | #endif | |
369 | ||
56a1740c | 370 | static int pca963x_probe(struct i2c_client *client, |
75cb2e1d PM |
371 | const struct i2c_device_id *id) |
372 | { | |
56a1740c RRD |
373 | struct pca963x *pca963x_chip; |
374 | struct pca963x_led *pca963x; | |
375 | struct pca963x_platform_data *pdata; | |
376 | struct pca963x_chipdef *chip; | |
75cb2e1d PM |
377 | int i, err; |
378 | ||
f26dab9f TH |
379 | if (id) { |
380 | chip = &pca963x_chipdefs[id->driver_data]; | |
381 | } else { | |
382 | const struct acpi_device_id *acpi_id; | |
383 | ||
384 | acpi_id = acpi_match_device(pca963x_acpi_ids, &client->dev); | |
385 | if (!acpi_id) | |
386 | return -ENODEV; | |
387 | chip = &pca963x_chipdefs[acpi_id->driver_data]; | |
388 | } | |
87aae1ea | 389 | pdata = dev_get_platdata(&client->dev); |
75cb2e1d | 390 | |
81d22878 | 391 | if (!pdata) { |
56a1740c | 392 | pdata = pca963x_dt_init(client, chip); |
81d22878 TL |
393 | if (IS_ERR(pdata)) { |
394 | dev_warn(&client->dev, "could not parse configuration\n"); | |
395 | pdata = NULL; | |
396 | } | |
397 | } | |
398 | ||
af67384f RRD |
399 | if (pdata && (pdata->leds.num_leds < 1 || |
400 | pdata->leds.num_leds > chip->n_leds)) { | |
401 | dev_err(&client->dev, "board info must claim 1-%d LEDs", | |
402 | chip->n_leds); | |
403 | return -EINVAL; | |
75cb2e1d PM |
404 | } |
405 | ||
56a1740c | 406 | pca963x_chip = devm_kzalloc(&client->dev, sizeof(*pca963x_chip), |
a7d0e988 | 407 | GFP_KERNEL); |
56a1740c | 408 | if (!pca963x_chip) |
a7d0e988 | 409 | return -ENOMEM; |
56a1740c | 410 | pca963x = devm_kzalloc(&client->dev, chip->n_leds * sizeof(*pca963x), |
af67384f | 411 | GFP_KERNEL); |
56a1740c | 412 | if (!pca963x) |
75cb2e1d PM |
413 | return -ENOMEM; |
414 | ||
56a1740c | 415 | i2c_set_clientdata(client, pca963x_chip); |
a7d0e988 | 416 | |
56a1740c RRD |
417 | mutex_init(&pca963x_chip->mutex); |
418 | pca963x_chip->chipdef = chip; | |
419 | pca963x_chip->client = client; | |
420 | pca963x_chip->leds = pca963x; | |
a7d0e988 RRD |
421 | |
422 | /* Turn off LEDs by default*/ | |
3dfedb9d PM |
423 | for (i = 0; i < chip->n_leds / 4; i++) |
424 | i2c_smbus_write_byte_data(client, chip->ledout_base + i, 0x00); | |
75cb2e1d | 425 | |
af67384f | 426 | for (i = 0; i < chip->n_leds; i++) { |
56a1740c RRD |
427 | pca963x[i].led_num = i; |
428 | pca963x[i].chip = pca963x_chip; | |
75cb2e1d PM |
429 | |
430 | /* Platform data can specify LED names and default triggers */ | |
2f73c392 PM |
431 | if (pdata && i < pdata->leds.num_leds) { |
432 | if (pdata->leds.leds[i].name) | |
56a1740c RRD |
433 | snprintf(pca963x[i].name, |
434 | sizeof(pca963x[i].name), "pca963x:%s", | |
2f73c392 PM |
435 | pdata->leds.leds[i].name); |
436 | if (pdata->leds.leds[i].default_trigger) | |
56a1740c | 437 | pca963x[i].led_cdev.default_trigger = |
2f73c392 | 438 | pdata->leds.leds[i].default_trigger; |
75cb2e1d | 439 | } |
a5cd98b7 RRD |
440 | if (!pdata || i >= pdata->leds.num_leds || |
441 | !pdata->leds.leds[i].name) | |
56a1740c RRD |
442 | snprintf(pca963x[i].name, sizeof(pca963x[i].name), |
443 | "pca963x:%d:%.2x:%d", client->adapter->nr, | |
a5cd98b7 | 444 | client->addr, i); |
75cb2e1d | 445 | |
56a1740c | 446 | pca963x[i].led_cdev.name = pca963x[i].name; |
5029a2e3 | 447 | pca963x[i].led_cdev.brightness_set_blocking = pca963x_led_set; |
75cb2e1d | 448 | |
56a1740c RRD |
449 | if (pdata && pdata->blink_type == PCA963X_HW_BLINK) |
450 | pca963x[i].led_cdev.blink_set = pca963x_blink_set; | |
8465b018 | 451 | |
56a1740c | 452 | err = led_classdev_register(&client->dev, &pca963x[i].led_cdev); |
75cb2e1d PM |
453 | if (err < 0) |
454 | goto exit; | |
455 | } | |
456 | ||
a8c170b0 MR |
457 | /* Disable LED all-call address, and power down initially */ |
458 | i2c_smbus_write_byte_data(client, PCA963X_MODE1, BIT(4)); | |
75cb2e1d | 459 | |
0c62f42d | 460 | if (pdata) { |
bb29b9cc AD |
461 | u8 mode2 = i2c_smbus_read_byte_data(pca963x->chip->client, |
462 | PCA963X_MODE2); | |
0c62f42d PM |
463 | /* Configure output: open-drain or totem pole (push-pull) */ |
464 | if (pdata->outdrv == PCA963X_OPEN_DRAIN) | |
bb29b9cc | 465 | mode2 |= 0x01; |
0c62f42d | 466 | else |
bb29b9cc AD |
467 | mode2 |= 0x05; |
468 | /* Configure direction: normal or inverted */ | |
469 | if (pdata->dir == PCA963X_INVERTED) | |
470 | mode2 |= 0x10; | |
471 | i2c_smbus_write_byte_data(pca963x->chip->client, PCA963X_MODE2, | |
472 | mode2); | |
0c62f42d | 473 | } |
2f73c392 | 474 | |
75cb2e1d PM |
475 | return 0; |
476 | ||
477 | exit: | |
5029a2e3 | 478 | while (i--) |
56a1740c | 479 | led_classdev_unregister(&pca963x[i].led_cdev); |
75cb2e1d | 480 | |
75cb2e1d PM |
481 | return err; |
482 | } | |
483 | ||
56a1740c | 484 | static int pca963x_remove(struct i2c_client *client) |
75cb2e1d | 485 | { |
56a1740c | 486 | struct pca963x *pca963x = i2c_get_clientdata(client); |
75cb2e1d PM |
487 | int i; |
488 | ||
5029a2e3 | 489 | for (i = 0; i < pca963x->chipdef->n_leds; i++) |
56a1740c | 490 | led_classdev_unregister(&pca963x->leds[i].led_cdev); |
75cb2e1d | 491 | |
75cb2e1d PM |
492 | return 0; |
493 | } | |
494 | ||
56a1740c | 495 | static struct i2c_driver pca963x_driver = { |
75cb2e1d | 496 | .driver = { |
56a1740c | 497 | .name = "leds-pca963x", |
56a1740c | 498 | .of_match_table = of_match_ptr(of_pca963x_match), |
f26dab9f | 499 | .acpi_match_table = ACPI_PTR(pca963x_acpi_ids), |
75cb2e1d | 500 | }, |
56a1740c RRD |
501 | .probe = pca963x_probe, |
502 | .remove = pca963x_remove, | |
503 | .id_table = pca963x_id, | |
75cb2e1d PM |
504 | }; |
505 | ||
56a1740c | 506 | module_i2c_driver(pca963x_driver); |
75cb2e1d PM |
507 | |
508 | MODULE_AUTHOR("Peter Meerwald <p.meerwald@bct-electronic.com>"); | |
56a1740c | 509 | MODULE_DESCRIPTION("PCA963X LED driver"); |
75cb2e1d | 510 | MODULE_LICENSE("GPL v2"); |