2 * lp5523.c - LP5523 LED Driver
4 * Copyright (C) 2010 Nokia Corporation
5 * Copyright (C) 2012 Texas Instruments
7 * Contact: Samu Onkalo <samu.p.onkalo@nokia.com>
8 * Milo(Woogyom) Kim <milo.kim@ti.com>
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * version 2 as published by the Free Software Foundation.
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
25 #include <linux/delay.h>
26 #include <linux/firmware.h>
27 #include <linux/i2c.h>
28 #include <linux/init.h>
29 #include <linux/leds.h>
30 #include <linux/module.h>
31 #include <linux/mutex.h>
33 #include <linux/platform_data/leds-lp55xx.h>
34 #include <linux/slab.h>
36 #include "leds-lp55xx-common.h"
38 #define LP5523_PROGRAM_LENGTH 32 /* bytes */
39 /* Memory is used like this:
43 0x30 engine 1 muxing info
44 0x40 engine 2 muxing info
45 0x50 engine 3 muxing info
47 #define LP5523_MAX_LEDS 9
50 #define LP5523_REG_ENABLE 0x00
51 #define LP5523_REG_OP_MODE 0x01
52 #define LP5523_REG_ENABLE_LEDS_MSB 0x04
53 #define LP5523_REG_ENABLE_LEDS_LSB 0x05
54 #define LP5523_REG_LED_PWM_BASE 0x16
55 #define LP5523_REG_LED_CURRENT_BASE 0x26
56 #define LP5523_REG_CONFIG 0x36
57 #define LP5523_REG_STATUS 0x3A
58 #define LP5523_REG_RESET 0x3D
59 #define LP5523_REG_LED_TEST_CTRL 0x41
60 #define LP5523_REG_LED_TEST_ADC 0x42
61 #define LP5523_REG_CH1_PROG_START 0x4C
62 #define LP5523_REG_CH2_PROG_START 0x4D
63 #define LP5523_REG_CH3_PROG_START 0x4E
64 #define LP5523_REG_PROG_PAGE_SEL 0x4F
65 #define LP5523_REG_PROG_MEM 0x50
67 /* Bit description in registers */
68 #define LP5523_ENABLE 0x40
69 #define LP5523_AUTO_INC 0x40
70 #define LP5523_PWR_SAVE 0x20
71 #define LP5523_PWM_PWR_SAVE 0x04
72 #define LP5523_CP_AUTO 0x18
73 #define LP5523_AUTO_CLK 0x02
75 #define LP5523_EN_LEDTEST 0x80
76 #define LP5523_LEDTEST_DONE 0x80
77 #define LP5523_RESET 0xFF
78 #define LP5523_ADC_SHORTCIRC_LIM 80
79 #define LP5523_EXT_CLK_USED 0x08
80 #define LP5523_ENG_STATUS_MASK 0x07
82 /* Memory Page Selection */
83 #define LP5523_PAGE_ENG1 0
84 #define LP5523_PAGE_ENG2 1
85 #define LP5523_PAGE_ENG3 2
86 #define LP5523_PAGE_MUX1 3
87 #define LP5523_PAGE_MUX2 4
88 #define LP5523_PAGE_MUX3 5
90 /* Program Memory Operations */
91 #define LP5523_MODE_ENG1_M 0x30 /* Operation Mode Register */
92 #define LP5523_MODE_ENG2_M 0x0C
93 #define LP5523_MODE_ENG3_M 0x03
94 #define LP5523_LOAD_ENG1 0x10
95 #define LP5523_LOAD_ENG2 0x04
96 #define LP5523_LOAD_ENG3 0x01
98 #define LP5523_ENG1_IS_LOADING(mode) \
99 ((mode & LP5523_MODE_ENG1_M) == LP5523_LOAD_ENG1)
100 #define LP5523_ENG2_IS_LOADING(mode) \
101 ((mode & LP5523_MODE_ENG2_M) == LP5523_LOAD_ENG2)
102 #define LP5523_ENG3_IS_LOADING(mode) \
103 ((mode & LP5523_MODE_ENG3_M) == LP5523_LOAD_ENG3)
105 #define LP5523_EXEC_ENG1_M 0x30 /* Enable Register */
106 #define LP5523_EXEC_ENG2_M 0x0C
107 #define LP5523_EXEC_ENG3_M 0x03
108 #define LP5523_EXEC_M 0x3F
109 #define LP5523_RUN_ENG1 0x20
110 #define LP5523_RUN_ENG2 0x08
111 #define LP5523_RUN_ENG3 0x02
113 #define LED_ACTIVE(mux, led) (!!(mux & (0x0001 << led)))
115 enum lp5523_chip_id
{
120 static int lp5523_init_program_engine(struct lp55xx_chip
*chip
);
122 static inline void lp5523_wait_opmode_done(void)
124 usleep_range(1000, 2000);
127 static void lp5523_set_led_current(struct lp55xx_led
*led
, u8 led_current
)
129 led
->led_current
= led_current
;
130 lp55xx_write(led
->chip
, LP5523_REG_LED_CURRENT_BASE
+ led
->chan_nr
,
134 static int lp5523_post_init_device(struct lp55xx_chip
*chip
)
138 ret
= lp55xx_write(chip
, LP5523_REG_ENABLE
, LP5523_ENABLE
);
142 /* Chip startup time is 500 us, 1 - 2 ms gives some margin */
143 usleep_range(1000, 2000);
145 ret
= lp55xx_write(chip
, LP5523_REG_CONFIG
,
146 LP5523_AUTO_INC
| LP5523_PWR_SAVE
|
147 LP5523_CP_AUTO
| LP5523_AUTO_CLK
|
148 LP5523_PWM_PWR_SAVE
);
152 /* turn on all leds */
153 ret
= lp55xx_write(chip
, LP5523_REG_ENABLE_LEDS_MSB
, 0x01);
157 ret
= lp55xx_write(chip
, LP5523_REG_ENABLE_LEDS_LSB
, 0xff);
161 return lp5523_init_program_engine(chip
);
164 static void lp5523_load_engine(struct lp55xx_chip
*chip
)
166 enum lp55xx_engine_index idx
= chip
->engine_idx
;
168 [LP55XX_ENGINE_1
] = LP5523_MODE_ENG1_M
,
169 [LP55XX_ENGINE_2
] = LP5523_MODE_ENG2_M
,
170 [LP55XX_ENGINE_3
] = LP5523_MODE_ENG3_M
,
174 [LP55XX_ENGINE_1
] = LP5523_LOAD_ENG1
,
175 [LP55XX_ENGINE_2
] = LP5523_LOAD_ENG2
,
176 [LP55XX_ENGINE_3
] = LP5523_LOAD_ENG3
,
179 lp55xx_update_bits(chip
, LP5523_REG_OP_MODE
, mask
[idx
], val
[idx
]);
181 lp5523_wait_opmode_done();
184 static void lp5523_load_engine_and_select_page(struct lp55xx_chip
*chip
)
186 enum lp55xx_engine_index idx
= chip
->engine_idx
;
188 [LP55XX_ENGINE_1
] = LP5523_PAGE_ENG1
,
189 [LP55XX_ENGINE_2
] = LP5523_PAGE_ENG2
,
190 [LP55XX_ENGINE_3
] = LP5523_PAGE_ENG3
,
193 lp5523_load_engine(chip
);
195 lp55xx_write(chip
, LP5523_REG_PROG_PAGE_SEL
, page_sel
[idx
]);
198 static void lp5523_stop_engine(struct lp55xx_chip
*chip
)
200 lp55xx_write(chip
, LP5523_REG_OP_MODE
, 0);
201 lp5523_wait_opmode_done();
204 static void lp5523_turn_off_channels(struct lp55xx_chip
*chip
)
208 for (i
= 0; i
< LP5523_MAX_LEDS
; i
++)
209 lp55xx_write(chip
, LP5523_REG_LED_PWM_BASE
+ i
, 0);
212 static void lp5523_run_engine(struct lp55xx_chip
*chip
, bool start
)
220 lp5523_stop_engine(chip
);
221 lp5523_turn_off_channels(chip
);
227 * operation mode and enable register should updated at the same time
230 ret
= lp55xx_read(chip
, LP5523_REG_OP_MODE
, &mode
);
234 ret
= lp55xx_read(chip
, LP5523_REG_ENABLE
, &exec
);
238 /* change operation mode to RUN only when each engine is loading */
239 if (LP5523_ENG1_IS_LOADING(mode
)) {
240 mode
= (mode
& ~LP5523_MODE_ENG1_M
) | LP5523_RUN_ENG1
;
241 exec
= (exec
& ~LP5523_EXEC_ENG1_M
) | LP5523_RUN_ENG1
;
244 if (LP5523_ENG2_IS_LOADING(mode
)) {
245 mode
= (mode
& ~LP5523_MODE_ENG2_M
) | LP5523_RUN_ENG2
;
246 exec
= (exec
& ~LP5523_EXEC_ENG2_M
) | LP5523_RUN_ENG2
;
249 if (LP5523_ENG3_IS_LOADING(mode
)) {
250 mode
= (mode
& ~LP5523_MODE_ENG3_M
) | LP5523_RUN_ENG3
;
251 exec
= (exec
& ~LP5523_EXEC_ENG3_M
) | LP5523_RUN_ENG3
;
254 lp55xx_write(chip
, LP5523_REG_OP_MODE
, mode
);
255 lp5523_wait_opmode_done();
257 lp55xx_update_bits(chip
, LP5523_REG_ENABLE
, LP5523_EXEC_M
, exec
);
260 static int lp5523_init_program_engine(struct lp55xx_chip
*chip
)
266 /* one pattern per engine setting LED MUX start and stop addresses */
267 static const u8 pattern
[][LP5523_PROGRAM_LENGTH
] = {
268 { 0x9c, 0x30, 0x9c, 0xb0, 0x9d, 0x80, 0xd8, 0x00, 0},
269 { 0x9c, 0x40, 0x9c, 0xc0, 0x9d, 0x80, 0xd8, 0x00, 0},
270 { 0x9c, 0x50, 0x9c, 0xd0, 0x9d, 0x80, 0xd8, 0x00, 0},
273 /* hardcode 32 bytes of memory for each engine from program memory */
274 ret
= lp55xx_write(chip
, LP5523_REG_CH1_PROG_START
, 0x00);
278 ret
= lp55xx_write(chip
, LP5523_REG_CH2_PROG_START
, 0x10);
282 ret
= lp55xx_write(chip
, LP5523_REG_CH3_PROG_START
, 0x20);
286 /* write LED MUX address space for each engine */
287 for (i
= LP55XX_ENGINE_1
; i
<= LP55XX_ENGINE_3
; i
++) {
288 chip
->engine_idx
= i
;
289 lp5523_load_engine_and_select_page(chip
);
291 for (j
= 0; j
< LP5523_PROGRAM_LENGTH
; j
++) {
292 ret
= lp55xx_write(chip
, LP5523_REG_PROG_MEM
+ j
,
299 lp5523_run_engine(chip
, true);
301 /* Let the programs run for couple of ms and check the engine status */
302 usleep_range(3000, 6000);
303 lp55xx_read(chip
, LP5523_REG_STATUS
, &status
);
304 status
&= LP5523_ENG_STATUS_MASK
;
306 if (status
!= LP5523_ENG_STATUS_MASK
) {
307 dev_err(&chip
->cl
->dev
,
308 "cound not configure LED engine, status = 0x%.2x\n",
314 lp5523_stop_engine(chip
);
318 static int lp5523_update_program_memory(struct lp55xx_chip
*chip
,
319 const u8
*data
, size_t size
)
321 u8 pattern
[LP5523_PROGRAM_LENGTH
] = {0};
329 while ((offset
< size
- 1) && (i
< LP5523_PROGRAM_LENGTH
)) {
330 /* separate sscanfs because length is working only for %s */
331 ret
= sscanf(data
+ offset
, "%2s%n ", c
, &nrchars
);
335 ret
= sscanf(c
, "%2x", &cmd
);
339 pattern
[i
] = (u8
)cmd
;
344 /* Each instruction is 16bit long. Check that length is even */
348 for (i
= 0; i
< LP5523_PROGRAM_LENGTH
; i
++) {
349 ret
= lp55xx_write(chip
, LP5523_REG_PROG_MEM
+ i
, pattern
[i
]);
357 dev_err(&chip
->cl
->dev
, "wrong pattern format\n");
361 static void lp5523_firmware_loaded(struct lp55xx_chip
*chip
)
363 const struct firmware
*fw
= chip
->fw
;
365 if (fw
->size
> LP5523_PROGRAM_LENGTH
) {
366 dev_err(&chip
->cl
->dev
, "firmware data size overflow: %zu\n",
372 * Program momery sequence
373 * 1) set engine mode to "LOAD"
374 * 2) write firmware data into program memory
377 lp5523_load_engine_and_select_page(chip
);
378 lp5523_update_program_memory(chip
, fw
->data
, fw
->size
);
381 static ssize_t
show_engine_mode(struct device
*dev
,
382 struct device_attribute
*attr
,
385 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
386 struct lp55xx_chip
*chip
= led
->chip
;
387 enum lp55xx_engine_mode mode
= chip
->engines
[nr
- 1].mode
;
390 case LP55XX_ENGINE_RUN
:
391 return sprintf(buf
, "run\n");
392 case LP55XX_ENGINE_LOAD
:
393 return sprintf(buf
, "load\n");
394 case LP55XX_ENGINE_DISABLED
:
396 return sprintf(buf
, "disabled\n");
403 static ssize_t
store_engine_mode(struct device
*dev
,
404 struct device_attribute
*attr
,
405 const char *buf
, size_t len
, int nr
)
407 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
408 struct lp55xx_chip
*chip
= led
->chip
;
409 struct lp55xx_engine
*engine
= &chip
->engines
[nr
- 1];
411 mutex_lock(&chip
->lock
);
413 chip
->engine_idx
= nr
;
415 if (!strncmp(buf
, "run", 3)) {
416 lp5523_run_engine(chip
, true);
417 engine
->mode
= LP55XX_ENGINE_RUN
;
418 } else if (!strncmp(buf
, "load", 4)) {
419 lp5523_stop_engine(chip
);
420 lp5523_load_engine(chip
);
421 engine
->mode
= LP55XX_ENGINE_LOAD
;
422 } else if (!strncmp(buf
, "disabled", 8)) {
423 lp5523_stop_engine(chip
);
424 engine
->mode
= LP55XX_ENGINE_DISABLED
;
427 mutex_unlock(&chip
->lock
);
435 static int lp5523_mux_parse(const char *buf
, u16
*mux
, size_t len
)
440 len
= min_t(int, len
, LP5523_MAX_LEDS
);
442 for (i
= 0; i
< len
; i
++) {
461 static void lp5523_mux_to_array(u16 led_mux
, char *array
)
464 for (i
= 0; i
< LP5523_MAX_LEDS
; i
++)
465 pos
+= sprintf(array
+ pos
, "%x", LED_ACTIVE(led_mux
, i
));
470 static ssize_t
show_engine_leds(struct device
*dev
,
471 struct device_attribute
*attr
,
474 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
475 struct lp55xx_chip
*chip
= led
->chip
;
476 char mux
[LP5523_MAX_LEDS
+ 1];
478 lp5523_mux_to_array(chip
->engines
[nr
- 1].led_mux
, mux
);
480 return sprintf(buf
, "%s\n", mux
);
486 static int lp5523_load_mux(struct lp55xx_chip
*chip
, u16 mux
, int nr
)
488 struct lp55xx_engine
*engine
= &chip
->engines
[nr
- 1];
491 [LP55XX_ENGINE_1
] = LP5523_PAGE_MUX1
,
492 [LP55XX_ENGINE_2
] = LP5523_PAGE_MUX2
,
493 [LP55XX_ENGINE_3
] = LP5523_PAGE_MUX3
,
496 lp5523_load_engine(chip
);
498 ret
= lp55xx_write(chip
, LP5523_REG_PROG_PAGE_SEL
, mux_page
[nr
]);
502 ret
= lp55xx_write(chip
, LP5523_REG_PROG_MEM
, (u8
)(mux
>> 8));
506 ret
= lp55xx_write(chip
, LP5523_REG_PROG_MEM
+ 1, (u8
)(mux
));
510 engine
->led_mux
= mux
;
514 static ssize_t
store_engine_leds(struct device
*dev
,
515 struct device_attribute
*attr
,
516 const char *buf
, size_t len
, int nr
)
518 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
519 struct lp55xx_chip
*chip
= led
->chip
;
520 struct lp55xx_engine
*engine
= &chip
->engines
[nr
- 1];
524 if (lp5523_mux_parse(buf
, &mux
, len
))
527 mutex_lock(&chip
->lock
);
529 chip
->engine_idx
= nr
;
532 if (engine
->mode
!= LP55XX_ENGINE_LOAD
)
535 if (lp5523_load_mux(chip
, mux
, nr
))
540 mutex_unlock(&chip
->lock
);
547 static ssize_t
store_engine_load(struct device
*dev
,
548 struct device_attribute
*attr
,
549 const char *buf
, size_t len
, int nr
)
551 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
552 struct lp55xx_chip
*chip
= led
->chip
;
555 mutex_lock(&chip
->lock
);
557 chip
->engine_idx
= nr
;
558 lp5523_load_engine_and_select_page(chip
);
559 ret
= lp5523_update_program_memory(chip
, buf
, len
);
561 mutex_unlock(&chip
->lock
);
569 static ssize_t
lp5523_selftest(struct device
*dev
,
570 struct device_attribute
*attr
,
573 struct lp55xx_led
*led
= i2c_get_clientdata(to_i2c_client(dev
));
574 struct lp55xx_chip
*chip
= led
->chip
;
575 struct lp55xx_platform_data
*pdata
= chip
->pdata
;
579 mutex_lock(&chip
->lock
);
581 ret
= lp55xx_read(chip
, LP5523_REG_STATUS
, &status
);
585 /* Check that ext clock is really in use if requested */
586 if (pdata
->clock_mode
== LP55XX_CLOCK_EXT
) {
587 if ((status
& LP5523_EXT_CLK_USED
) == 0)
591 /* Measure VDD (i.e. VBAT) first (channel 16 corresponds to VDD) */
592 lp55xx_write(chip
, LP5523_REG_LED_TEST_CTRL
, LP5523_EN_LEDTEST
| 16);
593 usleep_range(3000, 6000); /* ADC conversion time is typically 2.7 ms */
594 ret
= lp55xx_read(chip
, LP5523_REG_STATUS
, &status
);
598 if (!(status
& LP5523_LEDTEST_DONE
))
599 usleep_range(3000, 6000); /* Was not ready. Wait little bit */
601 ret
= lp55xx_read(chip
, LP5523_REG_LED_TEST_ADC
, &vdd
);
605 vdd
--; /* There may be some fluctuation in measurement */
607 for (i
= 0; i
< LP5523_MAX_LEDS
; i
++) {
608 /* Skip non-existing channels */
609 if (pdata
->led_config
[i
].led_current
== 0)
612 /* Set default current */
613 lp55xx_write(chip
, LP5523_REG_LED_CURRENT_BASE
+ i
,
614 pdata
->led_config
[i
].led_current
);
616 lp55xx_write(chip
, LP5523_REG_LED_PWM_BASE
+ i
, 0xff);
617 /* let current stabilize 2 - 4ms before measurements start */
618 usleep_range(2000, 4000);
619 lp55xx_write(chip
, LP5523_REG_LED_TEST_CTRL
,
620 LP5523_EN_LEDTEST
| i
);
621 /* ADC conversion time is 2.7 ms typically */
622 usleep_range(3000, 6000);
623 ret
= lp55xx_read(chip
, LP5523_REG_STATUS
, &status
);
627 if (!(status
& LP5523_LEDTEST_DONE
))
628 usleep_range(3000, 6000);/* Was not ready. Wait. */
630 ret
= lp55xx_read(chip
, LP5523_REG_LED_TEST_ADC
, &adc
);
634 if (adc
>= vdd
|| adc
< LP5523_ADC_SHORTCIRC_LIM
)
635 pos
+= sprintf(buf
+ pos
, "LED %d FAIL\n", i
);
637 lp55xx_write(chip
, LP5523_REG_LED_PWM_BASE
+ i
, 0x00);
639 /* Restore current */
640 lp55xx_write(chip
, LP5523_REG_LED_CURRENT_BASE
+ i
,
645 pos
= sprintf(buf
, "OK\n");
648 pos
= sprintf(buf
, "FAIL\n");
651 mutex_unlock(&chip
->lock
);
656 static void lp5523_led_brightness_work(struct work_struct
*work
)
658 struct lp55xx_led
*led
= container_of(work
, struct lp55xx_led
,
660 struct lp55xx_chip
*chip
= led
->chip
;
662 mutex_lock(&chip
->lock
);
663 lp55xx_write(chip
, LP5523_REG_LED_PWM_BASE
+ led
->chan_nr
,
665 mutex_unlock(&chip
->lock
);
668 static LP55XX_DEV_ATTR_RW(engine1_mode
, show_engine1_mode
, store_engine1_mode
);
669 static LP55XX_DEV_ATTR_RW(engine2_mode
, show_engine2_mode
, store_engine2_mode
);
670 static LP55XX_DEV_ATTR_RW(engine3_mode
, show_engine3_mode
, store_engine3_mode
);
671 static LP55XX_DEV_ATTR_RW(engine1_leds
, show_engine1_leds
, store_engine1_leds
);
672 static LP55XX_DEV_ATTR_RW(engine2_leds
, show_engine2_leds
, store_engine2_leds
);
673 static LP55XX_DEV_ATTR_RW(engine3_leds
, show_engine3_leds
, store_engine3_leds
);
674 static LP55XX_DEV_ATTR_WO(engine1_load
, store_engine1_load
);
675 static LP55XX_DEV_ATTR_WO(engine2_load
, store_engine2_load
);
676 static LP55XX_DEV_ATTR_WO(engine3_load
, store_engine3_load
);
677 static LP55XX_DEV_ATTR_RO(selftest
, lp5523_selftest
);
679 static struct attribute
*lp5523_attributes
[] = {
680 &dev_attr_engine1_mode
.attr
,
681 &dev_attr_engine2_mode
.attr
,
682 &dev_attr_engine3_mode
.attr
,
683 &dev_attr_engine1_load
.attr
,
684 &dev_attr_engine2_load
.attr
,
685 &dev_attr_engine3_load
.attr
,
686 &dev_attr_engine1_leds
.attr
,
687 &dev_attr_engine2_leds
.attr
,
688 &dev_attr_engine3_leds
.attr
,
689 &dev_attr_selftest
.attr
,
693 static const struct attribute_group lp5523_group
= {
694 .attrs
= lp5523_attributes
,
697 /* Chip specific configurations */
698 static struct lp55xx_device_config lp5523_cfg
= {
700 .addr
= LP5523_REG_RESET
,
704 .addr
= LP5523_REG_ENABLE
,
705 .val
= LP5523_ENABLE
,
707 .max_channel
= LP5523_MAX_LEDS
,
708 .post_init_device
= lp5523_post_init_device
,
709 .brightness_work_fn
= lp5523_led_brightness_work
,
710 .set_led_current
= lp5523_set_led_current
,
711 .firmware_cb
= lp5523_firmware_loaded
,
712 .run_engine
= lp5523_run_engine
,
713 .dev_attr_group
= &lp5523_group
,
716 static int lp5523_probe(struct i2c_client
*client
,
717 const struct i2c_device_id
*id
)
720 struct lp55xx_chip
*chip
;
721 struct lp55xx_led
*led
;
722 struct lp55xx_platform_data
*pdata
;
723 struct device_node
*np
= client
->dev
.of_node
;
725 if (!dev_get_platdata(&client
->dev
)) {
727 ret
= lp55xx_of_populate_pdata(&client
->dev
, np
);
731 dev_err(&client
->dev
, "no platform data\n");
735 pdata
= dev_get_platdata(&client
->dev
);
737 chip
= devm_kzalloc(&client
->dev
, sizeof(*chip
), GFP_KERNEL
);
741 led
= devm_kzalloc(&client
->dev
,
742 sizeof(*led
) * pdata
->num_channels
, GFP_KERNEL
);
748 chip
->cfg
= &lp5523_cfg
;
750 mutex_init(&chip
->lock
);
752 i2c_set_clientdata(client
, led
);
754 ret
= lp55xx_init_device(chip
);
758 dev_info(&client
->dev
, "%s Programmable led chip found\n", id
->name
);
760 ret
= lp55xx_register_leds(led
, chip
);
762 goto err_register_leds
;
764 ret
= lp55xx_register_sysfs(chip
);
766 dev_err(&client
->dev
, "registering sysfs failed\n");
767 goto err_register_sysfs
;
773 lp55xx_unregister_leds(led
, chip
);
775 lp55xx_deinit_device(chip
);
780 static int lp5523_remove(struct i2c_client
*client
)
782 struct lp55xx_led
*led
= i2c_get_clientdata(client
);
783 struct lp55xx_chip
*chip
= led
->chip
;
785 lp5523_stop_engine(chip
);
786 lp55xx_unregister_sysfs(chip
);
787 lp55xx_unregister_leds(led
, chip
);
788 lp55xx_deinit_device(chip
);
793 static const struct i2c_device_id lp5523_id
[] = {
794 { "lp5523", LP5523
},
795 { "lp55231", LP55231
},
799 MODULE_DEVICE_TABLE(i2c
, lp5523_id
);
802 static const struct of_device_id of_lp5523_leds_match
[] = {
803 { .compatible
= "national,lp5523", },
807 MODULE_DEVICE_TABLE(of
, of_lp5523_leds_match
);
810 static struct i2c_driver lp5523_driver
= {
813 .of_match_table
= of_match_ptr(of_lp5523_leds_match
),
815 .probe
= lp5523_probe
,
816 .remove
= lp5523_remove
,
817 .id_table
= lp5523_id
,
820 module_i2c_driver(lp5523_driver
);
822 MODULE_AUTHOR("Mathias Nyman <mathias.nyman@nokia.com>");
823 MODULE_AUTHOR("Milo Kim <milo.kim@ti.com>");
824 MODULE_DESCRIPTION("LP5523 LED engine");
825 MODULE_LICENSE("GPL");