xref: /openbmc/linux/drivers/iio/light/cm36651.c (revision 7cf15f42)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
4  * Author: Beomho Seo <beomho.seo@samsung.com>
5  */
6 
7 #include <linux/delay.h>
8 #include <linux/err.h>
9 #include <linux/i2c.h>
10 #include <linux/mutex.h>
11 #include <linux/module.h>
12 #include <linux/interrupt.h>
13 #include <linux/regulator/consumer.h>
14 #include <linux/iio/iio.h>
15 #include <linux/iio/sysfs.h>
16 #include <linux/iio/events.h>
17 
18 /* Slave address 0x19 for PS of 7 bit addressing protocol for I2C */
19 #define CM36651_I2C_ADDR_PS		0x19
20 /* Alert Response Address */
21 #define CM36651_ARA			0x0C
22 
23 /* Ambient light sensor */
24 #define CM36651_CS_CONF1		0x00
25 #define CM36651_CS_CONF2		0x01
26 #define CM36651_ALS_WH_M		0x02
27 #define CM36651_ALS_WH_L		0x03
28 #define CM36651_ALS_WL_M		0x04
29 #define CM36651_ALS_WL_L		0x05
30 #define CM36651_CS_CONF3		0x06
31 #define CM36651_CS_CONF_REG_NUM		0x02
32 
33 /* Proximity sensor */
34 #define CM36651_PS_CONF1		0x00
35 #define CM36651_PS_THD			0x01
36 #define CM36651_PS_CANC			0x02
37 #define CM36651_PS_CONF2		0x03
38 #define CM36651_PS_REG_NUM		0x04
39 
40 /* CS_CONF1 command code */
41 #define CM36651_ALS_ENABLE		0x00
42 #define CM36651_ALS_DISABLE		0x01
43 #define CM36651_ALS_INT_EN		0x02
44 #define CM36651_ALS_THRES		0x04
45 
46 /* CS_CONF2 command code */
47 #define CM36651_CS_CONF2_DEFAULT_BIT	0x08
48 
49 /* CS_CONF3 channel integration time */
50 #define CM36651_CS_IT1			0x00 /* Integration time 80 msec */
51 #define CM36651_CS_IT2			0x40 /* Integration time 160 msec */
52 #define CM36651_CS_IT3			0x80 /* Integration time 320 msec */
53 #define CM36651_CS_IT4			0xC0 /* Integration time 640 msec */
54 
55 /* PS_CONF1 command code */
56 #define CM36651_PS_ENABLE		0x00
57 #define CM36651_PS_DISABLE		0x01
58 #define CM36651_PS_INT_EN		0x02
59 #define CM36651_PS_PERS2		0x04
60 #define CM36651_PS_PERS3		0x08
61 #define CM36651_PS_PERS4		0x0C
62 
63 /* PS_CONF1 command code: integration time */
64 #define CM36651_PS_IT1			0x00 /* Integration time 0.32 msec */
65 #define CM36651_PS_IT2			0x10 /* Integration time 0.42 msec */
66 #define CM36651_PS_IT3			0x20 /* Integration time 0.52 msec */
67 #define CM36651_PS_IT4			0x30 /* Integration time 0.64 msec */
68 
69 /* PS_CONF1 command code: duty ratio */
70 #define CM36651_PS_DR1			0x00 /* Duty ratio 1/80 */
71 #define CM36651_PS_DR2			0x40 /* Duty ratio 1/160 */
72 #define CM36651_PS_DR3			0x80 /* Duty ratio 1/320 */
73 #define CM36651_PS_DR4			0xC0 /* Duty ratio 1/640 */
74 
75 /* PS_THD command code */
76 #define CM36651_PS_INITIAL_THD		0x05
77 
78 /* PS_CANC command code */
79 #define CM36651_PS_CANC_DEFAULT		0x00
80 
81 /* PS_CONF2 command code */
82 #define CM36651_PS_HYS1			0x00
83 #define CM36651_PS_HYS2			0x01
84 #define CM36651_PS_SMART_PERS_EN	0x02
85 #define CM36651_PS_DIR_INT		0x04
86 #define CM36651_PS_MS			0x10
87 
88 #define CM36651_CS_COLOR_NUM		4
89 
90 #define CM36651_CLOSE_PROXIMITY		0x32
91 #define CM36651_FAR_PROXIMITY			0x33
92 
93 #define CM36651_CS_INT_TIME_AVAIL	"0.08 0.16 0.32 0.64"
94 #define CM36651_PS_INT_TIME_AVAIL	"0.000320 0.000420 0.000520 0.000640"
95 
96 enum cm36651_operation_mode {
97 	CM36651_LIGHT_EN,
98 	CM36651_PROXIMITY_EN,
99 	CM36651_PROXIMITY_EV_EN,
100 };
101 
102 enum cm36651_light_channel_idx {
103 	CM36651_LIGHT_CHANNEL_IDX_RED,
104 	CM36651_LIGHT_CHANNEL_IDX_GREEN,
105 	CM36651_LIGHT_CHANNEL_IDX_BLUE,
106 	CM36651_LIGHT_CHANNEL_IDX_CLEAR,
107 };
108 
109 enum cm36651_command {
110 	CM36651_CMD_READ_RAW_LIGHT,
111 	CM36651_CMD_READ_RAW_PROXIMITY,
112 	CM36651_CMD_PROX_EV_EN,
113 	CM36651_CMD_PROX_EV_DIS,
114 };
115 
116 static const u8 cm36651_cs_reg[CM36651_CS_CONF_REG_NUM] = {
117 	CM36651_CS_CONF1,
118 	CM36651_CS_CONF2,
119 };
120 
121 static const u8 cm36651_ps_reg[CM36651_PS_REG_NUM] = {
122 	CM36651_PS_CONF1,
123 	CM36651_PS_THD,
124 	CM36651_PS_CANC,
125 	CM36651_PS_CONF2,
126 };
127 
128 struct cm36651_data {
129 	const struct cm36651_platform_data *pdata;
130 	struct i2c_client *client;
131 	struct i2c_client *ps_client;
132 	struct i2c_client *ara_client;
133 	struct mutex lock;
134 	struct regulator *vled_reg;
135 	unsigned long flags;
136 	int cs_int_time[CM36651_CS_COLOR_NUM];
137 	int ps_int_time;
138 	u8 cs_ctrl_regs[CM36651_CS_CONF_REG_NUM];
139 	u8 ps_ctrl_regs[CM36651_PS_REG_NUM];
140 	u16 color[CM36651_CS_COLOR_NUM];
141 };
142 
cm36651_setup_reg(struct cm36651_data * cm36651)143 static int cm36651_setup_reg(struct cm36651_data *cm36651)
144 {
145 	struct i2c_client *client = cm36651->client;
146 	struct i2c_client *ps_client = cm36651->ps_client;
147 	int i, ret;
148 
149 	/* CS initialization */
150 	cm36651->cs_ctrl_regs[CM36651_CS_CONF1] = CM36651_ALS_ENABLE |
151 							     CM36651_ALS_THRES;
152 	cm36651->cs_ctrl_regs[CM36651_CS_CONF2] = CM36651_CS_CONF2_DEFAULT_BIT;
153 
154 	for (i = 0; i < CM36651_CS_CONF_REG_NUM; i++) {
155 		ret = i2c_smbus_write_byte_data(client, cm36651_cs_reg[i],
156 						     cm36651->cs_ctrl_regs[i]);
157 		if (ret < 0)
158 			return ret;
159 	}
160 
161 	/* PS initialization */
162 	cm36651->ps_ctrl_regs[CM36651_PS_CONF1] = CM36651_PS_ENABLE |
163 								CM36651_PS_IT2;
164 	cm36651->ps_ctrl_regs[CM36651_PS_THD] = CM36651_PS_INITIAL_THD;
165 	cm36651->ps_ctrl_regs[CM36651_PS_CANC] = CM36651_PS_CANC_DEFAULT;
166 	cm36651->ps_ctrl_regs[CM36651_PS_CONF2] = CM36651_PS_HYS2 |
167 				CM36651_PS_DIR_INT | CM36651_PS_SMART_PERS_EN;
168 
169 	for (i = 0; i < CM36651_PS_REG_NUM; i++) {
170 		ret = i2c_smbus_write_byte_data(ps_client, cm36651_ps_reg[i],
171 						     cm36651->ps_ctrl_regs[i]);
172 		if (ret < 0)
173 			return ret;
174 	}
175 
176 	/* Set shutdown mode */
177 	ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1,
178 							  CM36651_ALS_DISABLE);
179 	if (ret < 0)
180 		return ret;
181 
182 	ret = i2c_smbus_write_byte_data(cm36651->ps_client,
183 					 CM36651_PS_CONF1, CM36651_PS_DISABLE);
184 	if (ret < 0)
185 		return ret;
186 
187 	return 0;
188 }
189 
cm36651_read_output(struct cm36651_data * cm36651,struct iio_chan_spec const * chan,int * val)190 static int cm36651_read_output(struct cm36651_data *cm36651,
191 				struct iio_chan_spec const *chan, int *val)
192 {
193 	struct i2c_client *client = cm36651->client;
194 	int ret = -EINVAL;
195 
196 	switch (chan->type) {
197 	case IIO_LIGHT:
198 		*val = i2c_smbus_read_word_data(client, chan->address);
199 		if (*val < 0)
200 			return ret;
201 
202 		ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1,
203 							CM36651_ALS_DISABLE);
204 		if (ret < 0)
205 			return ret;
206 
207 		ret = IIO_VAL_INT;
208 		break;
209 	case IIO_PROXIMITY:
210 		*val = i2c_smbus_read_byte(cm36651->ps_client);
211 		if (*val < 0)
212 			return ret;
213 
214 		if (!test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) {
215 			ret = i2c_smbus_write_byte_data(cm36651->ps_client,
216 					CM36651_PS_CONF1, CM36651_PS_DISABLE);
217 			if (ret < 0)
218 				return ret;
219 		}
220 
221 		ret = IIO_VAL_INT;
222 		break;
223 	default:
224 		break;
225 	}
226 
227 	return ret;
228 }
229 
cm36651_irq_handler(int irq,void * data)230 static irqreturn_t cm36651_irq_handler(int irq, void *data)
231 {
232 	struct iio_dev *indio_dev = data;
233 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
234 	struct i2c_client *client = cm36651->client;
235 	int ev_dir, ret;
236 	u64 ev_code;
237 
238 	/*
239 	 * The PS INT pin is an active low signal that PS INT move logic low
240 	 * when the object is detect. Once the MCU host received the PS INT
241 	 * "LOW" signal, the Host needs to read the data at Alert Response
242 	 * Address(ARA) to clear the PS INT signal. After clearing the PS
243 	 * INT pin, the PS INT signal toggles from low to high.
244 	 */
245 	ret = i2c_smbus_read_byte(cm36651->ara_client);
246 	if (ret < 0) {
247 		dev_err(&client->dev,
248 				"%s: Data read failed: %d\n", __func__, ret);
249 		return IRQ_HANDLED;
250 	}
251 	switch (ret) {
252 	case CM36651_CLOSE_PROXIMITY:
253 		ev_dir = IIO_EV_DIR_RISING;
254 		break;
255 	case CM36651_FAR_PROXIMITY:
256 		ev_dir = IIO_EV_DIR_FALLING;
257 		break;
258 	default:
259 		dev_err(&client->dev,
260 			"%s: Data read wrong: %d\n", __func__, ret);
261 		return IRQ_HANDLED;
262 	}
263 
264 	ev_code = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY,
265 				CM36651_CMD_READ_RAW_PROXIMITY,
266 				IIO_EV_TYPE_THRESH, ev_dir);
267 
268 	iio_push_event(indio_dev, ev_code, iio_get_time_ns(indio_dev));
269 
270 	return IRQ_HANDLED;
271 }
272 
cm36651_set_operation_mode(struct cm36651_data * cm36651,int cmd)273 static int cm36651_set_operation_mode(struct cm36651_data *cm36651, int cmd)
274 {
275 	struct i2c_client *client = cm36651->client;
276 	struct i2c_client *ps_client = cm36651->ps_client;
277 	int ret = -EINVAL;
278 
279 	switch (cmd) {
280 	case CM36651_CMD_READ_RAW_LIGHT:
281 		ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF1,
282 				cm36651->cs_ctrl_regs[CM36651_CS_CONF1]);
283 		break;
284 	case CM36651_CMD_READ_RAW_PROXIMITY:
285 		if (test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags))
286 			return CM36651_PROXIMITY_EV_EN;
287 
288 		ret = i2c_smbus_write_byte_data(ps_client, CM36651_PS_CONF1,
289 				cm36651->ps_ctrl_regs[CM36651_PS_CONF1]);
290 		break;
291 	case CM36651_CMD_PROX_EV_EN:
292 		if (test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) {
293 			dev_err(&client->dev,
294 				"Already proximity event enable state\n");
295 			return ret;
296 		}
297 		set_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags);
298 
299 		ret = i2c_smbus_write_byte_data(ps_client,
300 			cm36651_ps_reg[CM36651_PS_CONF1],
301 			CM36651_PS_INT_EN | CM36651_PS_PERS2 | CM36651_PS_IT2);
302 
303 		if (ret < 0) {
304 			dev_err(&client->dev, "Proximity enable event failed\n");
305 			return ret;
306 		}
307 		break;
308 	case CM36651_CMD_PROX_EV_DIS:
309 		if (!test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags)) {
310 			dev_err(&client->dev,
311 				"Already proximity event disable state\n");
312 			return ret;
313 		}
314 		clear_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags);
315 		ret = i2c_smbus_write_byte_data(ps_client,
316 					CM36651_PS_CONF1, CM36651_PS_DISABLE);
317 		break;
318 	}
319 
320 	if (ret < 0)
321 		dev_err(&client->dev, "Write register failed\n");
322 
323 	return ret;
324 }
325 
cm36651_read_channel(struct cm36651_data * cm36651,struct iio_chan_spec const * chan,int * val)326 static int cm36651_read_channel(struct cm36651_data *cm36651,
327 				struct iio_chan_spec const *chan, int *val)
328 {
329 	struct i2c_client *client = cm36651->client;
330 	int cmd, ret;
331 
332 	if (chan->type == IIO_LIGHT)
333 		cmd = CM36651_CMD_READ_RAW_LIGHT;
334 	else if (chan->type == IIO_PROXIMITY)
335 		cmd = CM36651_CMD_READ_RAW_PROXIMITY;
336 	else
337 		return -EINVAL;
338 
339 	ret = cm36651_set_operation_mode(cm36651, cmd);
340 	if (ret < 0) {
341 		dev_err(&client->dev, "CM36651 set operation mode failed\n");
342 		return ret;
343 	}
344 	/* Delay for work after enable operation */
345 	msleep(50);
346 	ret = cm36651_read_output(cm36651, chan, val);
347 	if (ret < 0) {
348 		dev_err(&client->dev, "CM36651 read output failed\n");
349 		return ret;
350 	}
351 
352 	return ret;
353 }
354 
cm36651_read_int_time(struct cm36651_data * cm36651,struct iio_chan_spec const * chan,int * val2)355 static int cm36651_read_int_time(struct cm36651_data *cm36651,
356 				struct iio_chan_spec const *chan, int *val2)
357 {
358 	switch (chan->type) {
359 	case IIO_LIGHT:
360 		if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT1)
361 			*val2 = 80000;
362 		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT2)
363 			*val2 = 160000;
364 		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT3)
365 			*val2 = 320000;
366 		else if (cm36651->cs_int_time[chan->address] == CM36651_CS_IT4)
367 			*val2 = 640000;
368 		else
369 			return -EINVAL;
370 		break;
371 	case IIO_PROXIMITY:
372 		if (cm36651->ps_int_time == CM36651_PS_IT1)
373 			*val2 = 320;
374 		else if (cm36651->ps_int_time == CM36651_PS_IT2)
375 			*val2 = 420;
376 		else if (cm36651->ps_int_time == CM36651_PS_IT3)
377 			*val2 = 520;
378 		else if (cm36651->ps_int_time == CM36651_PS_IT4)
379 			*val2 = 640;
380 		else
381 			return -EINVAL;
382 		break;
383 	default:
384 		return -EINVAL;
385 	}
386 
387 	return IIO_VAL_INT_PLUS_MICRO;
388 }
389 
cm36651_write_int_time(struct cm36651_data * cm36651,struct iio_chan_spec const * chan,int val)390 static int cm36651_write_int_time(struct cm36651_data *cm36651,
391 				struct iio_chan_spec const *chan, int val)
392 {
393 	struct i2c_client *client = cm36651->client;
394 	struct i2c_client *ps_client = cm36651->ps_client;
395 	int int_time, ret;
396 
397 	switch (chan->type) {
398 	case IIO_LIGHT:
399 		if (val == 80000)
400 			int_time = CM36651_CS_IT1;
401 		else if (val == 160000)
402 			int_time = CM36651_CS_IT2;
403 		else if (val == 320000)
404 			int_time = CM36651_CS_IT3;
405 		else if (val == 640000)
406 			int_time = CM36651_CS_IT4;
407 		else
408 			return -EINVAL;
409 
410 		ret = i2c_smbus_write_byte_data(client, CM36651_CS_CONF3,
411 					   int_time >> 2 * (chan->address));
412 		if (ret < 0) {
413 			dev_err(&client->dev, "CS integration time write failed\n");
414 			return ret;
415 		}
416 		cm36651->cs_int_time[chan->address] = int_time;
417 		break;
418 	case IIO_PROXIMITY:
419 		if (val == 320)
420 			int_time = CM36651_PS_IT1;
421 		else if (val == 420)
422 			int_time = CM36651_PS_IT2;
423 		else if (val == 520)
424 			int_time = CM36651_PS_IT3;
425 		else if (val == 640)
426 			int_time = CM36651_PS_IT4;
427 		else
428 			return -EINVAL;
429 
430 		ret = i2c_smbus_write_byte_data(ps_client,
431 						CM36651_PS_CONF1, int_time);
432 		if (ret < 0) {
433 			dev_err(&client->dev, "PS integration time write failed\n");
434 			return ret;
435 		}
436 		cm36651->ps_int_time = int_time;
437 		break;
438 	default:
439 		return -EINVAL;
440 	}
441 
442 	return ret;
443 }
444 
cm36651_read_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int * val,int * val2,long mask)445 static int cm36651_read_raw(struct iio_dev *indio_dev,
446 			    struct iio_chan_spec const *chan,
447 			    int *val, int *val2, long mask)
448 {
449 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
450 	int ret;
451 
452 	mutex_lock(&cm36651->lock);
453 
454 	switch (mask) {
455 	case IIO_CHAN_INFO_RAW:
456 		ret = cm36651_read_channel(cm36651, chan, val);
457 		break;
458 	case IIO_CHAN_INFO_INT_TIME:
459 		*val = 0;
460 		ret = cm36651_read_int_time(cm36651, chan, val2);
461 		break;
462 	default:
463 		ret = -EINVAL;
464 	}
465 
466 	mutex_unlock(&cm36651->lock);
467 
468 	return ret;
469 }
470 
cm36651_write_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int val,int val2,long mask)471 static int cm36651_write_raw(struct iio_dev *indio_dev,
472 			     struct iio_chan_spec const *chan,
473 			     int val, int val2, long mask)
474 {
475 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
476 	struct i2c_client *client = cm36651->client;
477 	int ret = -EINVAL;
478 
479 	if (mask == IIO_CHAN_INFO_INT_TIME) {
480 		ret = cm36651_write_int_time(cm36651, chan, val2);
481 		if (ret < 0)
482 			dev_err(&client->dev, "Integration time write failed\n");
483 	}
484 
485 	return ret;
486 }
487 
cm36651_read_prox_thresh(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,enum iio_event_type type,enum iio_event_direction dir,enum iio_event_info info,int * val,int * val2)488 static int cm36651_read_prox_thresh(struct iio_dev *indio_dev,
489 					const struct iio_chan_spec *chan,
490 					enum iio_event_type type,
491 					enum iio_event_direction dir,
492 					enum iio_event_info info,
493 					int *val, int *val2)
494 {
495 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
496 
497 	*val = cm36651->ps_ctrl_regs[CM36651_PS_THD];
498 
499 	return 0;
500 }
501 
cm36651_write_prox_thresh(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,enum iio_event_type type,enum iio_event_direction dir,enum iio_event_info info,int val,int val2)502 static int cm36651_write_prox_thresh(struct iio_dev *indio_dev,
503 					const struct iio_chan_spec *chan,
504 					enum iio_event_type type,
505 					enum iio_event_direction dir,
506 					enum iio_event_info info,
507 					int val, int val2)
508 {
509 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
510 	struct i2c_client *client = cm36651->client;
511 	int ret;
512 
513 	if (val < 3 || val > 255)
514 		return -EINVAL;
515 
516 	cm36651->ps_ctrl_regs[CM36651_PS_THD] = val;
517 	ret = i2c_smbus_write_byte_data(cm36651->ps_client, CM36651_PS_THD,
518 					cm36651->ps_ctrl_regs[CM36651_PS_THD]);
519 
520 	if (ret < 0) {
521 		dev_err(&client->dev, "PS threshold write failed: %d\n", ret);
522 		return ret;
523 	}
524 
525 	return 0;
526 }
527 
cm36651_write_prox_event_config(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,enum iio_event_type type,enum iio_event_direction dir,int state)528 static int cm36651_write_prox_event_config(struct iio_dev *indio_dev,
529 					const struct iio_chan_spec *chan,
530 					enum iio_event_type type,
531 					enum iio_event_direction dir,
532 					int state)
533 {
534 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
535 	int cmd, ret;
536 
537 	mutex_lock(&cm36651->lock);
538 
539 	cmd = state ? CM36651_CMD_PROX_EV_EN : CM36651_CMD_PROX_EV_DIS;
540 	ret = cm36651_set_operation_mode(cm36651, cmd);
541 
542 	mutex_unlock(&cm36651->lock);
543 
544 	return ret;
545 }
546 
cm36651_read_prox_event_config(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,enum iio_event_type type,enum iio_event_direction dir)547 static int cm36651_read_prox_event_config(struct iio_dev *indio_dev,
548 					const struct iio_chan_spec *chan,
549 					enum iio_event_type type,
550 					enum iio_event_direction dir)
551 {
552 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
553 	int event_en;
554 
555 	mutex_lock(&cm36651->lock);
556 
557 	event_en = test_bit(CM36651_PROXIMITY_EV_EN, &cm36651->flags);
558 
559 	mutex_unlock(&cm36651->lock);
560 
561 	return event_en;
562 }
563 
564 #define CM36651_LIGHT_CHANNEL(_color, _idx) {		\
565 	.type = IIO_LIGHT,				\
566 	.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |	\
567 			BIT(IIO_CHAN_INFO_INT_TIME),	\
568 	.address = _idx,				\
569 	.modified = 1,					\
570 	.channel2 = IIO_MOD_LIGHT_##_color,		\
571 }							\
572 
573 static const struct iio_event_spec cm36651_event_spec[] = {
574 	{
575 		.type = IIO_EV_TYPE_THRESH,
576 		.dir = IIO_EV_DIR_EITHER,
577 		.mask_separate = BIT(IIO_EV_INFO_VALUE) |
578 				BIT(IIO_EV_INFO_ENABLE),
579 	}
580 };
581 
582 static const struct iio_chan_spec cm36651_channels[] = {
583 	{
584 		.type = IIO_PROXIMITY,
585 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
586 				BIT(IIO_CHAN_INFO_INT_TIME),
587 		.event_spec = cm36651_event_spec,
588 		.num_event_specs = ARRAY_SIZE(cm36651_event_spec),
589 	},
590 	CM36651_LIGHT_CHANNEL(RED, CM36651_LIGHT_CHANNEL_IDX_RED),
591 	CM36651_LIGHT_CHANNEL(GREEN, CM36651_LIGHT_CHANNEL_IDX_GREEN),
592 	CM36651_LIGHT_CHANNEL(BLUE, CM36651_LIGHT_CHANNEL_IDX_BLUE),
593 	CM36651_LIGHT_CHANNEL(CLEAR, CM36651_LIGHT_CHANNEL_IDX_CLEAR),
594 };
595 
596 static IIO_CONST_ATTR(in_illuminance_integration_time_available,
597 					CM36651_CS_INT_TIME_AVAIL);
598 static IIO_CONST_ATTR(in_proximity_integration_time_available,
599 					CM36651_PS_INT_TIME_AVAIL);
600 
601 static struct attribute *cm36651_attributes[] = {
602 	&iio_const_attr_in_illuminance_integration_time_available.dev_attr.attr,
603 	&iio_const_attr_in_proximity_integration_time_available.dev_attr.attr,
604 	NULL,
605 };
606 
607 static const struct attribute_group cm36651_attribute_group = {
608 	.attrs = cm36651_attributes
609 };
610 
611 static const struct iio_info cm36651_info = {
612 	.read_raw		= &cm36651_read_raw,
613 	.write_raw		= &cm36651_write_raw,
614 	.read_event_value	= &cm36651_read_prox_thresh,
615 	.write_event_value	= &cm36651_write_prox_thresh,
616 	.read_event_config	= &cm36651_read_prox_event_config,
617 	.write_event_config	= &cm36651_write_prox_event_config,
618 	.attrs			= &cm36651_attribute_group,
619 };
620 
cm36651_probe(struct i2c_client * client)621 static int cm36651_probe(struct i2c_client *client)
622 {
623 	const struct i2c_device_id *id = i2c_client_get_device_id(client);
624 	struct cm36651_data *cm36651;
625 	struct iio_dev *indio_dev;
626 	int ret;
627 
628 	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*cm36651));
629 	if (!indio_dev)
630 		return -ENOMEM;
631 
632 	cm36651 = iio_priv(indio_dev);
633 
634 	cm36651->vled_reg = devm_regulator_get(&client->dev, "vled");
635 	if (IS_ERR(cm36651->vled_reg))
636 		return dev_err_probe(&client->dev, PTR_ERR(cm36651->vled_reg),
637 				     "get regulator vled failed\n");
638 
639 	ret = regulator_enable(cm36651->vled_reg);
640 	if (ret) {
641 		dev_err(&client->dev, "enable regulator vled failed\n");
642 		return ret;
643 	}
644 
645 	i2c_set_clientdata(client, indio_dev);
646 
647 	cm36651->client = client;
648 	cm36651->ps_client = i2c_new_dummy_device(client->adapter,
649 						     CM36651_I2C_ADDR_PS);
650 	if (IS_ERR(cm36651->ps_client)) {
651 		dev_err(&client->dev, "%s: new i2c device failed\n", __func__);
652 		ret = PTR_ERR(cm36651->ps_client);
653 		goto error_disable_reg;
654 	}
655 
656 	cm36651->ara_client = i2c_new_dummy_device(client->adapter, CM36651_ARA);
657 	if (IS_ERR(cm36651->ara_client)) {
658 		dev_err(&client->dev, "%s: new i2c device failed\n", __func__);
659 		ret = PTR_ERR(cm36651->ara_client);
660 		goto error_i2c_unregister_ps;
661 	}
662 
663 	mutex_init(&cm36651->lock);
664 	indio_dev->channels = cm36651_channels;
665 	indio_dev->num_channels = ARRAY_SIZE(cm36651_channels);
666 	indio_dev->info = &cm36651_info;
667 	indio_dev->name = id->name;
668 	indio_dev->modes = INDIO_DIRECT_MODE;
669 
670 	ret = cm36651_setup_reg(cm36651);
671 	if (ret) {
672 		dev_err(&client->dev, "%s: register setup failed\n", __func__);
673 		goto error_i2c_unregister_ara;
674 	}
675 
676 	ret = request_threaded_irq(client->irq, NULL, cm36651_irq_handler,
677 					IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
678 							"cm36651", indio_dev);
679 	if (ret) {
680 		dev_err(&client->dev, "%s: request irq failed\n", __func__);
681 		goto error_i2c_unregister_ara;
682 	}
683 
684 	ret = iio_device_register(indio_dev);
685 	if (ret) {
686 		dev_err(&client->dev, "%s: regist device failed\n", __func__);
687 		goto error_free_irq;
688 	}
689 
690 	return 0;
691 
692 error_free_irq:
693 	free_irq(client->irq, indio_dev);
694 error_i2c_unregister_ara:
695 	i2c_unregister_device(cm36651->ara_client);
696 error_i2c_unregister_ps:
697 	i2c_unregister_device(cm36651->ps_client);
698 error_disable_reg:
699 	regulator_disable(cm36651->vled_reg);
700 	return ret;
701 }
702 
cm36651_remove(struct i2c_client * client)703 static void cm36651_remove(struct i2c_client *client)
704 {
705 	struct iio_dev *indio_dev = i2c_get_clientdata(client);
706 	struct cm36651_data *cm36651 = iio_priv(indio_dev);
707 
708 	iio_device_unregister(indio_dev);
709 	regulator_disable(cm36651->vled_reg);
710 	free_irq(client->irq, indio_dev);
711 	i2c_unregister_device(cm36651->ps_client);
712 	i2c_unregister_device(cm36651->ara_client);
713 }
714 
715 static const struct i2c_device_id cm36651_id[] = {
716 	{ "cm36651", 0 },
717 	{ }
718 };
719 
720 MODULE_DEVICE_TABLE(i2c, cm36651_id);
721 
722 static const struct of_device_id cm36651_of_match[] = {
723 	{ .compatible = "capella,cm36651" },
724 	{ }
725 };
726 MODULE_DEVICE_TABLE(of, cm36651_of_match);
727 
728 static struct i2c_driver cm36651_driver = {
729 	.driver = {
730 		.name	= "cm36651",
731 		.of_match_table = cm36651_of_match,
732 	},
733 	.probe		= cm36651_probe,
734 	.remove		= cm36651_remove,
735 	.id_table	= cm36651_id,
736 };
737 
738 module_i2c_driver(cm36651_driver);
739 
740 MODULE_AUTHOR("Beomho Seo <beomho.seo@samsung.com>");
741 MODULE_DESCRIPTION("CM36651 proximity/ambient light sensor driver");
742 MODULE_LICENSE("GPL v2");
743