1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2dc76df5dSDaniel Jeong /*
3dc76df5dSDaniel Jeong * drivers/media/i2c/lm3646.c
4dc76df5dSDaniel Jeong * General device driver for TI lm3646, Dual FLASH LED Driver
5dc76df5dSDaniel Jeong *
6dc76df5dSDaniel Jeong * Copyright (C) 2014 Texas Instruments
7dc76df5dSDaniel Jeong *
8dc76df5dSDaniel Jeong * Contact: Daniel Jeong <gshark.jeong@gmail.com>
9dc76df5dSDaniel Jeong * Ldd-Mlp <ldd-mlp@list.ti.com>
10dc76df5dSDaniel Jeong */
11dc76df5dSDaniel Jeong
12dc76df5dSDaniel Jeong #include <linux/delay.h>
13dc76df5dSDaniel Jeong #include <linux/i2c.h>
14dc76df5dSDaniel Jeong #include <linux/module.h>
15dc76df5dSDaniel Jeong #include <linux/slab.h>
16dc76df5dSDaniel Jeong #include <linux/regmap.h>
17dc76df5dSDaniel Jeong #include <linux/videodev2.h>
18b5dcee22SMauro Carvalho Chehab #include <media/i2c/lm3646.h>
19dc76df5dSDaniel Jeong #include <media/v4l2-ctrls.h>
20dc76df5dSDaniel Jeong #include <media/v4l2-device.h>
21dc76df5dSDaniel Jeong
22dc76df5dSDaniel Jeong /* registers definitions */
23dc76df5dSDaniel Jeong #define REG_ENABLE 0x01
24dc76df5dSDaniel Jeong #define REG_TORCH_BR 0x05
25dc76df5dSDaniel Jeong #define REG_FLASH_BR 0x05
26dc76df5dSDaniel Jeong #define REG_FLASH_TOUT 0x04
27dc76df5dSDaniel Jeong #define REG_FLAG 0x08
28dc76df5dSDaniel Jeong #define REG_STROBE_SRC 0x06
29dc76df5dSDaniel Jeong #define REG_LED1_FLASH_BR 0x06
30dc76df5dSDaniel Jeong #define REG_LED1_TORCH_BR 0x07
31dc76df5dSDaniel Jeong
32dc76df5dSDaniel Jeong #define MASK_ENABLE 0x03
33dc76df5dSDaniel Jeong #define MASK_TORCH_BR 0x70
34dc76df5dSDaniel Jeong #define MASK_FLASH_BR 0x0F
35dc76df5dSDaniel Jeong #define MASK_FLASH_TOUT 0x07
36dc76df5dSDaniel Jeong #define MASK_FLAG 0xFF
37dc76df5dSDaniel Jeong #define MASK_STROBE_SRC 0x80
38dc76df5dSDaniel Jeong
39dc76df5dSDaniel Jeong /* Fault Mask */
40dc76df5dSDaniel Jeong #define FAULT_TIMEOUT (1<<0)
41dc76df5dSDaniel Jeong #define FAULT_SHORT_CIRCUIT (1<<1)
42dc76df5dSDaniel Jeong #define FAULT_UVLO (1<<2)
43dc76df5dSDaniel Jeong #define FAULT_IVFM (1<<3)
44dc76df5dSDaniel Jeong #define FAULT_OCP (1<<4)
45dc76df5dSDaniel Jeong #define FAULT_OVERTEMP (1<<5)
46dc76df5dSDaniel Jeong #define FAULT_NTC_TRIP (1<<6)
47dc76df5dSDaniel Jeong #define FAULT_OVP (1<<7)
48dc76df5dSDaniel Jeong
49dc76df5dSDaniel Jeong enum led_mode {
50dc76df5dSDaniel Jeong MODE_SHDN = 0x0,
51dc76df5dSDaniel Jeong MODE_TORCH = 0x2,
52dc76df5dSDaniel Jeong MODE_FLASH = 0x3,
53dc76df5dSDaniel Jeong };
54dc76df5dSDaniel Jeong
55dc76df5dSDaniel Jeong /*
56dc76df5dSDaniel Jeong * struct lm3646_flash
57dc76df5dSDaniel Jeong *
58dc76df5dSDaniel Jeong * @pdata: platform data
59dc76df5dSDaniel Jeong * @regmap: reg. map for i2c
60dc76df5dSDaniel Jeong * @lock: muxtex for serial access.
61dc76df5dSDaniel Jeong * @led_mode: V4L2 LED mode
62f8a7647dSMauro Carvalho Chehab * @ctrls_led: V4L2 controls
63dc76df5dSDaniel Jeong * @subdev_led: V4L2 subdev
64dc76df5dSDaniel Jeong * @mode_reg : mode register value
65dc76df5dSDaniel Jeong */
66dc76df5dSDaniel Jeong struct lm3646_flash {
67dc76df5dSDaniel Jeong struct device *dev;
68dc76df5dSDaniel Jeong struct lm3646_platform_data *pdata;
69dc76df5dSDaniel Jeong struct regmap *regmap;
70dc76df5dSDaniel Jeong
71dc76df5dSDaniel Jeong struct v4l2_ctrl_handler ctrls_led;
72dc76df5dSDaniel Jeong struct v4l2_subdev subdev_led;
73dc76df5dSDaniel Jeong
74dc76df5dSDaniel Jeong u8 mode_reg;
75dc76df5dSDaniel Jeong };
76dc76df5dSDaniel Jeong
77dc76df5dSDaniel Jeong #define to_lm3646_flash(_ctrl) \
78dc76df5dSDaniel Jeong container_of(_ctrl->handler, struct lm3646_flash, ctrls_led)
79dc76df5dSDaniel Jeong
80dc76df5dSDaniel Jeong /* enable mode control */
lm3646_mode_ctrl(struct lm3646_flash * flash,enum v4l2_flash_led_mode led_mode)81dc76df5dSDaniel Jeong static int lm3646_mode_ctrl(struct lm3646_flash *flash,
82dc76df5dSDaniel Jeong enum v4l2_flash_led_mode led_mode)
83dc76df5dSDaniel Jeong {
84dc76df5dSDaniel Jeong switch (led_mode) {
85dc76df5dSDaniel Jeong case V4L2_FLASH_LED_MODE_NONE:
86dc76df5dSDaniel Jeong return regmap_write(flash->regmap,
87dc76df5dSDaniel Jeong REG_ENABLE, flash->mode_reg | MODE_SHDN);
88dc76df5dSDaniel Jeong case V4L2_FLASH_LED_MODE_TORCH:
89dc76df5dSDaniel Jeong return regmap_write(flash->regmap,
90dc76df5dSDaniel Jeong REG_ENABLE, flash->mode_reg | MODE_TORCH);
91dc76df5dSDaniel Jeong case V4L2_FLASH_LED_MODE_FLASH:
92dc76df5dSDaniel Jeong return regmap_write(flash->regmap,
93dc76df5dSDaniel Jeong REG_ENABLE, flash->mode_reg | MODE_FLASH);
94dc76df5dSDaniel Jeong }
95dc76df5dSDaniel Jeong return -EINVAL;
96dc76df5dSDaniel Jeong }
97dc76df5dSDaniel Jeong
98dc76df5dSDaniel Jeong /* V4L2 controls */
lm3646_get_ctrl(struct v4l2_ctrl * ctrl)99dc76df5dSDaniel Jeong static int lm3646_get_ctrl(struct v4l2_ctrl *ctrl)
100dc76df5dSDaniel Jeong {
101dc76df5dSDaniel Jeong struct lm3646_flash *flash = to_lm3646_flash(ctrl);
102dc76df5dSDaniel Jeong unsigned int reg_val;
103dc76df5dSDaniel Jeong int rval;
104dc76df5dSDaniel Jeong
105dc76df5dSDaniel Jeong if (ctrl->id != V4L2_CID_FLASH_FAULT)
106dc76df5dSDaniel Jeong return -EINVAL;
107dc76df5dSDaniel Jeong
108dc76df5dSDaniel Jeong rval = regmap_read(flash->regmap, REG_FLAG, ®_val);
109dc76df5dSDaniel Jeong if (rval < 0)
110dc76df5dSDaniel Jeong return rval;
111dc76df5dSDaniel Jeong
112dc76df5dSDaniel Jeong ctrl->val = 0;
113dc76df5dSDaniel Jeong if (reg_val & FAULT_TIMEOUT)
114dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_TIMEOUT;
115dc76df5dSDaniel Jeong if (reg_val & FAULT_SHORT_CIRCUIT)
116dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_SHORT_CIRCUIT;
117dc76df5dSDaniel Jeong if (reg_val & FAULT_UVLO)
118dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_UNDER_VOLTAGE;
119dc76df5dSDaniel Jeong if (reg_val & FAULT_IVFM)
120dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_INPUT_VOLTAGE;
121dc76df5dSDaniel Jeong if (reg_val & FAULT_OCP)
122dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_OVER_CURRENT;
123dc76df5dSDaniel Jeong if (reg_val & FAULT_OVERTEMP)
124dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_OVER_TEMPERATURE;
125dc76df5dSDaniel Jeong if (reg_val & FAULT_NTC_TRIP)
126dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_LED_OVER_TEMPERATURE;
127dc76df5dSDaniel Jeong if (reg_val & FAULT_OVP)
128dc76df5dSDaniel Jeong ctrl->val |= V4L2_FLASH_FAULT_OVER_VOLTAGE;
129dc76df5dSDaniel Jeong
130dc76df5dSDaniel Jeong return 0;
131dc76df5dSDaniel Jeong }
132dc76df5dSDaniel Jeong
lm3646_set_ctrl(struct v4l2_ctrl * ctrl)133dc76df5dSDaniel Jeong static int lm3646_set_ctrl(struct v4l2_ctrl *ctrl)
134dc76df5dSDaniel Jeong {
135dc76df5dSDaniel Jeong struct lm3646_flash *flash = to_lm3646_flash(ctrl);
136dc76df5dSDaniel Jeong unsigned int reg_val;
137ecfaec43SColin Ian King int rval;
138dc76df5dSDaniel Jeong
139dc76df5dSDaniel Jeong switch (ctrl->id) {
140dc76df5dSDaniel Jeong case V4L2_CID_FLASH_LED_MODE:
141dc76df5dSDaniel Jeong
142dc76df5dSDaniel Jeong if (ctrl->val != V4L2_FLASH_LED_MODE_FLASH)
143dc76df5dSDaniel Jeong return lm3646_mode_ctrl(flash, ctrl->val);
144dc76df5dSDaniel Jeong /* switch to SHDN mode before flash strobe on */
145dc76df5dSDaniel Jeong return lm3646_mode_ctrl(flash, V4L2_FLASH_LED_MODE_NONE);
146dc76df5dSDaniel Jeong
147dc76df5dSDaniel Jeong case V4L2_CID_FLASH_STROBE_SOURCE:
148dc76df5dSDaniel Jeong return regmap_update_bits(flash->regmap,
149dc76df5dSDaniel Jeong REG_STROBE_SRC, MASK_STROBE_SRC,
150dc76df5dSDaniel Jeong (ctrl->val) << 7);
151dc76df5dSDaniel Jeong
152dc76df5dSDaniel Jeong case V4L2_CID_FLASH_STROBE:
153dc76df5dSDaniel Jeong
154dc76df5dSDaniel Jeong /* read and check current mode of chip to start flash */
155dc76df5dSDaniel Jeong rval = regmap_read(flash->regmap, REG_ENABLE, ®_val);
156dc76df5dSDaniel Jeong if (rval < 0 || ((reg_val & MASK_ENABLE) != MODE_SHDN))
157dc76df5dSDaniel Jeong return rval;
158dc76df5dSDaniel Jeong /* flash on */
159dc76df5dSDaniel Jeong return lm3646_mode_ctrl(flash, V4L2_FLASH_LED_MODE_FLASH);
160dc76df5dSDaniel Jeong
161dc76df5dSDaniel Jeong case V4L2_CID_FLASH_STROBE_STOP:
162dc76df5dSDaniel Jeong
163dc76df5dSDaniel Jeong /*
164dc76df5dSDaniel Jeong * flash mode will be turned automatically
165dc76df5dSDaniel Jeong * from FLASH mode to SHDN mode after flash duration timeout
166dc76df5dSDaniel Jeong * read and check current mode of chip to stop flash
167dc76df5dSDaniel Jeong */
168dc76df5dSDaniel Jeong rval = regmap_read(flash->regmap, REG_ENABLE, ®_val);
169dc76df5dSDaniel Jeong if (rval < 0)
170dc76df5dSDaniel Jeong return rval;
171dc76df5dSDaniel Jeong if ((reg_val & MASK_ENABLE) == MODE_FLASH)
172dc76df5dSDaniel Jeong return lm3646_mode_ctrl(flash,
173dc76df5dSDaniel Jeong V4L2_FLASH_LED_MODE_NONE);
174dc76df5dSDaniel Jeong return rval;
175dc76df5dSDaniel Jeong
176dc76df5dSDaniel Jeong case V4L2_CID_FLASH_TIMEOUT:
177dc76df5dSDaniel Jeong return regmap_update_bits(flash->regmap,
178dc76df5dSDaniel Jeong REG_FLASH_TOUT, MASK_FLASH_TOUT,
179dc76df5dSDaniel Jeong LM3646_FLASH_TOUT_ms_TO_REG
180dc76df5dSDaniel Jeong (ctrl->val));
181dc76df5dSDaniel Jeong
182dc76df5dSDaniel Jeong case V4L2_CID_FLASH_INTENSITY:
183dc76df5dSDaniel Jeong return regmap_update_bits(flash->regmap,
184dc76df5dSDaniel Jeong REG_FLASH_BR, MASK_FLASH_BR,
185dc76df5dSDaniel Jeong LM3646_TOTAL_FLASH_BRT_uA_TO_REG
186dc76df5dSDaniel Jeong (ctrl->val));
187dc76df5dSDaniel Jeong
188dc76df5dSDaniel Jeong case V4L2_CID_FLASH_TORCH_INTENSITY:
189dc76df5dSDaniel Jeong return regmap_update_bits(flash->regmap,
190dc76df5dSDaniel Jeong REG_TORCH_BR, MASK_TORCH_BR,
191dc76df5dSDaniel Jeong LM3646_TOTAL_TORCH_BRT_uA_TO_REG
192dc76df5dSDaniel Jeong (ctrl->val) << 4);
193dc76df5dSDaniel Jeong }
194dc76df5dSDaniel Jeong
195dc76df5dSDaniel Jeong return -EINVAL;
196dc76df5dSDaniel Jeong }
197dc76df5dSDaniel Jeong
198dc76df5dSDaniel Jeong static const struct v4l2_ctrl_ops lm3646_led_ctrl_ops = {
199dc76df5dSDaniel Jeong .g_volatile_ctrl = lm3646_get_ctrl,
200dc76df5dSDaniel Jeong .s_ctrl = lm3646_set_ctrl,
201dc76df5dSDaniel Jeong };
202dc76df5dSDaniel Jeong
lm3646_init_controls(struct lm3646_flash * flash)203dc76df5dSDaniel Jeong static int lm3646_init_controls(struct lm3646_flash *flash)
204dc76df5dSDaniel Jeong {
205dc76df5dSDaniel Jeong struct v4l2_ctrl *fault;
206dc76df5dSDaniel Jeong struct v4l2_ctrl_handler *hdl = &flash->ctrls_led;
207dc76df5dSDaniel Jeong const struct v4l2_ctrl_ops *ops = &lm3646_led_ctrl_ops;
208dc76df5dSDaniel Jeong
209dc76df5dSDaniel Jeong v4l2_ctrl_handler_init(hdl, 8);
210dc76df5dSDaniel Jeong /* flash mode */
211dc76df5dSDaniel Jeong v4l2_ctrl_new_std_menu(hdl, ops, V4L2_CID_FLASH_LED_MODE,
212dc76df5dSDaniel Jeong V4L2_FLASH_LED_MODE_TORCH, ~0x7,
213dc76df5dSDaniel Jeong V4L2_FLASH_LED_MODE_NONE);
214dc76df5dSDaniel Jeong
215dc76df5dSDaniel Jeong /* flash source */
216dc76df5dSDaniel Jeong v4l2_ctrl_new_std_menu(hdl, ops, V4L2_CID_FLASH_STROBE_SOURCE,
217dc76df5dSDaniel Jeong 0x1, ~0x3, V4L2_FLASH_STROBE_SOURCE_SOFTWARE);
218dc76df5dSDaniel Jeong
219dc76df5dSDaniel Jeong /* flash strobe */
220dc76df5dSDaniel Jeong v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_STROBE, 0, 0, 0, 0);
221dc76df5dSDaniel Jeong /* flash strobe stop */
222dc76df5dSDaniel Jeong v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_STROBE_STOP, 0, 0, 0, 0);
223dc76df5dSDaniel Jeong
224dc76df5dSDaniel Jeong /* flash strobe timeout */
225dc76df5dSDaniel Jeong v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_TIMEOUT,
226dc76df5dSDaniel Jeong LM3646_FLASH_TOUT_MIN,
227dc76df5dSDaniel Jeong LM3646_FLASH_TOUT_MAX,
228dc76df5dSDaniel Jeong LM3646_FLASH_TOUT_STEP, flash->pdata->flash_timeout);
229dc76df5dSDaniel Jeong
230dc76df5dSDaniel Jeong /* max flash current */
231dc76df5dSDaniel Jeong v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_INTENSITY,
232dc76df5dSDaniel Jeong LM3646_TOTAL_FLASH_BRT_MIN,
233dc76df5dSDaniel Jeong LM3646_TOTAL_FLASH_BRT_MAX,
234dc76df5dSDaniel Jeong LM3646_TOTAL_FLASH_BRT_STEP,
235dc76df5dSDaniel Jeong LM3646_TOTAL_FLASH_BRT_MAX);
236dc76df5dSDaniel Jeong
237dc76df5dSDaniel Jeong /* max torch current */
238dc76df5dSDaniel Jeong v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_TORCH_INTENSITY,
239dc76df5dSDaniel Jeong LM3646_TOTAL_TORCH_BRT_MIN,
240dc76df5dSDaniel Jeong LM3646_TOTAL_TORCH_BRT_MAX,
241dc76df5dSDaniel Jeong LM3646_TOTAL_TORCH_BRT_STEP,
242dc76df5dSDaniel Jeong LM3646_TOTAL_TORCH_BRT_MAX);
243dc76df5dSDaniel Jeong
244dc76df5dSDaniel Jeong /* fault */
245dc76df5dSDaniel Jeong fault = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FLASH_FAULT, 0,
246dc76df5dSDaniel Jeong V4L2_FLASH_FAULT_OVER_VOLTAGE
247dc76df5dSDaniel Jeong | V4L2_FLASH_FAULT_OVER_TEMPERATURE
248dc76df5dSDaniel Jeong | V4L2_FLASH_FAULT_SHORT_CIRCUIT
249dc76df5dSDaniel Jeong | V4L2_FLASH_FAULT_TIMEOUT, 0, 0);
250dc76df5dSDaniel Jeong if (fault != NULL)
251dc76df5dSDaniel Jeong fault->flags |= V4L2_CTRL_FLAG_VOLATILE;
252dc76df5dSDaniel Jeong
253dc76df5dSDaniel Jeong if (hdl->error)
254dc76df5dSDaniel Jeong return hdl->error;
255dc76df5dSDaniel Jeong
256dc76df5dSDaniel Jeong flash->subdev_led.ctrl_handler = hdl;
257dc76df5dSDaniel Jeong return 0;
258dc76df5dSDaniel Jeong }
259dc76df5dSDaniel Jeong
260dc76df5dSDaniel Jeong /* initialize device */
261dc76df5dSDaniel Jeong static const struct v4l2_subdev_ops lm3646_ops = {
262dc76df5dSDaniel Jeong .core = NULL,
263dc76df5dSDaniel Jeong };
264dc76df5dSDaniel Jeong
265dc76df5dSDaniel Jeong static const struct regmap_config lm3646_regmap = {
266dc76df5dSDaniel Jeong .reg_bits = 8,
267dc76df5dSDaniel Jeong .val_bits = 8,
268dc76df5dSDaniel Jeong .max_register = 0xFF,
269dc76df5dSDaniel Jeong };
270dc76df5dSDaniel Jeong
lm3646_subdev_init(struct lm3646_flash * flash)271dc76df5dSDaniel Jeong static int lm3646_subdev_init(struct lm3646_flash *flash)
272dc76df5dSDaniel Jeong {
273dc76df5dSDaniel Jeong struct i2c_client *client = to_i2c_client(flash->dev);
274dc76df5dSDaniel Jeong int rval;
275dc76df5dSDaniel Jeong
276dc76df5dSDaniel Jeong v4l2_i2c_subdev_init(&flash->subdev_led, client, &lm3646_ops);
277dc76df5dSDaniel Jeong flash->subdev_led.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
278cc1e6315SMauro Carvalho Chehab strscpy(flash->subdev_led.name, LM3646_NAME,
279cc1e6315SMauro Carvalho Chehab sizeof(flash->subdev_led.name));
280dc76df5dSDaniel Jeong rval = lm3646_init_controls(flash);
281dc76df5dSDaniel Jeong if (rval)
282dc76df5dSDaniel Jeong goto err_out;
283ab22e77cSMauro Carvalho Chehab rval = media_entity_pads_init(&flash->subdev_led.entity, 0, NULL);
284dc76df5dSDaniel Jeong if (rval < 0)
285dc76df5dSDaniel Jeong goto err_out;
2864ca72efaSMauro Carvalho Chehab flash->subdev_led.entity.function = MEDIA_ENT_F_FLASH;
287dc76df5dSDaniel Jeong return rval;
288dc76df5dSDaniel Jeong
289dc76df5dSDaniel Jeong err_out:
290dc76df5dSDaniel Jeong v4l2_ctrl_handler_free(&flash->ctrls_led);
291dc76df5dSDaniel Jeong return rval;
292dc76df5dSDaniel Jeong }
293dc76df5dSDaniel Jeong
lm3646_init_device(struct lm3646_flash * flash)294dc76df5dSDaniel Jeong static int lm3646_init_device(struct lm3646_flash *flash)
295dc76df5dSDaniel Jeong {
296dc76df5dSDaniel Jeong unsigned int reg_val;
297dc76df5dSDaniel Jeong int rval;
298dc76df5dSDaniel Jeong
299dc76df5dSDaniel Jeong /* read the value of mode register to reduce redundant i2c accesses */
300dc76df5dSDaniel Jeong rval = regmap_read(flash->regmap, REG_ENABLE, ®_val);
301dc76df5dSDaniel Jeong if (rval < 0)
302dc76df5dSDaniel Jeong return rval;
303dc76df5dSDaniel Jeong flash->mode_reg = reg_val & 0xfc;
304dc76df5dSDaniel Jeong
305dc76df5dSDaniel Jeong /* output disable */
306dc76df5dSDaniel Jeong rval = lm3646_mode_ctrl(flash, V4L2_FLASH_LED_MODE_NONE);
307dc76df5dSDaniel Jeong if (rval < 0)
308dc76df5dSDaniel Jeong return rval;
309dc76df5dSDaniel Jeong
310dc76df5dSDaniel Jeong /*
311dc76df5dSDaniel Jeong * LED1 flash current setting
312dc76df5dSDaniel Jeong * LED2 flash current = Total(Max) flash current - LED1 flash current
313dc76df5dSDaniel Jeong */
314dc76df5dSDaniel Jeong rval = regmap_update_bits(flash->regmap,
315dc76df5dSDaniel Jeong REG_LED1_FLASH_BR, 0x7F,
316dc76df5dSDaniel Jeong LM3646_LED1_FLASH_BRT_uA_TO_REG
317dc76df5dSDaniel Jeong (flash->pdata->led1_flash_brt));
318dc76df5dSDaniel Jeong
319dc76df5dSDaniel Jeong if (rval < 0)
320dc76df5dSDaniel Jeong return rval;
321dc76df5dSDaniel Jeong
322dc76df5dSDaniel Jeong /*
323dc76df5dSDaniel Jeong * LED1 torch current setting
324dc76df5dSDaniel Jeong * LED2 torch current = Total(Max) torch current - LED1 torch current
325dc76df5dSDaniel Jeong */
326dc76df5dSDaniel Jeong rval = regmap_update_bits(flash->regmap,
327dc76df5dSDaniel Jeong REG_LED1_TORCH_BR, 0x7F,
328dc76df5dSDaniel Jeong LM3646_LED1_TORCH_BRT_uA_TO_REG
329dc76df5dSDaniel Jeong (flash->pdata->led1_torch_brt));
330dc76df5dSDaniel Jeong if (rval < 0)
331dc76df5dSDaniel Jeong return rval;
332dc76df5dSDaniel Jeong
333dc76df5dSDaniel Jeong /* Reset flag register */
334dc76df5dSDaniel Jeong return regmap_read(flash->regmap, REG_FLAG, ®_val);
335dc76df5dSDaniel Jeong }
336dc76df5dSDaniel Jeong
lm3646_probe(struct i2c_client * client)337be353426SUwe Kleine-König static int lm3646_probe(struct i2c_client *client)
338dc76df5dSDaniel Jeong {
339dc76df5dSDaniel Jeong struct lm3646_flash *flash;
340dc76df5dSDaniel Jeong struct lm3646_platform_data *pdata = dev_get_platdata(&client->dev);
341dc76df5dSDaniel Jeong int rval;
342dc76df5dSDaniel Jeong
343dc76df5dSDaniel Jeong flash = devm_kzalloc(&client->dev, sizeof(*flash), GFP_KERNEL);
344dc76df5dSDaniel Jeong if (flash == NULL)
345dc76df5dSDaniel Jeong return -ENOMEM;
346dc76df5dSDaniel Jeong
347dc76df5dSDaniel Jeong flash->regmap = devm_regmap_init_i2c(client, &lm3646_regmap);
348dc76df5dSDaniel Jeong if (IS_ERR(flash->regmap))
349dc76df5dSDaniel Jeong return PTR_ERR(flash->regmap);
350dc76df5dSDaniel Jeong
351dc76df5dSDaniel Jeong /* check device tree if there is no platform data */
352dc76df5dSDaniel Jeong if (pdata == NULL) {
353dc76df5dSDaniel Jeong pdata = devm_kzalloc(&client->dev,
354dc76df5dSDaniel Jeong sizeof(struct lm3646_platform_data),
355dc76df5dSDaniel Jeong GFP_KERNEL);
356dc76df5dSDaniel Jeong if (pdata == NULL)
357dc76df5dSDaniel Jeong return -ENOMEM;
358dc76df5dSDaniel Jeong /* use default data in case of no platform data */
359dc76df5dSDaniel Jeong pdata->flash_timeout = LM3646_FLASH_TOUT_MAX;
360dc76df5dSDaniel Jeong pdata->led1_torch_brt = LM3646_LED1_TORCH_BRT_MAX;
361dc76df5dSDaniel Jeong pdata->led1_flash_brt = LM3646_LED1_FLASH_BRT_MAX;
362dc76df5dSDaniel Jeong }
363dc76df5dSDaniel Jeong flash->pdata = pdata;
364dc76df5dSDaniel Jeong flash->dev = &client->dev;
365dc76df5dSDaniel Jeong
366dc76df5dSDaniel Jeong rval = lm3646_subdev_init(flash);
367dc76df5dSDaniel Jeong if (rval < 0)
368dc76df5dSDaniel Jeong return rval;
369dc76df5dSDaniel Jeong
370dc76df5dSDaniel Jeong rval = lm3646_init_device(flash);
371dc76df5dSDaniel Jeong if (rval < 0)
372dc76df5dSDaniel Jeong return rval;
373dc76df5dSDaniel Jeong
374dc76df5dSDaniel Jeong i2c_set_clientdata(client, flash);
375dc76df5dSDaniel Jeong
376dc76df5dSDaniel Jeong return 0;
377dc76df5dSDaniel Jeong }
378dc76df5dSDaniel Jeong
lm3646_remove(struct i2c_client * client)379ed5c2f5fSUwe Kleine-König static void lm3646_remove(struct i2c_client *client)
380dc76df5dSDaniel Jeong {
381dc76df5dSDaniel Jeong struct lm3646_flash *flash = i2c_get_clientdata(client);
382dc76df5dSDaniel Jeong
383dc76df5dSDaniel Jeong v4l2_device_unregister_subdev(&flash->subdev_led);
384dc76df5dSDaniel Jeong v4l2_ctrl_handler_free(&flash->ctrls_led);
385dc76df5dSDaniel Jeong media_entity_cleanup(&flash->subdev_led.entity);
386dc76df5dSDaniel Jeong }
387dc76df5dSDaniel Jeong
388dc76df5dSDaniel Jeong static const struct i2c_device_id lm3646_id_table[] = {
389dc76df5dSDaniel Jeong {LM3646_NAME, 0},
390dc76df5dSDaniel Jeong {}
391dc76df5dSDaniel Jeong };
392dc76df5dSDaniel Jeong
393dc76df5dSDaniel Jeong MODULE_DEVICE_TABLE(i2c, lm3646_id_table);
394dc76df5dSDaniel Jeong
395dc76df5dSDaniel Jeong static struct i2c_driver lm3646_i2c_driver = {
396dc76df5dSDaniel Jeong .driver = {
397dc76df5dSDaniel Jeong .name = LM3646_NAME,
398dc76df5dSDaniel Jeong },
399*aaeb31c0SUwe Kleine-König .probe = lm3646_probe,
400dc76df5dSDaniel Jeong .remove = lm3646_remove,
401dc76df5dSDaniel Jeong .id_table = lm3646_id_table,
402dc76df5dSDaniel Jeong };
403dc76df5dSDaniel Jeong
404dc76df5dSDaniel Jeong module_i2c_driver(lm3646_i2c_driver);
405dc76df5dSDaniel Jeong
406dc76df5dSDaniel Jeong MODULE_AUTHOR("Daniel Jeong <gshark.jeong@gmail.com>");
407dc76df5dSDaniel Jeong MODULE_AUTHOR("Ldd Mlp <ldd-mlp@list.ti.com>");
408dc76df5dSDaniel Jeong MODULE_DESCRIPTION("Texas Instruments LM3646 Dual Flash LED driver");
409dc76df5dSDaniel Jeong MODULE_LICENSE("GPL");
410