1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * apds9960.c - Support for Avago APDS9960 gesture/RGB/ALS/proximity sensor
4  *
5  * Copyright (C) 2015, 2018
6  * Author: Matt Ranostay <matt.ranostay@konsulko.com>
7  *
8  * TODO: gesture + proximity calib offsets
9  */
10 
11 #include <linux/module.h>
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
14 #include <linux/delay.h>
15 #include <linux/mutex.h>
16 #include <linux/err.h>
17 #include <linux/irq.h>
18 #include <linux/gpio.h>
19 #include <linux/i2c.h>
20 #include <linux/pm_runtime.h>
21 #include <linux/regmap.h>
22 #include <linux/iio/iio.h>
23 #include <linux/iio/buffer.h>
24 #include <linux/iio/events.h>
25 #include <linux/iio/kfifo_buf.h>
26 #include <linux/iio/sysfs.h>
27 #include <linux/of_gpio.h>
28 
29 #define APDS9960_REGMAP_NAME	"apds9960_regmap"
30 #define APDS9960_DRV_NAME	"apds9960"
31 
32 #define APDS9960_REG_RAM_START	0x00
33 #define APDS9960_REG_RAM_END	0x7f
34 
35 #define APDS9960_REG_ENABLE	0x80
36 #define APDS9960_REG_ATIME	0x81
37 #define APDS9960_REG_WTIME	0x83
38 
39 #define APDS9960_REG_AILTL	0x84
40 #define APDS9960_REG_AILTH	0x85
41 #define APDS9960_REG_AIHTL	0x86
42 #define APDS9960_REG_AIHTH	0x87
43 
44 #define APDS9960_REG_PILT	0x89
45 #define APDS9960_REG_PIHT	0x8b
46 #define APDS9960_REG_PERS	0x8c
47 
48 #define APDS9960_REG_CONFIG_1	0x8d
49 #define APDS9960_REG_PPULSE	0x8e
50 
51 #define APDS9960_REG_CONTROL	0x8f
52 #define APDS9960_REG_CONTROL_AGAIN_MASK		0x03
53 #define APDS9960_REG_CONTROL_PGAIN_MASK		0x0c
54 #define APDS9960_REG_CONTROL_AGAIN_MASK_SHIFT	0
55 #define APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT	2
56 
57 #define APDS9960_REG_CONFIG_2	0x90
58 #define APDS9960_REG_CONFIG_2_GGAIN_MASK	0x60
59 #define APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT	5
60 
61 #define APDS9960_REG_ID		0x92
62 
63 #define APDS9960_REG_STATUS	0x93
64 #define APDS9960_REG_STATUS_PS_INT	BIT(5)
65 #define APDS9960_REG_STATUS_ALS_INT	BIT(4)
66 #define APDS9960_REG_STATUS_GINT	BIT(2)
67 
68 #define APDS9960_REG_PDATA	0x9c
69 #define APDS9960_REG_POFFSET_UR	0x9d
70 #define APDS9960_REG_POFFSET_DL 0x9e
71 #define APDS9960_REG_CONFIG_3	0x9f
72 
73 #define APDS9960_REG_GPENTH	0xa0
74 #define APDS9960_REG_GEXTH	0xa1
75 
76 #define APDS9960_REG_GCONF_1	0xa2
77 #define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK		0xc0
78 #define APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT	6
79 
80 #define APDS9960_REG_GCONF_2	0xa3
81 #define APDS9960_REG_GOFFSET_U	0xa4
82 #define APDS9960_REG_GOFFSET_D	0xa5
83 #define APDS9960_REG_GPULSE	0xa6
84 #define APDS9960_REG_GOFFSET_L	0xa7
85 #define APDS9960_REG_GOFFSET_R	0xa9
86 #define APDS9960_REG_GCONF_3	0xaa
87 
88 #define APDS9960_REG_GCONF_4	0xab
89 #define APDS9960_REG_GFLVL	0xae
90 #define APDS9960_REG_GSTATUS	0xaf
91 
92 #define APDS9960_REG_IFORCE	0xe4
93 #define APDS9960_REG_PICLEAR	0xe5
94 #define APDS9960_REG_CICLEAR	0xe6
95 #define APDS9960_REG_AICLEAR	0xe7
96 
97 #define APDS9960_DEFAULT_PERS	0x33
98 #define APDS9960_DEFAULT_GPENTH	0x50
99 #define APDS9960_DEFAULT_GEXTH	0x40
100 
101 #define APDS9960_MAX_PXS_THRES_VAL	255
102 #define APDS9960_MAX_ALS_THRES_VAL	0xffff
103 #define APDS9960_MAX_INT_TIME_IN_US	1000000
104 
105 enum apds9960_als_channel_idx {
106 	IDX_ALS_CLEAR, IDX_ALS_RED, IDX_ALS_GREEN, IDX_ALS_BLUE,
107 };
108 
109 #define APDS9960_REG_ALS_BASE	0x94
110 #define APDS9960_REG_ALS_CHANNEL(_colour) \
111 	(APDS9960_REG_ALS_BASE + (IDX_ALS_##_colour * 2))
112 
113 enum apds9960_gesture_channel_idx {
114 	IDX_DIR_UP, IDX_DIR_DOWN, IDX_DIR_LEFT, IDX_DIR_RIGHT,
115 };
116 
117 #define APDS9960_REG_GFIFO_BASE	0xfc
118 #define APDS9960_REG_GFIFO_DIR(_dir) \
119 	(APDS9960_REG_GFIFO_BASE + IDX_DIR_##_dir)
120 
121 struct apds9960_data {
122 	struct i2c_client *client;
123 	struct iio_dev *indio_dev;
124 	struct mutex lock;
125 
126 	/* regmap fields */
127 	struct regmap *regmap;
128 	struct regmap_field *reg_int_als;
129 	struct regmap_field *reg_int_ges;
130 	struct regmap_field *reg_int_pxs;
131 
132 	struct regmap_field *reg_enable_als;
133 	struct regmap_field *reg_enable_ges;
134 	struct regmap_field *reg_enable_pxs;
135 
136 	/* state */
137 	int als_int;
138 	int pxs_int;
139 	int gesture_mode_running;
140 
141 	/* gain values */
142 	int als_gain;
143 	int pxs_gain;
144 
145 	/* integration time value in us */
146 	int als_adc_int_us;
147 
148 	/* gesture buffer */
149 	u8 buffer[4]; /* 4 8-bit channels */
150 };
151 
152 static const struct reg_default apds9960_reg_defaults[] = {
153 	/* Default ALS integration time = 2.48ms */
154 	{ APDS9960_REG_ATIME, 0xff },
155 };
156 
157 static const struct regmap_range apds9960_volatile_ranges[] = {
158 	regmap_reg_range(APDS9960_REG_STATUS,
159 				APDS9960_REG_PDATA),
160 	regmap_reg_range(APDS9960_REG_GFLVL,
161 				APDS9960_REG_GSTATUS),
162 	regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP),
163 				APDS9960_REG_GFIFO_DIR(RIGHT)),
164 	regmap_reg_range(APDS9960_REG_IFORCE,
165 				APDS9960_REG_AICLEAR),
166 };
167 
168 static const struct regmap_access_table apds9960_volatile_table = {
169 	.yes_ranges	= apds9960_volatile_ranges,
170 	.n_yes_ranges	= ARRAY_SIZE(apds9960_volatile_ranges),
171 };
172 
173 static const struct regmap_range apds9960_precious_ranges[] = {
174 	regmap_reg_range(APDS9960_REG_RAM_START, APDS9960_REG_RAM_END),
175 };
176 
177 static const struct regmap_access_table apds9960_precious_table = {
178 	.yes_ranges	= apds9960_precious_ranges,
179 	.n_yes_ranges	= ARRAY_SIZE(apds9960_precious_ranges),
180 };
181 
182 static const struct regmap_range apds9960_readable_ranges[] = {
183 	regmap_reg_range(APDS9960_REG_ENABLE,
184 				APDS9960_REG_GSTATUS),
185 	regmap_reg_range(APDS9960_REG_GFIFO_DIR(UP),
186 				APDS9960_REG_GFIFO_DIR(RIGHT)),
187 };
188 
189 static const struct regmap_access_table apds9960_readable_table = {
190 	.yes_ranges	= apds9960_readable_ranges,
191 	.n_yes_ranges	= ARRAY_SIZE(apds9960_readable_ranges),
192 };
193 
194 static const struct regmap_range apds9960_writeable_ranges[] = {
195 	regmap_reg_range(APDS9960_REG_ENABLE, APDS9960_REG_CONFIG_2),
196 	regmap_reg_range(APDS9960_REG_POFFSET_UR, APDS9960_REG_GCONF_4),
197 	regmap_reg_range(APDS9960_REG_IFORCE, APDS9960_REG_AICLEAR),
198 };
199 
200 static const struct regmap_access_table apds9960_writeable_table = {
201 	.yes_ranges	= apds9960_writeable_ranges,
202 	.n_yes_ranges	= ARRAY_SIZE(apds9960_writeable_ranges),
203 };
204 
205 static const struct regmap_config apds9960_regmap_config = {
206 	.name = APDS9960_REGMAP_NAME,
207 	.reg_bits = 8,
208 	.val_bits = 8,
209 	.use_single_rw = 1,
210 
211 	.volatile_table = &apds9960_volatile_table,
212 	.precious_table = &apds9960_precious_table,
213 	.rd_table = &apds9960_readable_table,
214 	.wr_table = &apds9960_writeable_table,
215 
216 	.reg_defaults = apds9960_reg_defaults,
217 	.num_reg_defaults = ARRAY_SIZE(apds9960_reg_defaults),
218 	.max_register = APDS9960_REG_GFIFO_DIR(RIGHT),
219 	.cache_type = REGCACHE_RBTREE,
220 };
221 
222 static const struct iio_event_spec apds9960_pxs_event_spec[] = {
223 	{
224 		.type = IIO_EV_TYPE_THRESH,
225 		.dir = IIO_EV_DIR_RISING,
226 		.mask_separate = BIT(IIO_EV_INFO_VALUE) |
227 			BIT(IIO_EV_INFO_ENABLE),
228 	},
229 	{
230 		.type = IIO_EV_TYPE_THRESH,
231 		.dir = IIO_EV_DIR_FALLING,
232 		.mask_separate = BIT(IIO_EV_INFO_VALUE) |
233 			BIT(IIO_EV_INFO_ENABLE),
234 	},
235 };
236 
237 static const struct iio_event_spec apds9960_als_event_spec[] = {
238 	{
239 		.type = IIO_EV_TYPE_THRESH,
240 		.dir = IIO_EV_DIR_RISING,
241 		.mask_separate = BIT(IIO_EV_INFO_VALUE) |
242 			BIT(IIO_EV_INFO_ENABLE),
243 	},
244 	{
245 		.type = IIO_EV_TYPE_THRESH,
246 		.dir = IIO_EV_DIR_FALLING,
247 		.mask_separate = BIT(IIO_EV_INFO_VALUE) |
248 			BIT(IIO_EV_INFO_ENABLE),
249 	},
250 };
251 
252 #define APDS9960_GESTURE_CHANNEL(_dir, _si) { \
253 	.type = IIO_PROXIMITY, \
254 	.channel = _si + 1, \
255 	.scan_index = _si, \
256 	.indexed = 1, \
257 	.scan_type = { \
258 		.sign = 'u', \
259 		.realbits = 8, \
260 		.storagebits = 8, \
261 	}, \
262 }
263 
264 #define APDS9960_INTENSITY_CHANNEL(_colour) { \
265 	.type = IIO_INTENSITY, \
266 	.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
267 	.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
268 			BIT(IIO_CHAN_INFO_INT_TIME), \
269 	.channel2 = IIO_MOD_LIGHT_##_colour, \
270 	.address = APDS9960_REG_ALS_CHANNEL(_colour), \
271 	.modified = 1, \
272 	.scan_index = -1, \
273 }
274 
275 static const unsigned long apds9960_scan_masks[] = {0xf, 0};
276 
277 static const struct iio_chan_spec apds9960_channels[] = {
278 	{
279 		.type = IIO_PROXIMITY,
280 		.address = APDS9960_REG_PDATA,
281 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
282 		.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE),
283 		.channel = 0,
284 		.indexed = 0,
285 		.scan_index = -1,
286 
287 		.event_spec = apds9960_pxs_event_spec,
288 		.num_event_specs = ARRAY_SIZE(apds9960_pxs_event_spec),
289 	},
290 	/* Gesture Sensor */
291 	APDS9960_GESTURE_CHANNEL(UP, 0),
292 	APDS9960_GESTURE_CHANNEL(DOWN, 1),
293 	APDS9960_GESTURE_CHANNEL(LEFT, 2),
294 	APDS9960_GESTURE_CHANNEL(RIGHT, 3),
295 	/* ALS */
296 	{
297 		.type = IIO_INTENSITY,
298 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
299 		.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) |
300 			BIT(IIO_CHAN_INFO_INT_TIME),
301 		.channel2 = IIO_MOD_LIGHT_CLEAR,
302 		.address = APDS9960_REG_ALS_CHANNEL(CLEAR),
303 		.modified = 1,
304 		.scan_index = -1,
305 
306 		.event_spec = apds9960_als_event_spec,
307 		.num_event_specs = ARRAY_SIZE(apds9960_als_event_spec),
308 	},
309 	/* RGB Sensor */
310 	APDS9960_INTENSITY_CHANNEL(RED),
311 	APDS9960_INTENSITY_CHANNEL(GREEN),
312 	APDS9960_INTENSITY_CHANNEL(BLUE),
313 };
314 
315 /* integration time in us */
316 static const int apds9960_int_time[][2] = {
317 	{ 28000, 246},
318 	{100000, 219},
319 	{200000, 182},
320 	{700000,   0}
321 };
322 
323 /* gain mapping */
324 static const int apds9960_pxs_gain_map[] = {1, 2, 4, 8};
325 static const int apds9960_als_gain_map[] = {1, 4, 16, 64};
326 
327 static IIO_CONST_ATTR(proximity_scale_available, "1 2 4 8");
328 static IIO_CONST_ATTR(intensity_scale_available, "1 4 16 64");
329 static IIO_CONST_ATTR_INT_TIME_AVAIL("0.028 0.1 0.2 0.7");
330 
331 static struct attribute *apds9960_attributes[] = {
332 	&iio_const_attr_proximity_scale_available.dev_attr.attr,
333 	&iio_const_attr_intensity_scale_available.dev_attr.attr,
334 	&iio_const_attr_integration_time_available.dev_attr.attr,
335 	NULL,
336 };
337 
338 static const struct attribute_group apds9960_attribute_group = {
339 	.attrs = apds9960_attributes,
340 };
341 
342 static const struct reg_field apds9960_reg_field_int_als =
343 				REG_FIELD(APDS9960_REG_ENABLE, 4, 4);
344 
345 static const struct reg_field apds9960_reg_field_int_ges =
346 				REG_FIELD(APDS9960_REG_GCONF_4, 1, 1);
347 
348 static const struct reg_field apds9960_reg_field_int_pxs =
349 				REG_FIELD(APDS9960_REG_ENABLE, 5, 5);
350 
351 static const struct reg_field apds9960_reg_field_enable_als =
352 				REG_FIELD(APDS9960_REG_ENABLE, 1, 1);
353 
354 static const struct reg_field apds9960_reg_field_enable_ges =
355 				REG_FIELD(APDS9960_REG_ENABLE, 6, 6);
356 
357 static const struct reg_field apds9960_reg_field_enable_pxs =
358 				REG_FIELD(APDS9960_REG_ENABLE, 2, 2);
359 
apds9960_set_it_time(struct apds9960_data * data,int val2)360 static int apds9960_set_it_time(struct apds9960_data *data, int val2)
361 {
362 	int ret = -EINVAL;
363 	int idx;
364 
365 	for (idx = 0; idx < ARRAY_SIZE(apds9960_int_time); idx++) {
366 		if (apds9960_int_time[idx][0] == val2) {
367 			mutex_lock(&data->lock);
368 			ret = regmap_write(data->regmap, APDS9960_REG_ATIME,
369 						 apds9960_int_time[idx][1]);
370 			if (!ret)
371 				data->als_adc_int_us = val2;
372 			mutex_unlock(&data->lock);
373 			break;
374 		}
375 	}
376 
377 	return ret;
378 }
379 
apds9960_set_pxs_gain(struct apds9960_data * data,int val)380 static int apds9960_set_pxs_gain(struct apds9960_data *data, int val)
381 {
382 	int ret = -EINVAL;
383 	int idx;
384 
385 	for (idx = 0; idx < ARRAY_SIZE(apds9960_pxs_gain_map); idx++) {
386 		if (apds9960_pxs_gain_map[idx] == val) {
387 			/* pxs + gesture gains are mirrored */
388 			mutex_lock(&data->lock);
389 			ret = regmap_update_bits(data->regmap,
390 				APDS9960_REG_CONTROL,
391 				APDS9960_REG_CONTROL_PGAIN_MASK,
392 				idx << APDS9960_REG_CONTROL_PGAIN_MASK_SHIFT);
393 			if (ret) {
394 				mutex_unlock(&data->lock);
395 				break;
396 			}
397 
398 			ret = regmap_update_bits(data->regmap,
399 				APDS9960_REG_CONFIG_2,
400 				APDS9960_REG_CONFIG_2_GGAIN_MASK,
401 				idx << APDS9960_REG_CONFIG_2_GGAIN_MASK_SHIFT);
402 			if (!ret)
403 				data->pxs_gain = idx;
404 			mutex_unlock(&data->lock);
405 			break;
406 		}
407 	}
408 
409 	return ret;
410 }
411 
apds9960_set_als_gain(struct apds9960_data * data,int val)412 static int apds9960_set_als_gain(struct apds9960_data *data, int val)
413 {
414 	int ret = -EINVAL;
415 	int idx;
416 
417 	for (idx = 0; idx < ARRAY_SIZE(apds9960_als_gain_map); idx++) {
418 		if (apds9960_als_gain_map[idx] == val) {
419 			mutex_lock(&data->lock);
420 			ret = regmap_update_bits(data->regmap,
421 					APDS9960_REG_CONTROL,
422 					APDS9960_REG_CONTROL_AGAIN_MASK, idx);
423 			if (!ret)
424 				data->als_gain = idx;
425 			mutex_unlock(&data->lock);
426 			break;
427 		}
428 	}
429 
430 	return ret;
431 }
432 
433 #ifdef CONFIG_PM
apds9960_set_power_state(struct apds9960_data * data,bool on)434 static int apds9960_set_power_state(struct apds9960_data *data, bool on)
435 {
436 	struct device *dev = &data->client->dev;
437 	int ret = 0;
438 
439 	mutex_lock(&data->lock);
440 
441 	if (on) {
442 		int suspended;
443 
444 		suspended = pm_runtime_suspended(dev);
445 		ret = pm_runtime_get_sync(dev);
446 
447 		/* Allow one integration cycle before allowing a reading */
448 		if (suspended)
449 			usleep_range(data->als_adc_int_us,
450 				     APDS9960_MAX_INT_TIME_IN_US);
451 	} else {
452 		pm_runtime_mark_last_busy(dev);
453 		ret = pm_runtime_put_autosuspend(dev);
454 	}
455 
456 	mutex_unlock(&data->lock);
457 
458 	return ret;
459 }
460 #else
apds9960_set_power_state(struct apds9960_data * data,bool on)461 static int apds9960_set_power_state(struct apds9960_data *data, bool on)
462 {
463 	return 0;
464 }
465 #endif
466 
apds9960_read_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int * val,int * val2,long mask)467 static int apds9960_read_raw(struct iio_dev *indio_dev,
468 			     struct iio_chan_spec const *chan,
469 			     int *val, int *val2, long mask)
470 {
471 	struct apds9960_data *data = iio_priv(indio_dev);
472 	__le16 buf;
473 	int ret = -EINVAL;
474 
475 	if (data->gesture_mode_running)
476 		return -EBUSY;
477 
478 	switch (mask) {
479 	case IIO_CHAN_INFO_RAW:
480 		apds9960_set_power_state(data, true);
481 		switch (chan->type) {
482 		case IIO_PROXIMITY:
483 			ret = regmap_read(data->regmap, chan->address, val);
484 			if (!ret)
485 				ret = IIO_VAL_INT;
486 			break;
487 		case IIO_INTENSITY:
488 			ret = regmap_bulk_read(data->regmap, chan->address,
489 					       &buf, 2);
490 			if (!ret) {
491 				ret = IIO_VAL_INT;
492 				*val = le16_to_cpu(buf);
493 			}
494 			break;
495 		default:
496 			ret = -EINVAL;
497 		}
498 		apds9960_set_power_state(data, false);
499 		break;
500 	case IIO_CHAN_INFO_INT_TIME:
501 		/* RGB + ALS sensors only have integration time */
502 		mutex_lock(&data->lock);
503 		switch (chan->type) {
504 		case IIO_INTENSITY:
505 			*val = 0;
506 			*val2 = data->als_adc_int_us;
507 			ret = IIO_VAL_INT_PLUS_MICRO;
508 			break;
509 		default:
510 			ret = -EINVAL;
511 		}
512 		mutex_unlock(&data->lock);
513 		break;
514 	case IIO_CHAN_INFO_SCALE:
515 		mutex_lock(&data->lock);
516 		switch (chan->type) {
517 		case IIO_PROXIMITY:
518 			*val = apds9960_pxs_gain_map[data->pxs_gain];
519 			ret = IIO_VAL_INT;
520 			break;
521 		case IIO_INTENSITY:
522 			*val = apds9960_als_gain_map[data->als_gain];
523 			ret = IIO_VAL_INT;
524 			break;
525 		default:
526 			ret = -EINVAL;
527 		}
528 		mutex_unlock(&data->lock);
529 		break;
530 	}
531 
532 	return ret;
533 };
534 
apds9960_write_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int val,int val2,long mask)535 static int apds9960_write_raw(struct iio_dev *indio_dev,
536 			     struct iio_chan_spec const *chan,
537 			     int val, int val2, long mask)
538 {
539 	struct apds9960_data *data = iio_priv(indio_dev);
540 
541 	switch (mask) {
542 	case IIO_CHAN_INFO_INT_TIME:
543 		/* RGB + ALS sensors only have int time */
544 		switch (chan->type) {
545 		case IIO_INTENSITY:
546 			if (val != 0)
547 				return -EINVAL;
548 			return apds9960_set_it_time(data, val2);
549 		default:
550 			return -EINVAL;
551 		}
552 	case IIO_CHAN_INFO_SCALE:
553 		if (val2 != 0)
554 			return -EINVAL;
555 		switch (chan->type) {
556 		case IIO_PROXIMITY:
557 			return apds9960_set_pxs_gain(data, val);
558 		case IIO_INTENSITY:
559 			return apds9960_set_als_gain(data, val);
560 		default:
561 			return -EINVAL;
562 		}
563 	default:
564 		return -EINVAL;
565 	};
566 
567 	return 0;
568 }
569 
apds9960_get_thres_reg(const struct iio_chan_spec * chan,enum iio_event_direction dir,u8 * reg)570 static inline int apds9960_get_thres_reg(const struct iio_chan_spec *chan,
571 					 enum iio_event_direction dir,
572 					 u8 *reg)
573 {
574 	switch (dir) {
575 	case IIO_EV_DIR_RISING:
576 		switch (chan->type) {
577 		case IIO_PROXIMITY:
578 			*reg = APDS9960_REG_PIHT;
579 			break;
580 		case IIO_INTENSITY:
581 			*reg = APDS9960_REG_AIHTL;
582 			break;
583 		default:
584 			return -EINVAL;
585 		}
586 		break;
587 	case IIO_EV_DIR_FALLING:
588 		switch (chan->type) {
589 		case IIO_PROXIMITY:
590 			*reg = APDS9960_REG_PILT;
591 			break;
592 		case IIO_INTENSITY:
593 			*reg = APDS9960_REG_AILTL;
594 			break;
595 		default:
596 			return -EINVAL;
597 		}
598 		break;
599 	default:
600 		return -EINVAL;
601 	}
602 
603 	return 0;
604 }
605 
apds9960_read_event(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)606 static int apds9960_read_event(struct iio_dev *indio_dev,
607 			       const struct iio_chan_spec *chan,
608 			       enum iio_event_type type,
609 			       enum iio_event_direction dir,
610 			       enum iio_event_info info,
611 			       int *val, int *val2)
612 {
613 	u8 reg;
614 	__le16 buf;
615 	int ret = 0;
616 	struct apds9960_data *data = iio_priv(indio_dev);
617 
618 	if (info != IIO_EV_INFO_VALUE)
619 		return -EINVAL;
620 
621 	ret = apds9960_get_thres_reg(chan, dir, &reg);
622 	if (ret < 0)
623 		return ret;
624 
625 	if (chan->type == IIO_PROXIMITY) {
626 		ret = regmap_read(data->regmap, reg, val);
627 		if (ret < 0)
628 			return ret;
629 	} else if (chan->type == IIO_INTENSITY) {
630 		ret = regmap_bulk_read(data->regmap, reg, &buf, 2);
631 		if (ret < 0)
632 			return ret;
633 		*val = le16_to_cpu(buf);
634 	} else
635 		return -EINVAL;
636 
637 	*val2 = 0;
638 
639 	return IIO_VAL_INT;
640 }
641 
apds9960_write_event(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)642 static int apds9960_write_event(struct iio_dev *indio_dev,
643 				const struct iio_chan_spec *chan,
644 				enum iio_event_type type,
645 				enum iio_event_direction dir,
646 				enum iio_event_info info,
647 				int val, int val2)
648 {
649 	u8 reg;
650 	__le16 buf;
651 	int ret = 0;
652 	struct apds9960_data *data = iio_priv(indio_dev);
653 
654 	if (info != IIO_EV_INFO_VALUE)
655 		return -EINVAL;
656 
657 	ret = apds9960_get_thres_reg(chan, dir, &reg);
658 	if (ret < 0)
659 		return ret;
660 
661 	if (chan->type == IIO_PROXIMITY) {
662 		if (val < 0 || val > APDS9960_MAX_PXS_THRES_VAL)
663 			return -EINVAL;
664 		ret = regmap_write(data->regmap, reg, val);
665 		if (ret < 0)
666 			return ret;
667 	} else if (chan->type == IIO_INTENSITY) {
668 		if (val < 0 || val > APDS9960_MAX_ALS_THRES_VAL)
669 			return -EINVAL;
670 		buf = cpu_to_le16(val);
671 		ret = regmap_bulk_write(data->regmap, reg, &buf, 2);
672 		if (ret < 0)
673 			return ret;
674 	} else
675 		return -EINVAL;
676 
677 	return 0;
678 }
679 
apds9960_read_event_config(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,enum iio_event_type type,enum iio_event_direction dir)680 static int apds9960_read_event_config(struct iio_dev *indio_dev,
681 				      const struct iio_chan_spec *chan,
682 				      enum iio_event_type type,
683 				      enum iio_event_direction dir)
684 {
685 	struct apds9960_data *data = iio_priv(indio_dev);
686 
687 	switch (chan->type) {
688 	case IIO_PROXIMITY:
689 		return data->pxs_int;
690 	case IIO_INTENSITY:
691 		return data->als_int;
692 	default:
693 		return -EINVAL;
694 	}
695 
696 	return 0;
697 }
698 
apds9960_write_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)699 static int apds9960_write_event_config(struct iio_dev *indio_dev,
700 				       const struct iio_chan_spec *chan,
701 				       enum iio_event_type type,
702 				       enum iio_event_direction dir,
703 				       int state)
704 {
705 	struct apds9960_data *data = iio_priv(indio_dev);
706 	int ret;
707 
708 	state = !!state;
709 
710 	switch (chan->type) {
711 	case IIO_PROXIMITY:
712 		if (data->pxs_int == state)
713 			return -EINVAL;
714 
715 		ret = regmap_field_write(data->reg_int_pxs, state);
716 		if (ret)
717 			return ret;
718 		data->pxs_int = state;
719 		apds9960_set_power_state(data, state);
720 		break;
721 	case IIO_INTENSITY:
722 		if (data->als_int == state)
723 			return -EINVAL;
724 
725 		ret = regmap_field_write(data->reg_int_als, state);
726 		if (ret)
727 			return ret;
728 		data->als_int = state;
729 		apds9960_set_power_state(data, state);
730 		break;
731 	default:
732 		return -EINVAL;
733 	}
734 
735 	return 0;
736 }
737 
738 static const struct iio_info apds9960_info = {
739 	.attrs = &apds9960_attribute_group,
740 	.read_raw = apds9960_read_raw,
741 	.write_raw = apds9960_write_raw,
742 	.read_event_value = apds9960_read_event,
743 	.write_event_value = apds9960_write_event,
744 	.read_event_config = apds9960_read_event_config,
745 	.write_event_config = apds9960_write_event_config,
746 
747 };
748 
apds9660_fifo_is_empty(struct apds9960_data * data)749 static inline int apds9660_fifo_is_empty(struct apds9960_data *data)
750 {
751 	int cnt;
752 	int ret;
753 
754 	ret = regmap_read(data->regmap, APDS9960_REG_GFLVL, &cnt);
755 	if (ret)
756 		return ret;
757 
758 	return cnt;
759 }
760 
apds9960_read_gesture_fifo(struct apds9960_data * data)761 static void apds9960_read_gesture_fifo(struct apds9960_data *data)
762 {
763 	int ret, cnt = 0;
764 
765 	mutex_lock(&data->lock);
766 	data->gesture_mode_running = 1;
767 
768 	while (cnt || (cnt = apds9660_fifo_is_empty(data) > 0)) {
769 		ret = regmap_bulk_read(data->regmap, APDS9960_REG_GFIFO_BASE,
770 				      &data->buffer, 4);
771 
772 		if (ret)
773 			goto err_read;
774 
775 		iio_push_to_buffers(data->indio_dev, data->buffer);
776 		cnt--;
777 	}
778 
779 err_read:
780 	data->gesture_mode_running = 0;
781 	mutex_unlock(&data->lock);
782 }
783 
apds9960_interrupt_handler(int irq,void * private)784 static irqreturn_t apds9960_interrupt_handler(int irq, void *private)
785 {
786 	struct iio_dev *indio_dev = private;
787 	struct apds9960_data *data = iio_priv(indio_dev);
788 	int ret, status;
789 
790 	ret = regmap_read(data->regmap, APDS9960_REG_STATUS, &status);
791 	if (ret < 0) {
792 		dev_err(&data->client->dev, "irq status reg read failed\n");
793 		return IRQ_HANDLED;
794 	}
795 
796 	if ((status & APDS9960_REG_STATUS_ALS_INT) && data->als_int) {
797 		iio_push_event(indio_dev,
798 			       IIO_UNMOD_EVENT_CODE(IIO_INTENSITY, 0,
799 						    IIO_EV_TYPE_THRESH,
800 						    IIO_EV_DIR_EITHER),
801 			       iio_get_time_ns(indio_dev));
802 		regmap_write(data->regmap, APDS9960_REG_CICLEAR, 1);
803 	}
804 
805 	if ((status & APDS9960_REG_STATUS_PS_INT) && data->pxs_int) {
806 		iio_push_event(indio_dev,
807 			       IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 0,
808 						    IIO_EV_TYPE_THRESH,
809 						    IIO_EV_DIR_EITHER),
810 			       iio_get_time_ns(indio_dev));
811 		regmap_write(data->regmap, APDS9960_REG_PICLEAR, 1);
812 	}
813 
814 	if (status & APDS9960_REG_STATUS_GINT)
815 		apds9960_read_gesture_fifo(data);
816 
817 	return IRQ_HANDLED;
818 }
819 
apds9960_set_powermode(struct apds9960_data * data,bool state)820 static int apds9960_set_powermode(struct apds9960_data *data, bool state)
821 {
822 	return regmap_update_bits(data->regmap, APDS9960_REG_ENABLE, 1, state);
823 }
824 
apds9960_buffer_postenable(struct iio_dev * indio_dev)825 static int apds9960_buffer_postenable(struct iio_dev *indio_dev)
826 {
827 	struct apds9960_data *data = iio_priv(indio_dev);
828 	int ret;
829 
830 	ret = regmap_field_write(data->reg_int_ges, 1);
831 	if (ret)
832 		return ret;
833 
834 	ret = regmap_field_write(data->reg_enable_ges, 1);
835 	if (ret)
836 		return ret;
837 
838 	pm_runtime_get_sync(&data->client->dev);
839 
840 	return 0;
841 }
842 
apds9960_buffer_predisable(struct iio_dev * indio_dev)843 static int apds9960_buffer_predisable(struct iio_dev *indio_dev)
844 {
845 	struct apds9960_data *data = iio_priv(indio_dev);
846 	int ret;
847 
848 	ret = regmap_field_write(data->reg_enable_ges, 0);
849 	if (ret)
850 		return ret;
851 
852 	ret = regmap_field_write(data->reg_int_ges, 0);
853 	if (ret)
854 		return ret;
855 
856 	pm_runtime_put_autosuspend(&data->client->dev);
857 
858 	return 0;
859 }
860 
861 static const struct iio_buffer_setup_ops apds9960_buffer_setup_ops = {
862 	.postenable = apds9960_buffer_postenable,
863 	.predisable = apds9960_buffer_predisable,
864 };
865 
apds9960_regfield_init(struct apds9960_data * data)866 static int apds9960_regfield_init(struct apds9960_data *data)
867 {
868 	struct device *dev = &data->client->dev;
869 	struct regmap *regmap = data->regmap;
870 
871 	data->reg_int_als = devm_regmap_field_alloc(dev, regmap,
872 						apds9960_reg_field_int_als);
873 	if (IS_ERR(data->reg_int_als)) {
874 		dev_err(dev, "INT ALS reg field init failed\n");
875 		return PTR_ERR(data->reg_int_als);
876 	}
877 
878 	data->reg_int_ges = devm_regmap_field_alloc(dev, regmap,
879 						apds9960_reg_field_int_ges);
880 	if (IS_ERR(data->reg_int_ges)) {
881 		dev_err(dev, "INT gesture reg field init failed\n");
882 		return PTR_ERR(data->reg_int_ges);
883 	}
884 
885 	data->reg_int_pxs = devm_regmap_field_alloc(dev, regmap,
886 						apds9960_reg_field_int_pxs);
887 	if (IS_ERR(data->reg_int_pxs)) {
888 		dev_err(dev, "INT pxs reg field init failed\n");
889 		return PTR_ERR(data->reg_int_pxs);
890 	}
891 
892 	data->reg_enable_als = devm_regmap_field_alloc(dev, regmap,
893 						apds9960_reg_field_enable_als);
894 	if (IS_ERR(data->reg_enable_als)) {
895 		dev_err(dev, "Enable ALS reg field init failed\n");
896 		return PTR_ERR(data->reg_enable_als);
897 	}
898 
899 	data->reg_enable_ges = devm_regmap_field_alloc(dev, regmap,
900 						apds9960_reg_field_enable_ges);
901 	if (IS_ERR(data->reg_enable_ges)) {
902 		dev_err(dev, "Enable gesture reg field init failed\n");
903 		return PTR_ERR(data->reg_enable_ges);
904 	}
905 
906 	data->reg_enable_pxs = devm_regmap_field_alloc(dev, regmap,
907 						apds9960_reg_field_enable_pxs);
908 	if (IS_ERR(data->reg_enable_pxs)) {
909 		dev_err(dev, "Enable PXS reg field init failed\n");
910 		return PTR_ERR(data->reg_enable_pxs);
911 	}
912 
913 	return 0;
914 }
915 
apds9960_chip_init(struct apds9960_data * data)916 static int apds9960_chip_init(struct apds9960_data *data)
917 {
918 	int ret;
919 
920 	/* Default IT for ALS of 28 ms */
921 	ret = apds9960_set_it_time(data, 28000);
922 	if (ret)
923 		return ret;
924 
925 	/* Ensure gesture interrupt is OFF */
926 	ret = regmap_field_write(data->reg_int_ges, 0);
927 	if (ret)
928 		return ret;
929 
930 	/* Disable gesture sensor, since polling is useless from user-space */
931 	ret = regmap_field_write(data->reg_enable_ges, 0);
932 	if (ret)
933 		return ret;
934 
935 	/* Ensure proximity interrupt is OFF */
936 	ret = regmap_field_write(data->reg_int_pxs, 0);
937 	if (ret)
938 		return ret;
939 
940 	/* Enable proximity sensor for polling */
941 	ret = regmap_field_write(data->reg_enable_pxs, 1);
942 	if (ret)
943 		return ret;
944 
945 	/* Ensure ALS interrupt is OFF */
946 	ret = regmap_field_write(data->reg_int_als, 0);
947 	if (ret)
948 		return ret;
949 
950 	/* Enable ALS sensor for polling */
951 	ret = regmap_field_write(data->reg_enable_als, 1);
952 	if (ret)
953 		return ret;
954 	/*
955 	 * When enabled trigger an interrupt after 3 readings
956 	 * outside threshold for ALS + PXS
957 	 */
958 	ret = regmap_write(data->regmap, APDS9960_REG_PERS,
959 			   APDS9960_DEFAULT_PERS);
960 	if (ret)
961 		return ret;
962 
963 	/*
964 	 * Wait for 4 event outside gesture threshold to prevent interrupt
965 	 * flooding.
966 	 */
967 	ret = regmap_update_bits(data->regmap, APDS9960_REG_GCONF_1,
968 			APDS9960_REG_GCONF_1_GFIFO_THRES_MASK,
969 			BIT(0) << APDS9960_REG_GCONF_1_GFIFO_THRES_MASK_SHIFT);
970 	if (ret)
971 		return ret;
972 
973 	/* Default ENTER and EXIT thresholds for the GESTURE engine. */
974 	ret = regmap_write(data->regmap, APDS9960_REG_GPENTH,
975 			   APDS9960_DEFAULT_GPENTH);
976 	if (ret)
977 		return ret;
978 
979 	ret = regmap_write(data->regmap, APDS9960_REG_GEXTH,
980 			   APDS9960_DEFAULT_GEXTH);
981 	if (ret)
982 		return ret;
983 
984 	return apds9960_set_powermode(data, 1);
985 }
986 
apds9960_probe(struct i2c_client * client,const struct i2c_device_id * id)987 static int apds9960_probe(struct i2c_client *client,
988 			  const struct i2c_device_id *id)
989 {
990 	struct apds9960_data *data;
991 	struct iio_buffer *buffer;
992 	struct iio_dev *indio_dev;
993 	int ret;
994 
995 	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
996 	if (!indio_dev)
997 		return -ENOMEM;
998 
999 	buffer = devm_iio_kfifo_allocate(&client->dev);
1000 	if (!buffer)
1001 		return -ENOMEM;
1002 
1003 	iio_device_attach_buffer(indio_dev, buffer);
1004 
1005 	indio_dev->dev.parent = &client->dev;
1006 	indio_dev->info = &apds9960_info;
1007 	indio_dev->name = APDS9960_DRV_NAME;
1008 	indio_dev->channels = apds9960_channels;
1009 	indio_dev->num_channels = ARRAY_SIZE(apds9960_channels);
1010 	indio_dev->available_scan_masks = apds9960_scan_masks;
1011 	indio_dev->modes = (INDIO_BUFFER_SOFTWARE | INDIO_DIRECT_MODE);
1012 	indio_dev->setup_ops = &apds9960_buffer_setup_ops;
1013 
1014 	data = iio_priv(indio_dev);
1015 	i2c_set_clientdata(client, indio_dev);
1016 
1017 	data->regmap = devm_regmap_init_i2c(client, &apds9960_regmap_config);
1018 	if (IS_ERR(data->regmap)) {
1019 		dev_err(&client->dev, "regmap initialization failed.\n");
1020 		return PTR_ERR(data->regmap);
1021 	}
1022 
1023 	data->client = client;
1024 	data->indio_dev = indio_dev;
1025 	mutex_init(&data->lock);
1026 
1027 	ret = pm_runtime_set_active(&client->dev);
1028 	if (ret)
1029 		goto error_power_down;
1030 
1031 	pm_runtime_enable(&client->dev);
1032 	pm_runtime_set_autosuspend_delay(&client->dev, 5000);
1033 	pm_runtime_use_autosuspend(&client->dev);
1034 
1035 	apds9960_set_power_state(data, true);
1036 
1037 	ret = apds9960_regfield_init(data);
1038 	if (ret)
1039 		goto error_power_down;
1040 
1041 	ret = apds9960_chip_init(data);
1042 	if (ret)
1043 		goto error_power_down;
1044 
1045 	if (client->irq <= 0) {
1046 		dev_err(&client->dev, "no valid irq defined\n");
1047 		ret = -EINVAL;
1048 		goto error_power_down;
1049 	}
1050 	ret = devm_request_threaded_irq(&client->dev, client->irq,
1051 					NULL, apds9960_interrupt_handler,
1052 					IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
1053 					"apds9960_event",
1054 					indio_dev);
1055 	if (ret) {
1056 		dev_err(&client->dev, "request irq (%d) failed\n", client->irq);
1057 		goto error_power_down;
1058 	}
1059 
1060 	ret = iio_device_register(indio_dev);
1061 	if (ret)
1062 		goto error_power_down;
1063 
1064 	apds9960_set_power_state(data, false);
1065 
1066 	return 0;
1067 
1068 error_power_down:
1069 	apds9960_set_power_state(data, false);
1070 
1071 	return ret;
1072 }
1073 
apds9960_remove(struct i2c_client * client)1074 static int apds9960_remove(struct i2c_client *client)
1075 {
1076 	struct iio_dev *indio_dev = i2c_get_clientdata(client);
1077 	struct apds9960_data *data = iio_priv(indio_dev);
1078 
1079 	iio_device_unregister(indio_dev);
1080 	pm_runtime_disable(&client->dev);
1081 	pm_runtime_set_suspended(&client->dev);
1082 	apds9960_set_powermode(data, 0);
1083 
1084 	return 0;
1085 }
1086 
1087 #ifdef CONFIG_PM
apds9960_runtime_suspend(struct device * dev)1088 static int apds9960_runtime_suspend(struct device *dev)
1089 {
1090 	struct apds9960_data *data =
1091 			iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
1092 
1093 	return apds9960_set_powermode(data, 0);
1094 }
1095 
apds9960_runtime_resume(struct device * dev)1096 static int apds9960_runtime_resume(struct device *dev)
1097 {
1098 	struct apds9960_data *data =
1099 			iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
1100 
1101 	return apds9960_set_powermode(data, 1);
1102 }
1103 #endif
1104 
1105 static const struct dev_pm_ops apds9960_pm_ops = {
1106 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
1107 				pm_runtime_force_resume)
1108 	SET_RUNTIME_PM_OPS(apds9960_runtime_suspend,
1109 			   apds9960_runtime_resume, NULL)
1110 };
1111 
1112 static const struct i2c_device_id apds9960_id[] = {
1113 	{ "apds9960", 0 },
1114 	{}
1115 };
1116 MODULE_DEVICE_TABLE(i2c, apds9960_id);
1117 
1118 static const struct of_device_id apds9960_of_match[] = {
1119 	{ .compatible = "avago,apds9960" },
1120 	{ }
1121 };
1122 MODULE_DEVICE_TABLE(of, apds9960_of_match);
1123 
1124 static struct i2c_driver apds9960_driver = {
1125 	.driver = {
1126 		.name	= APDS9960_DRV_NAME,
1127 		.of_match_table = apds9960_of_match,
1128 		.pm	= &apds9960_pm_ops,
1129 	},
1130 	.probe		= apds9960_probe,
1131 	.remove		= apds9960_remove,
1132 	.id_table	= apds9960_id,
1133 };
1134 module_i2c_driver(apds9960_driver);
1135 
1136 MODULE_AUTHOR("Matt Ranostay <matt.ranostay@konsulko.com>");
1137 MODULE_DESCRIPTION("ADPS9960 Gesture/RGB/ALS/Proximity sensor");
1138 MODULE_LICENSE("GPL");
1139