xref: /openbmc/linux/drivers/iio/adc/ti-tsc2046.c (revision 349f631d)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Texas Instruments TSC2046 SPI ADC driver
4  *
5  * Copyright (c) 2021 Oleksij Rempel <kernel@pengutronix.de>, Pengutronix
6  */
7 
8 #include <linux/bitfield.h>
9 #include <linux/delay.h>
10 #include <linux/module.h>
11 #include <linux/spi/spi.h>
12 
13 #include <asm/unaligned.h>
14 
15 #include <linux/iio/buffer.h>
16 #include <linux/iio/trigger_consumer.h>
17 #include <linux/iio/triggered_buffer.h>
18 #include <linux/iio/trigger.h>
19 
20 /*
21  * The PENIRQ of TSC2046 controller is implemented as level shifter attached to
22  * the X+ line. If voltage of the X+ line reaches a specific level the IRQ will
23  * be activated or deactivated.
24  * To make this kind of IRQ reusable as trigger following additions were
25  * implemented:
26  * - rate limiting:
27  *   For typical touchscreen use case, we need to trigger about each 10ms.
28  * - hrtimer:
29  *   Continue triggering at least once after the IRQ was deactivated. Then
30  *   deactivate this trigger to stop sampling in order to reduce power
31  *   consumption.
32  */
33 
34 #define TI_TSC2046_NAME				"tsc2046"
35 
36 /* This driver doesn't aim at the peak continuous sample rate */
37 #define	TI_TSC2046_MAX_SAMPLE_RATE		125000
38 #define	TI_TSC2046_SAMPLE_BITS \
39 	BITS_PER_TYPE(struct tsc2046_adc_atom)
40 #define	TI_TSC2046_MAX_CLK_FREQ \
41 	(TI_TSC2046_MAX_SAMPLE_RATE * TI_TSC2046_SAMPLE_BITS)
42 
43 #define TI_TSC2046_SAMPLE_INTERVAL_US		10000
44 
45 #define TI_TSC2046_START			BIT(7)
46 #define TI_TSC2046_ADDR				GENMASK(6, 4)
47 #define TI_TSC2046_ADDR_TEMP1			7
48 #define TI_TSC2046_ADDR_AUX			6
49 #define TI_TSC2046_ADDR_X			5
50 #define TI_TSC2046_ADDR_Z2			4
51 #define TI_TSC2046_ADDR_Z1			3
52 #define TI_TSC2046_ADDR_VBAT			2
53 #define TI_TSC2046_ADDR_Y			1
54 #define TI_TSC2046_ADDR_TEMP0			0
55 
56 /*
57  * The mode bit sets the resolution of the ADC. With this bit low, the next
58  * conversion has 12-bit resolution, whereas with this bit high, the next
59  * conversion has 8-bit resolution. This driver is optimized for 12-bit mode.
60  * So, for this driver, this bit should stay zero.
61  */
62 #define TI_TSC2046_8BIT_MODE			BIT(3)
63 
64 /*
65  * SER/DFR - The SER/DFR bit controls the reference mode, either single-ended
66  * (high) or differential (low).
67  */
68 #define TI_TSC2046_SER				BIT(2)
69 
70 /*
71  * If VREF_ON and ADC_ON are both zero, then the chip operates in
72  * auto-wake/suspend mode. In most case this bits should stay zero.
73  */
74 #define TI_TSC2046_PD1_VREF_ON			BIT(1)
75 #define TI_TSC2046_PD0_ADC_ON			BIT(0)
76 
77 /*
78  * All supported devices can do 8 or 12bit resolution. This driver
79  * supports only 12bit mode, here we have a 16bit data transfer, where
80  * the MSB and the 3 LSB are 0.
81  */
82 #define TI_TSC2046_DATA_12BIT			GENMASK(14, 3)
83 
84 #define TI_TSC2046_MAX_CHAN			8
85 
86 /* Represents a HW sample */
87 struct tsc2046_adc_atom {
88 	/*
89 	 * Command transmitted to the controller. This field is empty on the RX
90 	 * buffer.
91 	 */
92 	u8 cmd;
93 	/*
94 	 * Data received from the controller. This field is empty for the TX
95 	 * buffer
96 	 */
97 	__be16 data;
98 } __packed;
99 
100 /* Layout of atomic buffers within big buffer */
101 struct tsc2046_adc_group_layout {
102 	/* Group offset within the SPI RX buffer */
103 	unsigned int offset;
104 	/*
105 	 * Amount of tsc2046_adc_atom structs within the same command gathered
106 	 * within same group.
107 	 */
108 	unsigned int count;
109 	/*
110 	 * Settling samples (tsc2046_adc_atom structs) which should be skipped
111 	 * before good samples will start.
112 	 */
113 	unsigned int skip;
114 };
115 
116 struct tsc2046_adc_dcfg {
117 	const struct iio_chan_spec *channels;
118 	unsigned int num_channels;
119 };
120 
121 struct tsc2046_adc_ch_cfg {
122 	unsigned int settling_time_us;
123 	unsigned int oversampling_ratio;
124 };
125 
126 struct tsc2046_adc_priv {
127 	struct spi_device *spi;
128 	const struct tsc2046_adc_dcfg *dcfg;
129 
130 	struct iio_trigger *trig;
131 	struct hrtimer trig_timer;
132 	spinlock_t trig_lock;
133 	unsigned int trig_more_count;
134 
135 	struct spi_transfer xfer;
136 	struct spi_message msg;
137 
138 	struct {
139 		/* Scan data for each channel */
140 		u16 data[TI_TSC2046_MAX_CHAN];
141 		/* Timestamp */
142 		s64 ts __aligned(8);
143 	} scan_buf;
144 
145 	/*
146 	 * Lock to protect the layout and the SPI transfer buffer.
147 	 * tsc2046_adc_group_layout can be changed within update_scan_mode(),
148 	 * in this case the l[] and tx/rx buffer will be out of sync to each
149 	 * other.
150 	 */
151 	struct mutex slock;
152 	struct tsc2046_adc_group_layout l[TI_TSC2046_MAX_CHAN];
153 	struct tsc2046_adc_atom *rx;
154 	struct tsc2046_adc_atom *tx;
155 
156 	struct tsc2046_adc_atom *rx_one;
157 	struct tsc2046_adc_atom *tx_one;
158 
159 	unsigned int count;
160 	unsigned int groups;
161 	u32 effective_speed_hz;
162 	u32 scan_interval_us;
163 	u32 time_per_scan_us;
164 	u32 time_per_bit_ns;
165 
166 	struct tsc2046_adc_ch_cfg ch_cfg[TI_TSC2046_MAX_CHAN];
167 };
168 
169 #define TI_TSC2046_V_CHAN(index, bits, name)			\
170 {								\
171 	.type = IIO_VOLTAGE,					\
172 	.indexed = 1,						\
173 	.channel = index,					\
174 	.datasheet_name = "#name",				\
175 	.scan_index = index,					\
176 	.scan_type = {						\
177 		.sign = 'u',					\
178 		.realbits = bits,				\
179 		.storagebits = 16,				\
180 		.endianness = IIO_CPU,				\
181 	},							\
182 }
183 
184 #define DECLARE_TI_TSC2046_8_CHANNELS(name, bits) \
185 const struct iio_chan_spec name ## _channels[] = { \
186 	TI_TSC2046_V_CHAN(0, bits, TEMP0), \
187 	TI_TSC2046_V_CHAN(1, bits, Y), \
188 	TI_TSC2046_V_CHAN(2, bits, VBAT), \
189 	TI_TSC2046_V_CHAN(3, bits, Z1), \
190 	TI_TSC2046_V_CHAN(4, bits, Z2), \
191 	TI_TSC2046_V_CHAN(5, bits, X), \
192 	TI_TSC2046_V_CHAN(6, bits, AUX), \
193 	TI_TSC2046_V_CHAN(7, bits, TEMP1), \
194 	IIO_CHAN_SOFT_TIMESTAMP(8), \
195 }
196 
197 static DECLARE_TI_TSC2046_8_CHANNELS(tsc2046_adc, 12);
198 
199 static const struct tsc2046_adc_dcfg tsc2046_adc_dcfg_tsc2046e = {
200 	.channels = tsc2046_adc_channels,
201 	.num_channels = ARRAY_SIZE(tsc2046_adc_channels),
202 };
203 
204 /*
205  * Convert time to a number of samples which can be transferred within this
206  * time.
207  */
208 static unsigned int tsc2046_adc_time_to_count(struct tsc2046_adc_priv *priv,
209 					      unsigned long time)
210 {
211 	unsigned int bit_count, sample_count;
212 
213 	bit_count = DIV_ROUND_UP(time * NSEC_PER_USEC, priv->time_per_bit_ns);
214 	sample_count = DIV_ROUND_UP(bit_count, TI_TSC2046_SAMPLE_BITS);
215 
216 	dev_dbg(&priv->spi->dev, "Effective speed %u, time per bit: %u, count bits: %u, count samples: %u\n",
217 		priv->effective_speed_hz, priv->time_per_bit_ns,
218 		bit_count, sample_count);
219 
220 	return sample_count;
221 }
222 
223 static u8 tsc2046_adc_get_cmd(struct tsc2046_adc_priv *priv, int ch_idx,
224 			      bool keep_power)
225 {
226 	u32 pd;
227 
228 	/*
229 	 * if PD bits are 0, controller will automatically disable ADC, VREF and
230 	 * enable IRQ.
231 	 */
232 	if (keep_power)
233 		pd = TI_TSC2046_PD0_ADC_ON;
234 	else
235 		pd = 0;
236 
237 	return TI_TSC2046_START | FIELD_PREP(TI_TSC2046_ADDR, ch_idx) | pd;
238 }
239 
240 static u16 tsc2046_adc_get_value(struct tsc2046_adc_atom *buf)
241 {
242 	return FIELD_GET(TI_TSC2046_DATA_12BIT, get_unaligned_be16(&buf->data));
243 }
244 
245 static int tsc2046_adc_read_one(struct tsc2046_adc_priv *priv, int ch_idx,
246 				u32 *effective_speed_hz)
247 {
248 	struct spi_transfer xfer;
249 	struct spi_message msg;
250 	int ret;
251 
252 	memset(&xfer, 0, sizeof(xfer));
253 	priv->tx_one->cmd = tsc2046_adc_get_cmd(priv, ch_idx, false);
254 	priv->tx_one->data = 0;
255 	xfer.tx_buf = priv->tx_one;
256 	xfer.rx_buf = priv->rx_one;
257 	xfer.len = sizeof(*priv->tx_one);
258 	spi_message_init_with_transfers(&msg, &xfer, 1);
259 
260 	/*
261 	 * We aren't using spi_write_then_read() because we need to be able
262 	 * to get hold of the effective_speed_hz from the xfer
263 	 */
264 	ret = spi_sync(priv->spi, &msg);
265 	if (ret) {
266 		dev_err_ratelimited(&priv->spi->dev, "SPI transfer failed %pe\n",
267 				    ERR_PTR(ret));
268 		return ret;
269 	}
270 
271 	if (effective_speed_hz)
272 		*effective_speed_hz = xfer.effective_speed_hz;
273 
274 	return tsc2046_adc_get_value(priv->rx_one);
275 }
276 
277 static size_t tsc2046_adc_group_set_layout(struct tsc2046_adc_priv *priv,
278 					   unsigned int group,
279 					   unsigned int ch_idx)
280 {
281 	struct tsc2046_adc_ch_cfg *ch = &priv->ch_cfg[ch_idx];
282 	struct tsc2046_adc_group_layout *cur;
283 	unsigned int max_count, count_skip;
284 	unsigned int offset = 0;
285 
286 	if (group)
287 		offset = priv->l[group - 1].offset + priv->l[group - 1].count;
288 
289 	count_skip = tsc2046_adc_time_to_count(priv, ch->settling_time_us);
290 	max_count = count_skip + ch->oversampling_ratio;
291 
292 	cur = &priv->l[group];
293 	cur->offset = offset;
294 	cur->count = max_count;
295 	cur->skip = count_skip;
296 
297 	return sizeof(*priv->tx) * max_count;
298 }
299 
300 static void tsc2046_adc_group_set_cmd(struct tsc2046_adc_priv *priv,
301 				      unsigned int group, int ch_idx)
302 {
303 	struct tsc2046_adc_group_layout *l = &priv->l[group];
304 	unsigned int i;
305 	u8 cmd;
306 
307 	/*
308 	 * Do not enable automatic power down on working samples. Otherwise the
309 	 * plates will never be completely charged.
310 	 */
311 	cmd = tsc2046_adc_get_cmd(priv, ch_idx, true);
312 
313 	for (i = 0; i < l->count - 1; i++)
314 		priv->tx[l->offset + i].cmd = cmd;
315 
316 	/* automatically power down on last sample */
317 	priv->tx[l->offset + i].cmd = tsc2046_adc_get_cmd(priv, ch_idx, false);
318 }
319 
320 static u16 tsc2046_adc_get_val(struct tsc2046_adc_priv *priv, int group)
321 {
322 	struct tsc2046_adc_group_layout *l;
323 	unsigned int val, val_normalized = 0;
324 	int valid_count, i;
325 
326 	l = &priv->l[group];
327 	valid_count = l->count - l->skip;
328 
329 	for (i = 0; i < valid_count; i++) {
330 		val = tsc2046_adc_get_value(&priv->rx[l->offset + l->skip + i]);
331 		val_normalized += val;
332 	}
333 
334 	return DIV_ROUND_UP(val_normalized, valid_count);
335 }
336 
337 static int tsc2046_adc_scan(struct iio_dev *indio_dev)
338 {
339 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
340 	struct device *dev = &priv->spi->dev;
341 	int group;
342 	int ret;
343 
344 	ret = spi_sync(priv->spi, &priv->msg);
345 	if (ret < 0) {
346 		dev_err_ratelimited(dev, "SPI transfer failed: %pe\n", ERR_PTR(ret));
347 		return ret;
348 	}
349 
350 	for (group = 0; group < priv->groups; group++)
351 		priv->scan_buf.data[group] = tsc2046_adc_get_val(priv, group);
352 
353 	ret = iio_push_to_buffers_with_timestamp(indio_dev, &priv->scan_buf,
354 						 iio_get_time_ns(indio_dev));
355 	/* If the consumer is kfifo, we may get a EBUSY here - ignore it. */
356 	if (ret < 0 && ret != -EBUSY) {
357 		dev_err_ratelimited(dev, "Failed to push scan buffer %pe\n",
358 				    ERR_PTR(ret));
359 
360 		return ret;
361 	}
362 
363 	return 0;
364 }
365 
366 static irqreturn_t tsc2046_adc_trigger_handler(int irq, void *p)
367 {
368 	struct iio_poll_func *pf = p;
369 	struct iio_dev *indio_dev = pf->indio_dev;
370 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
371 
372 	mutex_lock(&priv->slock);
373 	tsc2046_adc_scan(indio_dev);
374 	mutex_unlock(&priv->slock);
375 
376 	iio_trigger_notify_done(indio_dev->trig);
377 
378 	return IRQ_HANDLED;
379 }
380 
381 static int tsc2046_adc_update_scan_mode(struct iio_dev *indio_dev,
382 					const unsigned long *active_scan_mask)
383 {
384 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
385 	unsigned int ch_idx, group = 0;
386 	size_t size;
387 
388 	mutex_lock(&priv->slock);
389 
390 	size = 0;
391 	for_each_set_bit(ch_idx, active_scan_mask, indio_dev->num_channels) {
392 		size += tsc2046_adc_group_set_layout(priv, group, ch_idx);
393 		tsc2046_adc_group_set_cmd(priv, group, ch_idx);
394 		group++;
395 	}
396 
397 	priv->groups = group;
398 	priv->xfer.len = size;
399 	priv->time_per_scan_us = size * 8 * priv->time_per_bit_ns / NSEC_PER_USEC;
400 
401 	if (priv->scan_interval_us > priv->time_per_scan_us)
402 		dev_warn(&priv->spi->dev, "The scan interval (%d) is less then calculated scan time (%d)\n",
403 			 priv->scan_interval_us, priv->time_per_scan_us);
404 
405 	mutex_unlock(&priv->slock);
406 
407 	return 0;
408 }
409 
410 static const struct iio_info tsc2046_adc_info = {
411 	.update_scan_mode = tsc2046_adc_update_scan_mode,
412 };
413 
414 static enum hrtimer_restart tsc2046_adc_trig_more(struct hrtimer *hrtimer)
415 {
416 	struct tsc2046_adc_priv *priv = container_of(hrtimer,
417 						     struct tsc2046_adc_priv,
418 						     trig_timer);
419 	unsigned long flags;
420 
421 	spin_lock_irqsave(&priv->trig_lock, flags);
422 
423 	disable_irq_nosync(priv->spi->irq);
424 
425 	priv->trig_more_count++;
426 	iio_trigger_poll(priv->trig);
427 
428 	spin_unlock_irqrestore(&priv->trig_lock, flags);
429 
430 	return HRTIMER_NORESTART;
431 }
432 
433 static irqreturn_t tsc2046_adc_irq(int irq, void *dev_id)
434 {
435 	struct iio_dev *indio_dev = dev_id;
436 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
437 
438 	spin_lock(&priv->trig_lock);
439 
440 	hrtimer_try_to_cancel(&priv->trig_timer);
441 
442 	priv->trig_more_count = 0;
443 	disable_irq_nosync(priv->spi->irq);
444 	iio_trigger_poll(priv->trig);
445 
446 	spin_unlock(&priv->trig_lock);
447 
448 	return IRQ_HANDLED;
449 }
450 
451 static void tsc2046_adc_reenable_trigger(struct iio_trigger *trig)
452 {
453 	struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
454 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
455 	unsigned long flags;
456 	int delta;
457 
458 	/*
459 	 * We can sample it as fast as we can, but usually we do not need so
460 	 * many samples. Reduce the sample rate for default (touchscreen) use
461 	 * case.
462 	 * Currently we do not need a highly precise sample rate. It is enough
463 	 * to have calculated numbers.
464 	 */
465 	delta = priv->scan_interval_us - priv->time_per_scan_us;
466 	if (delta > 0)
467 		fsleep(delta);
468 
469 	spin_lock_irqsave(&priv->trig_lock, flags);
470 
471 	/*
472 	 * We need to trigger at least one extra sample to detect state
473 	 * difference on ADC side.
474 	 */
475 	if (!priv->trig_more_count) {
476 		int timeout_ms = DIV_ROUND_UP(priv->scan_interval_us,
477 					      USEC_PER_MSEC);
478 
479 		hrtimer_start(&priv->trig_timer, ms_to_ktime(timeout_ms),
480 			      HRTIMER_MODE_REL_SOFT);
481 	}
482 
483 	enable_irq(priv->spi->irq);
484 
485 	spin_unlock_irqrestore(&priv->trig_lock, flags);
486 }
487 
488 static int tsc2046_adc_set_trigger_state(struct iio_trigger *trig, bool enable)
489 {
490 	struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
491 	struct tsc2046_adc_priv *priv = iio_priv(indio_dev);
492 
493 	if (enable) {
494 		enable_irq(priv->spi->irq);
495 	} else {
496 		disable_irq(priv->spi->irq);
497 		hrtimer_try_to_cancel(&priv->trig_timer);
498 	}
499 
500 	return 0;
501 }
502 
503 static const struct iio_trigger_ops tsc2046_adc_trigger_ops = {
504 	.set_trigger_state = tsc2046_adc_set_trigger_state,
505 	.reenable = tsc2046_adc_reenable_trigger,
506 };
507 
508 static int tsc2046_adc_setup_spi_msg(struct tsc2046_adc_priv *priv)
509 {
510 	unsigned int ch_idx;
511 	size_t size;
512 	int ret;
513 
514 	priv->tx_one = devm_kzalloc(&priv->spi->dev, sizeof(*priv->tx_one),
515 				    GFP_KERNEL);
516 	if (!priv->tx_one)
517 		return -ENOMEM;
518 
519 	priv->rx_one = devm_kzalloc(&priv->spi->dev, sizeof(*priv->rx_one),
520 				    GFP_KERNEL);
521 	if (!priv->rx_one)
522 		return -ENOMEM;
523 
524 	/*
525 	 * Make dummy read to set initial power state and get real SPI clock
526 	 * freq. It seems to be not important which channel is used for this
527 	 * case.
528 	 */
529 	ret = tsc2046_adc_read_one(priv, TI_TSC2046_ADDR_TEMP0,
530 				   &priv->effective_speed_hz);
531 	if (ret < 0)
532 		return ret;
533 
534 	/*
535 	 * In case SPI controller do not report effective_speed_hz, use
536 	 * configure value and hope it will match.
537 	 */
538 	if (!priv->effective_speed_hz)
539 		priv->effective_speed_hz = priv->spi->max_speed_hz;
540 
541 
542 	priv->scan_interval_us = TI_TSC2046_SAMPLE_INTERVAL_US;
543 	priv->time_per_bit_ns = DIV_ROUND_UP(NSEC_PER_SEC,
544 					     priv->effective_speed_hz);
545 
546 	/*
547 	 * Calculate and allocate maximal size buffer if all channels are
548 	 * enabled.
549 	 */
550 	size = 0;
551 	for (ch_idx = 0; ch_idx < priv->dcfg->num_channels; ch_idx++)
552 		size += tsc2046_adc_group_set_layout(priv, ch_idx, ch_idx);
553 
554 	priv->tx = devm_kzalloc(&priv->spi->dev, size, GFP_KERNEL);
555 	if (!priv->tx)
556 		return -ENOMEM;
557 
558 	priv->rx = devm_kzalloc(&priv->spi->dev, size, GFP_KERNEL);
559 	if (!priv->rx)
560 		return -ENOMEM;
561 
562 	priv->xfer.tx_buf = priv->tx;
563 	priv->xfer.rx_buf = priv->rx;
564 	priv->xfer.len = size;
565 	spi_message_init_with_transfers(&priv->msg, &priv->xfer, 1);
566 
567 	return 0;
568 }
569 
570 static void tsc2046_adc_parse_fwnode(struct tsc2046_adc_priv *priv)
571 {
572 	struct fwnode_handle *child;
573 	struct device *dev = &priv->spi->dev;
574 	unsigned int i;
575 
576 	for (i = 0; i < ARRAY_SIZE(priv->ch_cfg); i++) {
577 		priv->ch_cfg[i].settling_time_us = 1;
578 		priv->ch_cfg[i].oversampling_ratio = 1;
579 	}
580 
581 	device_for_each_child_node(dev, child) {
582 		u32 stl, overs, reg;
583 		int ret;
584 
585 		ret = fwnode_property_read_u32(child, "reg", &reg);
586 		if (ret) {
587 			dev_err(dev, "invalid reg on %pfw, err: %pe\n", child,
588 				ERR_PTR(ret));
589 			continue;
590 		}
591 
592 		if (reg >= ARRAY_SIZE(priv->ch_cfg)) {
593 			dev_err(dev, "%pfw: Unsupported reg value: %i, max supported is: %zu.\n",
594 				child, reg, ARRAY_SIZE(priv->ch_cfg));
595 			continue;
596 		}
597 
598 		ret = fwnode_property_read_u32(child, "settling-time-us", &stl);
599 		if (!ret)
600 			priv->ch_cfg[reg].settling_time_us = stl;
601 
602 		ret = fwnode_property_read_u32(child, "oversampling-ratio",
603 					       &overs);
604 		if (!ret)
605 			priv->ch_cfg[reg].oversampling_ratio = overs;
606 	}
607 }
608 
609 static int tsc2046_adc_probe(struct spi_device *spi)
610 {
611 	const struct tsc2046_adc_dcfg *dcfg;
612 	struct device *dev = &spi->dev;
613 	struct tsc2046_adc_priv *priv;
614 	struct iio_dev *indio_dev;
615 	struct iio_trigger *trig;
616 	int ret;
617 
618 	if (spi->max_speed_hz > TI_TSC2046_MAX_CLK_FREQ) {
619 		dev_err(dev, "SPI max_speed_hz is too high: %d Hz. Max supported freq is %zu Hz\n",
620 			spi->max_speed_hz, TI_TSC2046_MAX_CLK_FREQ);
621 		return -EINVAL;
622 	}
623 
624 	dcfg = device_get_match_data(dev);
625 	if (!dcfg)
626 		return -EINVAL;
627 
628 	spi->bits_per_word = 8;
629 	spi->mode &= ~SPI_MODE_X_MASK;
630 	spi->mode |= SPI_MODE_0;
631 	ret = spi_setup(spi);
632 	if (ret < 0)
633 		return dev_err_probe(dev, ret, "Error in SPI setup\n");
634 
635 	indio_dev = devm_iio_device_alloc(dev, sizeof(*priv));
636 	if (!indio_dev)
637 		return -ENOMEM;
638 
639 	priv = iio_priv(indio_dev);
640 	priv->dcfg = dcfg;
641 
642 	priv->spi = spi;
643 
644 	indio_dev->name = TI_TSC2046_NAME;
645 	indio_dev->modes = INDIO_DIRECT_MODE | INDIO_BUFFER_TRIGGERED;
646 	indio_dev->channels = dcfg->channels;
647 	indio_dev->num_channels = dcfg->num_channels;
648 	indio_dev->info = &tsc2046_adc_info;
649 
650 	tsc2046_adc_parse_fwnode(priv);
651 
652 	ret = tsc2046_adc_setup_spi_msg(priv);
653 	if (ret)
654 		return ret;
655 
656 	mutex_init(&priv->slock);
657 
658 	ret = devm_request_irq(dev, spi->irq, &tsc2046_adc_irq,
659 			       IRQF_NO_AUTOEN, indio_dev->name, indio_dev);
660 	if (ret)
661 		return ret;
662 
663 	trig = devm_iio_trigger_alloc(dev, "touchscreen-%s", indio_dev->name);
664 	if (!trig)
665 		return -ENOMEM;
666 
667 	priv->trig = trig;
668 	iio_trigger_set_drvdata(trig, indio_dev);
669 	trig->ops = &tsc2046_adc_trigger_ops;
670 
671 	spin_lock_init(&priv->trig_lock);
672 	hrtimer_init(&priv->trig_timer, CLOCK_MONOTONIC,
673 		     HRTIMER_MODE_REL_SOFT);
674 	priv->trig_timer.function = tsc2046_adc_trig_more;
675 
676 	ret = devm_iio_trigger_register(dev, trig);
677 	if (ret) {
678 		dev_err(dev, "failed to register trigger\n");
679 		return ret;
680 	}
681 
682 	ret = devm_iio_triggered_buffer_setup(dev, indio_dev, NULL,
683 					      &tsc2046_adc_trigger_handler, NULL);
684 	if (ret) {
685 		dev_err(dev, "Failed to setup triggered buffer\n");
686 		return ret;
687 	}
688 
689 	/* set default trigger */
690 	indio_dev->trig = iio_trigger_get(priv->trig);
691 
692 	return devm_iio_device_register(dev, indio_dev);
693 }
694 
695 static const struct of_device_id ads7950_of_table[] = {
696 	{ .compatible = "ti,tsc2046e-adc", .data = &tsc2046_adc_dcfg_tsc2046e },
697 	{ }
698 };
699 MODULE_DEVICE_TABLE(of, ads7950_of_table);
700 
701 static struct spi_driver tsc2046_adc_driver = {
702 	.driver = {
703 		.name = "tsc2046",
704 		.of_match_table = ads7950_of_table,
705 	},
706 	.probe = tsc2046_adc_probe,
707 };
708 module_spi_driver(tsc2046_adc_driver);
709 
710 MODULE_AUTHOR("Oleksij Rempel <kernel@pengutronix.de>");
711 MODULE_DESCRIPTION("TI TSC2046 ADC");
712 MODULE_LICENSE("GPL v2");
713