1
2
3
4
5
6
7
8
9
10#include <linux/kernel.h>
11#include <linux/slab.h>
12#include <linux/module.h>
13#include <linux/i2c.h>
14#include <linux/irq.h>
15#include <linux/acpi.h>
16#include <linux/gpio/consumer.h>
17#include <linux/regmap.h>
18#include <linux/pm.h>
19#include <linux/delay.h>
20
21#include <linux/iio/iio.h>
22#include <linux/iio/buffer.h>
23#include <linux/iio/sysfs.h>
24#include <linux/iio/events.h>
25#include <linux/iio/trigger.h>
26#include <linux/iio/triggered_buffer.h>
27#include <linux/iio/trigger_consumer.h>
28
29#define SX9500_DRIVER_NAME "sx9500"
30#define SX9500_IRQ_NAME "sx9500_event"
31
32
33#define SX9500_REG_IRQ_SRC 0x00
34#define SX9500_REG_STAT 0x01
35#define SX9500_REG_IRQ_MSK 0x03
36
37#define SX9500_REG_PROX_CTRL0 0x06
38#define SX9500_REG_PROX_CTRL1 0x07
39#define SX9500_REG_PROX_CTRL2 0x08
40#define SX9500_REG_PROX_CTRL3 0x09
41#define SX9500_REG_PROX_CTRL4 0x0a
42#define SX9500_REG_PROX_CTRL5 0x0b
43#define SX9500_REG_PROX_CTRL6 0x0c
44#define SX9500_REG_PROX_CTRL7 0x0d
45#define SX9500_REG_PROX_CTRL8 0x0e
46
47#define SX9500_REG_SENSOR_SEL 0x20
48#define SX9500_REG_USE_MSB 0x21
49#define SX9500_REG_USE_LSB 0x22
50#define SX9500_REG_AVG_MSB 0x23
51#define SX9500_REG_AVG_LSB 0x24
52#define SX9500_REG_DIFF_MSB 0x25
53#define SX9500_REG_DIFF_LSB 0x26
54#define SX9500_REG_OFFSET_MSB 0x27
55#define SX9500_REG_OFFSET_LSB 0x28
56
57#define SX9500_REG_RESET 0x7f
58
59
60#define SX9500_SOFT_RESET 0xde
61
62#define SX9500_SCAN_PERIOD_MASK GENMASK(6, 4)
63#define SX9500_SCAN_PERIOD_SHIFT 4
64
65
66
67
68
69#define SX9500_CLOSE_IRQ BIT(6)
70#define SX9500_FAR_IRQ BIT(5)
71#define SX9500_CONVDONE_IRQ BIT(3)
72
73#define SX9500_PROXSTAT_SHIFT 4
74#define SX9500_COMPSTAT_MASK GENMASK(3, 0)
75
76#define SX9500_NUM_CHANNELS 4
77#define SX9500_CHAN_MASK GENMASK(SX9500_NUM_CHANNELS - 1, 0)
78
79struct sx9500_data {
80 struct mutex mutex;
81 struct i2c_client *client;
82 struct iio_trigger *trig;
83 struct regmap *regmap;
84 struct gpio_desc *gpiod_rst;
85
86
87
88
89 bool prox_stat[SX9500_NUM_CHANNELS];
90 bool event_enabled[SX9500_NUM_CHANNELS];
91 bool trigger_enabled;
92 u16 *buffer;
93
94 unsigned int suspend_ctrl0;
95 struct completion completion;
96 int data_rdy_users, close_far_users;
97 int channel_users[SX9500_NUM_CHANNELS];
98};
99
100static const struct iio_event_spec sx9500_events[] = {
101 {
102 .type = IIO_EV_TYPE_THRESH,
103 .dir = IIO_EV_DIR_EITHER,
104 .mask_separate = BIT(IIO_EV_INFO_ENABLE),
105 },
106};
107
108#define SX9500_CHANNEL(idx) \
109 { \
110 .type = IIO_PROXIMITY, \
111 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
112 .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \
113 .indexed = 1, \
114 .channel = idx, \
115 .event_spec = sx9500_events, \
116 .num_event_specs = ARRAY_SIZE(sx9500_events), \
117 .scan_index = idx, \
118 .scan_type = { \
119 .sign = 'u', \
120 .realbits = 16, \
121 .storagebits = 16, \
122 .shift = 0, \
123 }, \
124 }
125
126static const struct iio_chan_spec sx9500_channels[] = {
127 SX9500_CHANNEL(0),
128 SX9500_CHANNEL(1),
129 SX9500_CHANNEL(2),
130 SX9500_CHANNEL(3),
131 IIO_CHAN_SOFT_TIMESTAMP(4),
132};
133
134static const struct {
135 int val;
136 int val2;
137} sx9500_samp_freq_table[] = {
138 {33, 333333},
139 {16, 666666},
140 {11, 111111},
141 {8, 333333},
142 {6, 666666},
143 {5, 0},
144 {3, 333333},
145 {2, 500000},
146};
147
148static const unsigned int sx9500_scan_period_table[] = {
149 30, 60, 90, 120, 150, 200, 300, 400,
150};
151
152static const struct regmap_range sx9500_writable_reg_ranges[] = {
153 regmap_reg_range(SX9500_REG_IRQ_MSK, SX9500_REG_IRQ_MSK),
154 regmap_reg_range(SX9500_REG_PROX_CTRL0, SX9500_REG_PROX_CTRL8),
155 regmap_reg_range(SX9500_REG_SENSOR_SEL, SX9500_REG_SENSOR_SEL),
156 regmap_reg_range(SX9500_REG_OFFSET_MSB, SX9500_REG_OFFSET_LSB),
157 regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET),
158};
159
160static const struct regmap_access_table sx9500_writeable_regs = {
161 .yes_ranges = sx9500_writable_reg_ranges,
162 .n_yes_ranges = ARRAY_SIZE(sx9500_writable_reg_ranges),
163};
164
165
166
167
168
169static const struct regmap_range sx9500_non_readable_reg_ranges[] = {
170 regmap_reg_range(SX9500_REG_STAT + 1, SX9500_REG_STAT + 1),
171 regmap_reg_range(SX9500_REG_IRQ_MSK + 1, SX9500_REG_PROX_CTRL0 - 1),
172 regmap_reg_range(SX9500_REG_PROX_CTRL8 + 1, SX9500_REG_SENSOR_SEL - 1),
173 regmap_reg_range(SX9500_REG_OFFSET_LSB + 1, SX9500_REG_RESET - 1),
174};
175
176static const struct regmap_access_table sx9500_readable_regs = {
177 .no_ranges = sx9500_non_readable_reg_ranges,
178 .n_no_ranges = ARRAY_SIZE(sx9500_non_readable_reg_ranges),
179};
180
181static const struct regmap_range sx9500_volatile_reg_ranges[] = {
182 regmap_reg_range(SX9500_REG_IRQ_SRC, SX9500_REG_STAT),
183 regmap_reg_range(SX9500_REG_USE_MSB, SX9500_REG_OFFSET_LSB),
184 regmap_reg_range(SX9500_REG_RESET, SX9500_REG_RESET),
185};
186
187static const struct regmap_access_table sx9500_volatile_regs = {
188 .yes_ranges = sx9500_volatile_reg_ranges,
189 .n_yes_ranges = ARRAY_SIZE(sx9500_volatile_reg_ranges),
190};
191
192static const struct regmap_config sx9500_regmap_config = {
193 .reg_bits = 8,
194 .val_bits = 8,
195
196 .max_register = SX9500_REG_RESET,
197 .cache_type = REGCACHE_RBTREE,
198
199 .wr_table = &sx9500_writeable_regs,
200 .rd_table = &sx9500_readable_regs,
201 .volatile_table = &sx9500_volatile_regs,
202};
203
204static int sx9500_inc_users(struct sx9500_data *data, int *counter,
205 unsigned int reg, unsigned int bitmask)
206{
207 (*counter)++;
208 if (*counter != 1)
209
210 return 0;
211
212 return regmap_update_bits(data->regmap, reg, bitmask, bitmask);
213}
214
215static int sx9500_dec_users(struct sx9500_data *data, int *counter,
216 unsigned int reg, unsigned int bitmask)
217{
218 (*counter)--;
219 if (*counter != 0)
220
221 return 0;
222
223 return regmap_update_bits(data->regmap, reg, bitmask, 0);
224}
225
226static int sx9500_inc_chan_users(struct sx9500_data *data, int chan)
227{
228 return sx9500_inc_users(data, &data->channel_users[chan],
229 SX9500_REG_PROX_CTRL0, BIT(chan));
230}
231
232static int sx9500_dec_chan_users(struct sx9500_data *data, int chan)
233{
234 return sx9500_dec_users(data, &data->channel_users[chan],
235 SX9500_REG_PROX_CTRL0, BIT(chan));
236}
237
238static int sx9500_inc_data_rdy_users(struct sx9500_data *data)
239{
240 return sx9500_inc_users(data, &data->data_rdy_users,
241 SX9500_REG_IRQ_MSK, SX9500_CONVDONE_IRQ);
242}
243
244static int sx9500_dec_data_rdy_users(struct sx9500_data *data)
245{
246 return sx9500_dec_users(data, &data->data_rdy_users,
247 SX9500_REG_IRQ_MSK, SX9500_CONVDONE_IRQ);
248}
249
250static int sx9500_inc_close_far_users(struct sx9500_data *data)
251{
252 return sx9500_inc_users(data, &data->close_far_users,
253 SX9500_REG_IRQ_MSK,
254 SX9500_CLOSE_IRQ | SX9500_FAR_IRQ);
255}
256
257static int sx9500_dec_close_far_users(struct sx9500_data *data)
258{
259 return sx9500_dec_users(data, &data->close_far_users,
260 SX9500_REG_IRQ_MSK,
261 SX9500_CLOSE_IRQ | SX9500_FAR_IRQ);
262}
263
264static int sx9500_read_prox_data(struct sx9500_data *data,
265 const struct iio_chan_spec *chan,
266 int *val)
267{
268 int ret;
269 __be16 regval;
270
271 ret = regmap_write(data->regmap, SX9500_REG_SENSOR_SEL, chan->channel);
272 if (ret < 0)
273 return ret;
274
275 ret = regmap_bulk_read(data->regmap, SX9500_REG_USE_MSB, ®val, 2);
276 if (ret < 0)
277 return ret;
278
279 *val = be16_to_cpu(regval);
280
281 return IIO_VAL_INT;
282}
283
284
285
286
287
288static int sx9500_wait_for_sample(struct sx9500_data *data)
289{
290 int ret;
291 unsigned int val;
292
293 ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, &val);
294 if (ret < 0)
295 return ret;
296
297 val = (val & SX9500_SCAN_PERIOD_MASK) >> SX9500_SCAN_PERIOD_SHIFT;
298
299 msleep(sx9500_scan_period_table[val]);
300
301 return 0;
302}
303
304static int sx9500_read_proximity(struct sx9500_data *data,
305 const struct iio_chan_spec *chan,
306 int *val)
307{
308 int ret;
309
310 mutex_lock(&data->mutex);
311
312 ret = sx9500_inc_chan_users(data, chan->channel);
313 if (ret < 0)
314 goto out;
315
316 ret = sx9500_inc_data_rdy_users(data);
317 if (ret < 0)
318 goto out_dec_chan;
319
320 mutex_unlock(&data->mutex);
321
322 if (data->client->irq > 0)
323 ret = wait_for_completion_interruptible(&data->completion);
324 else
325 ret = sx9500_wait_for_sample(data);
326
327 mutex_lock(&data->mutex);
328
329 if (ret < 0)
330 goto out_dec_data_rdy;
331
332 ret = sx9500_read_prox_data(data, chan, val);
333 if (ret < 0)
334 goto out_dec_data_rdy;
335
336 ret = sx9500_dec_data_rdy_users(data);
337 if (ret < 0)
338 goto out_dec_chan;
339
340 ret = sx9500_dec_chan_users(data, chan->channel);
341 if (ret < 0)
342 goto out;
343
344 ret = IIO_VAL_INT;
345
346 goto out;
347
348out_dec_data_rdy:
349 sx9500_dec_data_rdy_users(data);
350out_dec_chan:
351 sx9500_dec_chan_users(data, chan->channel);
352out:
353 mutex_unlock(&data->mutex);
354 reinit_completion(&data->completion);
355
356 return ret;
357}
358
359static int sx9500_read_samp_freq(struct sx9500_data *data,
360 int *val, int *val2)
361{
362 int ret;
363 unsigned int regval;
364
365 mutex_lock(&data->mutex);
366 ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0, ®val);
367 mutex_unlock(&data->mutex);
368
369 if (ret < 0)
370 return ret;
371
372 regval = (regval & SX9500_SCAN_PERIOD_MASK) >> SX9500_SCAN_PERIOD_SHIFT;
373 *val = sx9500_samp_freq_table[regval].val;
374 *val2 = sx9500_samp_freq_table[regval].val2;
375
376 return IIO_VAL_INT_PLUS_MICRO;
377}
378
379static int sx9500_read_raw(struct iio_dev *indio_dev,
380 const struct iio_chan_spec *chan,
381 int *val, int *val2, long mask)
382{
383 struct sx9500_data *data = iio_priv(indio_dev);
384 int ret;
385
386 switch (chan->type) {
387 case IIO_PROXIMITY:
388 switch (mask) {
389 case IIO_CHAN_INFO_RAW:
390 ret = iio_device_claim_direct_mode(indio_dev);
391 if (ret)
392 return ret;
393 ret = sx9500_read_proximity(data, chan, val);
394 iio_device_release_direct_mode(indio_dev);
395 return ret;
396 case IIO_CHAN_INFO_SAMP_FREQ:
397 return sx9500_read_samp_freq(data, val, val2);
398 default:
399 return -EINVAL;
400 }
401 default:
402 return -EINVAL;
403 }
404}
405
406static int sx9500_set_samp_freq(struct sx9500_data *data,
407 int val, int val2)
408{
409 int i, ret;
410
411 for (i = 0; i < ARRAY_SIZE(sx9500_samp_freq_table); i++)
412 if (val == sx9500_samp_freq_table[i].val &&
413 val2 == sx9500_samp_freq_table[i].val2)
414 break;
415
416 if (i == ARRAY_SIZE(sx9500_samp_freq_table))
417 return -EINVAL;
418
419 mutex_lock(&data->mutex);
420
421 ret = regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0,
422 SX9500_SCAN_PERIOD_MASK,
423 i << SX9500_SCAN_PERIOD_SHIFT);
424
425 mutex_unlock(&data->mutex);
426
427 return ret;
428}
429
430static int sx9500_write_raw(struct iio_dev *indio_dev,
431 const struct iio_chan_spec *chan,
432 int val, int val2, long mask)
433{
434 struct sx9500_data *data = iio_priv(indio_dev);
435
436 switch (chan->type) {
437 case IIO_PROXIMITY:
438 switch (mask) {
439 case IIO_CHAN_INFO_SAMP_FREQ:
440 return sx9500_set_samp_freq(data, val, val2);
441 default:
442 return -EINVAL;
443 }
444 default:
445 return -EINVAL;
446 }
447}
448
449static irqreturn_t sx9500_irq_handler(int irq, void *private)
450{
451 struct iio_dev *indio_dev = private;
452 struct sx9500_data *data = iio_priv(indio_dev);
453
454 if (data->trigger_enabled)
455 iio_trigger_poll(data->trig);
456
457
458
459
460
461
462
463 return IRQ_WAKE_THREAD;
464}
465
466static void sx9500_push_events(struct iio_dev *indio_dev)
467{
468 int ret;
469 unsigned int val, chan;
470 struct sx9500_data *data = iio_priv(indio_dev);
471
472 ret = regmap_read(data->regmap, SX9500_REG_STAT, &val);
473 if (ret < 0) {
474 dev_err(&data->client->dev, "i2c transfer error in irq\n");
475 return;
476 }
477
478 val >>= SX9500_PROXSTAT_SHIFT;
479 for (chan = 0; chan < SX9500_NUM_CHANNELS; chan++) {
480 int dir;
481 u64 ev;
482 bool new_prox = val & BIT(chan);
483
484 if (!data->event_enabled[chan])
485 continue;
486 if (new_prox == data->prox_stat[chan])
487
488 continue;
489
490 dir = new_prox ? IIO_EV_DIR_FALLING : IIO_EV_DIR_RISING;
491 ev = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, chan,
492 IIO_EV_TYPE_THRESH, dir);
493 iio_push_event(indio_dev, ev, iio_get_time_ns(indio_dev));
494 data->prox_stat[chan] = new_prox;
495 }
496}
497
498static irqreturn_t sx9500_irq_thread_handler(int irq, void *private)
499{
500 struct iio_dev *indio_dev = private;
501 struct sx9500_data *data = iio_priv(indio_dev);
502 int ret;
503 unsigned int val;
504
505 mutex_lock(&data->mutex);
506
507 ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val);
508 if (ret < 0) {
509 dev_err(&data->client->dev, "i2c transfer error in irq\n");
510 goto out;
511 }
512
513 if (val & (SX9500_CLOSE_IRQ | SX9500_FAR_IRQ))
514 sx9500_push_events(indio_dev);
515
516 if (val & SX9500_CONVDONE_IRQ)
517 complete(&data->completion);
518
519out:
520 mutex_unlock(&data->mutex);
521
522 return IRQ_HANDLED;
523}
524
525static int sx9500_read_event_config(struct iio_dev *indio_dev,
526 const struct iio_chan_spec *chan,
527 enum iio_event_type type,
528 enum iio_event_direction dir)
529{
530 struct sx9500_data *data = iio_priv(indio_dev);
531
532 if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH ||
533 dir != IIO_EV_DIR_EITHER)
534 return -EINVAL;
535
536 return data->event_enabled[chan->channel];
537}
538
539static int sx9500_write_event_config(struct iio_dev *indio_dev,
540 const struct iio_chan_spec *chan,
541 enum iio_event_type type,
542 enum iio_event_direction dir,
543 int state)
544{
545 struct sx9500_data *data = iio_priv(indio_dev);
546 int ret;
547
548 if (chan->type != IIO_PROXIMITY || type != IIO_EV_TYPE_THRESH ||
549 dir != IIO_EV_DIR_EITHER)
550 return -EINVAL;
551
552 mutex_lock(&data->mutex);
553
554 if (state == 1) {
555 ret = sx9500_inc_chan_users(data, chan->channel);
556 if (ret < 0)
557 goto out_unlock;
558 ret = sx9500_inc_close_far_users(data);
559 if (ret < 0)
560 goto out_undo_chan;
561 } else {
562 ret = sx9500_dec_chan_users(data, chan->channel);
563 if (ret < 0)
564 goto out_unlock;
565 ret = sx9500_dec_close_far_users(data);
566 if (ret < 0)
567 goto out_undo_chan;
568 }
569
570 data->event_enabled[chan->channel] = state;
571 goto out_unlock;
572
573out_undo_chan:
574 if (state == 1)
575 sx9500_dec_chan_users(data, chan->channel);
576 else
577 sx9500_inc_chan_users(data, chan->channel);
578out_unlock:
579 mutex_unlock(&data->mutex);
580 return ret;
581}
582
583static int sx9500_update_scan_mode(struct iio_dev *indio_dev,
584 const unsigned long *scan_mask)
585{
586 struct sx9500_data *data = iio_priv(indio_dev);
587
588 mutex_lock(&data->mutex);
589 kfree(data->buffer);
590 data->buffer = kzalloc(indio_dev->scan_bytes, GFP_KERNEL);
591 mutex_unlock(&data->mutex);
592
593 if (data->buffer == NULL)
594 return -ENOMEM;
595
596 return 0;
597}
598
599static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
600 "2.500000 3.333333 5 6.666666 8.333333 11.111111 16.666666 33.333333");
601
602static struct attribute *sx9500_attributes[] = {
603 &iio_const_attr_sampling_frequency_available.dev_attr.attr,
604 NULL,
605};
606
607static const struct attribute_group sx9500_attribute_group = {
608 .attrs = sx9500_attributes,
609};
610
611static const struct iio_info sx9500_info = {
612 .attrs = &sx9500_attribute_group,
613 .read_raw = &sx9500_read_raw,
614 .write_raw = &sx9500_write_raw,
615 .read_event_config = &sx9500_read_event_config,
616 .write_event_config = &sx9500_write_event_config,
617 .update_scan_mode = &sx9500_update_scan_mode,
618};
619
620static int sx9500_set_trigger_state(struct iio_trigger *trig,
621 bool state)
622{
623 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
624 struct sx9500_data *data = iio_priv(indio_dev);
625 int ret;
626
627 mutex_lock(&data->mutex);
628
629 if (state)
630 ret = sx9500_inc_data_rdy_users(data);
631 else
632 ret = sx9500_dec_data_rdy_users(data);
633 if (ret < 0)
634 goto out;
635
636 data->trigger_enabled = state;
637
638out:
639 mutex_unlock(&data->mutex);
640
641 return ret;
642}
643
644static const struct iio_trigger_ops sx9500_trigger_ops = {
645 .set_trigger_state = sx9500_set_trigger_state,
646};
647
648static irqreturn_t sx9500_trigger_handler(int irq, void *private)
649{
650 struct iio_poll_func *pf = private;
651 struct iio_dev *indio_dev = pf->indio_dev;
652 struct sx9500_data *data = iio_priv(indio_dev);
653 int val, bit, ret, i = 0;
654
655 mutex_lock(&data->mutex);
656
657 for_each_set_bit(bit, indio_dev->active_scan_mask,
658 indio_dev->masklength) {
659 ret = sx9500_read_prox_data(data, &indio_dev->channels[bit],
660 &val);
661 if (ret < 0)
662 goto out;
663
664 data->buffer[i++] = val;
665 }
666
667 iio_push_to_buffers_with_timestamp(indio_dev, data->buffer,
668 iio_get_time_ns(indio_dev));
669
670out:
671 mutex_unlock(&data->mutex);
672
673 iio_trigger_notify_done(indio_dev->trig);
674
675 return IRQ_HANDLED;
676}
677
678static int sx9500_buffer_postenable(struct iio_dev *indio_dev)
679{
680 struct sx9500_data *data = iio_priv(indio_dev);
681 int ret = 0, i;
682
683 mutex_lock(&data->mutex);
684
685 for (i = 0; i < SX9500_NUM_CHANNELS; i++)
686 if (test_bit(i, indio_dev->active_scan_mask)) {
687 ret = sx9500_inc_chan_users(data, i);
688 if (ret)
689 break;
690 }
691
692 if (ret)
693 for (i = i - 1; i >= 0; i--)
694 if (test_bit(i, indio_dev->active_scan_mask))
695 sx9500_dec_chan_users(data, i);
696
697 mutex_unlock(&data->mutex);
698
699 return ret;
700}
701
702static int sx9500_buffer_predisable(struct iio_dev *indio_dev)
703{
704 struct sx9500_data *data = iio_priv(indio_dev);
705 int ret = 0, i;
706
707 mutex_lock(&data->mutex);
708
709 for (i = 0; i < SX9500_NUM_CHANNELS; i++)
710 if (test_bit(i, indio_dev->active_scan_mask)) {
711 ret = sx9500_dec_chan_users(data, i);
712 if (ret)
713 break;
714 }
715
716 if (ret)
717 for (i = i - 1; i >= 0; i--)
718 if (test_bit(i, indio_dev->active_scan_mask))
719 sx9500_inc_chan_users(data, i);
720
721 mutex_unlock(&data->mutex);
722
723 return ret;
724}
725
726static const struct iio_buffer_setup_ops sx9500_buffer_setup_ops = {
727 .postenable = sx9500_buffer_postenable,
728 .predisable = sx9500_buffer_predisable,
729};
730
731struct sx9500_reg_default {
732 u8 reg;
733 u8 def;
734};
735
736static const struct sx9500_reg_default sx9500_default_regs[] = {
737 {
738 .reg = SX9500_REG_PROX_CTRL1,
739
740 .def = 0x43,
741 },
742 {
743 .reg = SX9500_REG_PROX_CTRL2,
744
745 .def = 0x77,
746 },
747 {
748 .reg = SX9500_REG_PROX_CTRL3,
749
750 .def = 0x40,
751 },
752 {
753 .reg = SX9500_REG_PROX_CTRL4,
754
755 .def = 0x30,
756 },
757 {
758 .reg = SX9500_REG_PROX_CTRL5,
759
760
761
762
763 .def = 0x0f,
764 },
765 {
766 .reg = SX9500_REG_PROX_CTRL6,
767
768 .def = 0x0e,
769 },
770 {
771 .reg = SX9500_REG_PROX_CTRL7,
772
773
774
775
776
777 .def = 0x00,
778 },
779 {
780 .reg = SX9500_REG_PROX_CTRL8,
781
782 .def = 0x00,
783 },
784 {
785 .reg = SX9500_REG_PROX_CTRL0,
786
787 .def = 0x00,
788 },
789};
790
791
792static int sx9500_init_compensation(struct iio_dev *indio_dev)
793{
794 struct sx9500_data *data = iio_priv(indio_dev);
795 int i, ret;
796 unsigned int val;
797
798 ret = regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0,
799 SX9500_CHAN_MASK, SX9500_CHAN_MASK);
800 if (ret < 0)
801 return ret;
802
803 for (i = 10; i >= 0; i--) {
804 usleep_range(10000, 20000);
805 ret = regmap_read(data->regmap, SX9500_REG_STAT, &val);
806 if (ret < 0)
807 goto out;
808 if (!(val & SX9500_COMPSTAT_MASK))
809 break;
810 }
811
812 if (i < 0) {
813 dev_err(&data->client->dev, "initial compensation timed out");
814 ret = -ETIMEDOUT;
815 }
816
817out:
818 regmap_update_bits(data->regmap, SX9500_REG_PROX_CTRL0,
819 SX9500_CHAN_MASK, 0);
820 return ret;
821}
822
823static int sx9500_init_device(struct iio_dev *indio_dev)
824{
825 struct sx9500_data *data = iio_priv(indio_dev);
826 int ret, i;
827 unsigned int val;
828
829 if (data->gpiod_rst) {
830 gpiod_set_value_cansleep(data->gpiod_rst, 0);
831 usleep_range(1000, 2000);
832 gpiod_set_value_cansleep(data->gpiod_rst, 1);
833 usleep_range(1000, 2000);
834 }
835
836 ret = regmap_write(data->regmap, SX9500_REG_IRQ_MSK, 0);
837 if (ret < 0)
838 return ret;
839
840 ret = regmap_write(data->regmap, SX9500_REG_RESET,
841 SX9500_SOFT_RESET);
842 if (ret < 0)
843 return ret;
844
845 ret = regmap_read(data->regmap, SX9500_REG_IRQ_SRC, &val);
846 if (ret < 0)
847 return ret;
848
849 for (i = 0; i < ARRAY_SIZE(sx9500_default_regs); i++) {
850 ret = regmap_write(data->regmap,
851 sx9500_default_regs[i].reg,
852 sx9500_default_regs[i].def);
853 if (ret < 0)
854 return ret;
855 }
856
857 return sx9500_init_compensation(indio_dev);
858}
859
860static const struct acpi_gpio_params reset_gpios = { 0, 0, false };
861static const struct acpi_gpio_params interrupt_gpios = { 2, 0, false };
862
863static const struct acpi_gpio_mapping acpi_sx9500_gpios[] = {
864 { "reset-gpios", &reset_gpios, 1 },
865
866
867
868
869 { "interrupt-gpios", &interrupt_gpios, 1, ACPI_GPIO_QUIRK_NO_IO_RESTRICTION },
870 { },
871};
872
873static void sx9500_gpio_probe(struct i2c_client *client,
874 struct sx9500_data *data)
875{
876 struct gpio_desc *gpiod_int;
877 struct device *dev;
878 int ret;
879
880 if (!client)
881 return;
882
883 dev = &client->dev;
884
885 ret = devm_acpi_dev_add_driver_gpios(dev, acpi_sx9500_gpios);
886 if (ret)
887 dev_dbg(dev, "Unable to add GPIO mapping table\n");
888
889 if (client->irq <= 0) {
890 gpiod_int = devm_gpiod_get(dev, "interrupt", GPIOD_IN);
891 if (IS_ERR(gpiod_int))
892 dev_err(dev, "gpio get irq failed\n");
893 else
894 client->irq = gpiod_to_irq(gpiod_int);
895 }
896
897 data->gpiod_rst = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
898 if (IS_ERR(data->gpiod_rst)) {
899 dev_warn(dev, "gpio get reset pin failed\n");
900 data->gpiod_rst = NULL;
901 }
902}
903
904static int sx9500_probe(struct i2c_client *client,
905 const struct i2c_device_id *id)
906{
907 int ret;
908 struct iio_dev *indio_dev;
909 struct sx9500_data *data;
910
911 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
912 if (indio_dev == NULL)
913 return -ENOMEM;
914
915 data = iio_priv(indio_dev);
916 data->client = client;
917 mutex_init(&data->mutex);
918 init_completion(&data->completion);
919 data->trigger_enabled = false;
920
921 data->regmap = devm_regmap_init_i2c(client, &sx9500_regmap_config);
922 if (IS_ERR(data->regmap))
923 return PTR_ERR(data->regmap);
924
925 indio_dev->name = SX9500_DRIVER_NAME;
926 indio_dev->channels = sx9500_channels;
927 indio_dev->num_channels = ARRAY_SIZE(sx9500_channels);
928 indio_dev->info = &sx9500_info;
929 indio_dev->modes = INDIO_DIRECT_MODE;
930 i2c_set_clientdata(client, indio_dev);
931
932 sx9500_gpio_probe(client, data);
933
934 ret = sx9500_init_device(indio_dev);
935 if (ret < 0)
936 return ret;
937
938 if (client->irq <= 0)
939 dev_warn(&client->dev, "no valid irq found\n");
940 else {
941 ret = devm_request_threaded_irq(&client->dev, client->irq,
942 sx9500_irq_handler, sx9500_irq_thread_handler,
943 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
944 SX9500_IRQ_NAME, indio_dev);
945 if (ret < 0)
946 return ret;
947
948 data->trig = devm_iio_trigger_alloc(&client->dev,
949 "%s-dev%d", indio_dev->name, iio_device_id(indio_dev));
950 if (!data->trig)
951 return -ENOMEM;
952
953 data->trig->ops = &sx9500_trigger_ops;
954 iio_trigger_set_drvdata(data->trig, indio_dev);
955
956 ret = iio_trigger_register(data->trig);
957 if (ret)
958 return ret;
959 }
960
961 ret = iio_triggered_buffer_setup(indio_dev, NULL,
962 sx9500_trigger_handler,
963 &sx9500_buffer_setup_ops);
964 if (ret < 0)
965 goto out_trigger_unregister;
966
967 ret = iio_device_register(indio_dev);
968 if (ret < 0)
969 goto out_buffer_cleanup;
970
971 return 0;
972
973out_buffer_cleanup:
974 iio_triggered_buffer_cleanup(indio_dev);
975out_trigger_unregister:
976 if (client->irq > 0)
977 iio_trigger_unregister(data->trig);
978
979 return ret;
980}
981
982static int sx9500_remove(struct i2c_client *client)
983{
984 struct iio_dev *indio_dev = i2c_get_clientdata(client);
985 struct sx9500_data *data = iio_priv(indio_dev);
986
987 iio_device_unregister(indio_dev);
988 iio_triggered_buffer_cleanup(indio_dev);
989 if (client->irq > 0)
990 iio_trigger_unregister(data->trig);
991 kfree(data->buffer);
992
993 return 0;
994}
995
996#ifdef CONFIG_PM_SLEEP
997static int sx9500_suspend(struct device *dev)
998{
999 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1000 struct sx9500_data *data = iio_priv(indio_dev);
1001 int ret;
1002
1003 mutex_lock(&data->mutex);
1004 ret = regmap_read(data->regmap, SX9500_REG_PROX_CTRL0,
1005 &data->suspend_ctrl0);
1006 if (ret < 0)
1007 goto out;
1008
1009
1010
1011
1012
1013 ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0, 0);
1014
1015out:
1016 mutex_unlock(&data->mutex);
1017 return ret;
1018}
1019
1020static int sx9500_resume(struct device *dev)
1021{
1022 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1023 struct sx9500_data *data = iio_priv(indio_dev);
1024 int ret;
1025
1026 mutex_lock(&data->mutex);
1027 ret = regmap_write(data->regmap, SX9500_REG_PROX_CTRL0,
1028 data->suspend_ctrl0);
1029 mutex_unlock(&data->mutex);
1030
1031 return ret;
1032}
1033#endif
1034
1035static const struct dev_pm_ops sx9500_pm_ops = {
1036 SET_SYSTEM_SLEEP_PM_OPS(sx9500_suspend, sx9500_resume)
1037};
1038
1039static const struct acpi_device_id sx9500_acpi_match[] = {
1040 {"SSX9500", 0},
1041 {"SASX9500", 0},
1042 { },
1043};
1044MODULE_DEVICE_TABLE(acpi, sx9500_acpi_match);
1045
1046static const struct of_device_id sx9500_of_match[] = {
1047 { .compatible = "semtech,sx9500", },
1048 { }
1049};
1050MODULE_DEVICE_TABLE(of, sx9500_of_match);
1051
1052static const struct i2c_device_id sx9500_id[] = {
1053 {"sx9500", 0},
1054 { },
1055};
1056MODULE_DEVICE_TABLE(i2c, sx9500_id);
1057
1058static struct i2c_driver sx9500_driver = {
1059 .driver = {
1060 .name = SX9500_DRIVER_NAME,
1061 .acpi_match_table = ACPI_PTR(sx9500_acpi_match),
1062 .of_match_table = of_match_ptr(sx9500_of_match),
1063 .pm = &sx9500_pm_ops,
1064 },
1065 .probe = sx9500_probe,
1066 .remove = sx9500_remove,
1067 .id_table = sx9500_id,
1068};
1069module_i2c_driver(sx9500_driver);
1070
1071MODULE_AUTHOR("Vlad Dogaru <vlad.dogaru@intel.com>");
1072MODULE_DESCRIPTION("Driver for Semtech SX9500 proximity sensor");
1073MODULE_LICENSE("GPL v2");
1074