Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[sfrench/cifs-2.6.git] / drivers / input / touchscreen / ads7846.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * ADS7846 based touchscreen and sensor driver
4  *
5  * Copyright (c) 2005 David Brownell
6  * Copyright (c) 2006 Nokia Corporation
7  * Various changes: Imre Deak <imre.deak@nokia.com>
8  *
9  * Using code from:
10  *  - corgi_ts.c
11  *      Copyright (C) 2004-2005 Richard Purdie
12  *  - omap_ts.[hc], ads7846.h, ts_osk.c
13  *      Copyright (C) 2002 MontaVista Software
14  *      Copyright (C) 2004 Texas Instruments
15  *      Copyright (C) 2005 Dirk Behme
16  */
17 #include <linux/types.h>
18 #include <linux/hwmon.h>
19 #include <linux/err.h>
20 #include <linux/sched.h>
21 #include <linux/delay.h>
22 #include <linux/input.h>
23 #include <linux/input/touchscreen.h>
24 #include <linux/interrupt.h>
25 #include <linux/slab.h>
26 #include <linux/pm.h>
27 #include <linux/of.h>
28 #include <linux/of_gpio.h>
29 #include <linux/of_device.h>
30 #include <linux/gpio.h>
31 #include <linux/spi/spi.h>
32 #include <linux/spi/ads7846.h>
33 #include <linux/regulator/consumer.h>
34 #include <linux/module.h>
35 #include <asm/unaligned.h>
36
37 /*
38  * This code has been heavily tested on a Nokia 770, and lightly
39  * tested on other ads7846 devices (OSK/Mistral, Lubbock, Spitz).
40  * TSC2046 is just newer ads7846 silicon.
41  * Support for ads7843 tested on Atmel at91sam926x-EK.
42  * Support for ads7845 has only been stubbed in.
43  * Support for Analog Devices AD7873 and AD7843 tested.
44  *
45  * IRQ handling needs a workaround because of a shortcoming in handling
46  * edge triggered IRQs on some platforms like the OMAP1/2. These
47  * platforms don't handle the ARM lazy IRQ disabling properly, thus we
48  * have to maintain our own SW IRQ disabled status. This should be
49  * removed as soon as the affected platform's IRQ handling is fixed.
50  *
51  * App note sbaa036 talks in more detail about accurate sampling...
52  * that ought to help in situations like LCDs inducing noise (which
53  * can also be helped by using synch signals) and more generally.
54  * This driver tries to utilize the measures described in the app
55  * note. The strength of filtering can be set in the board-* specific
56  * files.
57  */
58
59 #define TS_POLL_DELAY   1       /* ms delay before the first sample */
60 #define TS_POLL_PERIOD  5       /* ms delay between samples */
61
62 /* this driver doesn't aim at the peak continuous sample rate */
63 #define SAMPLE_BITS     (8 /*cmd*/ + 16 /*sample*/ + 2 /* before, after */)
64
65 struct ads7846_buf {
66         u8 cmd;
67         /*
68          * This union is a temporary hack. The driver does an in-place
69          * endianness conversion. This will be cleaned up in the next
70          * patch.
71          */
72         union {
73                 __be16 data_be16;
74                 u16 data;
75         };
76 } __packed;
77
78
79 struct ts_event {
80         bool ignore;
81         struct ads7846_buf x;
82         struct ads7846_buf y;
83         struct ads7846_buf z1;
84         struct ads7846_buf z2;
85 };
86
87 /*
88  * We allocate this separately to avoid cache line sharing issues when
89  * driver is used with DMA-based SPI controllers (like atmel_spi) on
90  * systems where main memory is not DMA-coherent (most non-x86 boards).
91  */
92 struct ads7846_packet {
93         struct ts_event tc;
94         struct ads7846_buf read_x_cmd;
95         struct ads7846_buf read_y_cmd;
96         struct ads7846_buf read_z1_cmd;
97         struct ads7846_buf read_z2_cmd;
98         struct ads7846_buf pwrdown_cmd;
99 };
100
101 struct ads7846 {
102         struct input_dev        *input;
103         char                    phys[32];
104         char                    name[32];
105
106         struct spi_device       *spi;
107         struct regulator        *reg;
108
109 #if IS_ENABLED(CONFIG_HWMON)
110         struct device           *hwmon;
111 #endif
112
113         u16                     model;
114         u16                     vref_mv;
115         u16                     vref_delay_usecs;
116         u16                     x_plate_ohms;
117         u16                     pressure_max;
118
119         bool                    swap_xy;
120         bool                    use_internal;
121
122         struct ads7846_packet   *packet;
123
124         struct spi_transfer     xfer[18];
125         struct spi_message      msg[5];
126         int                     msg_count;
127         wait_queue_head_t       wait;
128
129         bool                    pendown;
130
131         int                     read_cnt;
132         int                     read_rep;
133         int                     last_read;
134
135         u16                     debounce_max;
136         u16                     debounce_tol;
137         u16                     debounce_rep;
138
139         u16                     penirq_recheck_delay_usecs;
140
141         struct touchscreen_properties core_prop;
142
143         struct mutex            lock;
144         bool                    stopped;        /* P: lock */
145         bool                    disabled;       /* P: lock */
146         bool                    suspended;      /* P: lock */
147
148         int                     (*filter)(void *data, int data_idx, int *val);
149         void                    *filter_data;
150         void                    (*filter_cleanup)(void *data);
151         int                     (*get_pendown_state)(void);
152         int                     gpio_pendown;
153
154         void                    (*wait_for_sync)(void);
155 };
156
157 /* leave chip selected when we're done, for quicker re-select? */
158 #if     0
159 #define CS_CHANGE(xfer) ((xfer).cs_change = 1)
160 #else
161 #define CS_CHANGE(xfer) ((xfer).cs_change = 0)
162 #endif
163
164 /*--------------------------------------------------------------------------*/
165
166 /* The ADS7846 has touchscreen and other sensors.
167  * Earlier ads784x chips are somewhat compatible.
168  */
169 #define ADS_START               (1 << 7)
170 #define ADS_A2A1A0_d_y          (1 << 4)        /* differential */
171 #define ADS_A2A1A0_d_z1         (3 << 4)        /* differential */
172 #define ADS_A2A1A0_d_z2         (4 << 4)        /* differential */
173 #define ADS_A2A1A0_d_x          (5 << 4)        /* differential */
174 #define ADS_A2A1A0_temp0        (0 << 4)        /* non-differential */
175 #define ADS_A2A1A0_vbatt        (2 << 4)        /* non-differential */
176 #define ADS_A2A1A0_vaux         (6 << 4)        /* non-differential */
177 #define ADS_A2A1A0_temp1        (7 << 4)        /* non-differential */
178 #define ADS_8_BIT               (1 << 3)
179 #define ADS_12_BIT              (0 << 3)
180 #define ADS_SER                 (1 << 2)        /* non-differential */
181 #define ADS_DFR                 (0 << 2)        /* differential */
182 #define ADS_PD10_PDOWN          (0 << 0)        /* low power mode + penirq */
183 #define ADS_PD10_ADC_ON         (1 << 0)        /* ADC on */
184 #define ADS_PD10_REF_ON         (2 << 0)        /* vREF on + penirq */
185 #define ADS_PD10_ALL_ON         (3 << 0)        /* ADC + vREF on */
186
187 #define MAX_12BIT       ((1<<12)-1)
188
189 /* leave ADC powered up (disables penirq) between differential samples */
190 #define READ_12BIT_DFR(x, adc, vref) (ADS_START | ADS_A2A1A0_d_ ## x \
191         | ADS_12_BIT | ADS_DFR | \
192         (adc ? ADS_PD10_ADC_ON : 0) | (vref ? ADS_PD10_REF_ON : 0))
193
194 #define READ_Y(vref)    (READ_12BIT_DFR(y,  1, vref))
195 #define READ_Z1(vref)   (READ_12BIT_DFR(z1, 1, vref))
196 #define READ_Z2(vref)   (READ_12BIT_DFR(z2, 1, vref))
197
198 #define READ_X(vref)    (READ_12BIT_DFR(x,  1, vref))
199 #define PWRDOWN         (READ_12BIT_DFR(y,  0, 0))      /* LAST */
200
201 /* single-ended samples need to first power up reference voltage;
202  * we leave both ADC and VREF powered
203  */
204 #define READ_12BIT_SER(x) (ADS_START | ADS_A2A1A0_ ## x \
205         | ADS_12_BIT | ADS_SER)
206
207 #define REF_ON  (READ_12BIT_DFR(x, 1, 1))
208 #define REF_OFF (READ_12BIT_DFR(y, 0, 0))
209
210 static int get_pendown_state(struct ads7846 *ts)
211 {
212         if (ts->get_pendown_state)
213                 return ts->get_pendown_state();
214
215         return !gpio_get_value(ts->gpio_pendown);
216 }
217
218 static void ads7846_report_pen_up(struct ads7846 *ts)
219 {
220         struct input_dev *input = ts->input;
221
222         input_report_key(input, BTN_TOUCH, 0);
223         input_report_abs(input, ABS_PRESSURE, 0);
224         input_sync(input);
225
226         ts->pendown = false;
227         dev_vdbg(&ts->spi->dev, "UP\n");
228 }
229
230 /* Must be called with ts->lock held */
231 static void ads7846_stop(struct ads7846 *ts)
232 {
233         if (!ts->disabled && !ts->suspended) {
234                 /* Signal IRQ thread to stop polling and disable the handler. */
235                 ts->stopped = true;
236                 mb();
237                 wake_up(&ts->wait);
238                 disable_irq(ts->spi->irq);
239         }
240 }
241
242 /* Must be called with ts->lock held */
243 static void ads7846_restart(struct ads7846 *ts)
244 {
245         if (!ts->disabled && !ts->suspended) {
246                 /* Check if pen was released since last stop */
247                 if (ts->pendown && !get_pendown_state(ts))
248                         ads7846_report_pen_up(ts);
249
250                 /* Tell IRQ thread that it may poll the device. */
251                 ts->stopped = false;
252                 mb();
253                 enable_irq(ts->spi->irq);
254         }
255 }
256
257 /* Must be called with ts->lock held */
258 static void __ads7846_disable(struct ads7846 *ts)
259 {
260         ads7846_stop(ts);
261         regulator_disable(ts->reg);
262
263         /*
264          * We know the chip's in low power mode since we always
265          * leave it that way after every request
266          */
267 }
268
269 /* Must be called with ts->lock held */
270 static void __ads7846_enable(struct ads7846 *ts)
271 {
272         int error;
273
274         error = regulator_enable(ts->reg);
275         if (error != 0)
276                 dev_err(&ts->spi->dev, "Failed to enable supply: %d\n", error);
277
278         ads7846_restart(ts);
279 }
280
281 static void ads7846_disable(struct ads7846 *ts)
282 {
283         mutex_lock(&ts->lock);
284
285         if (!ts->disabled) {
286
287                 if  (!ts->suspended)
288                         __ads7846_disable(ts);
289
290                 ts->disabled = true;
291         }
292
293         mutex_unlock(&ts->lock);
294 }
295
296 static void ads7846_enable(struct ads7846 *ts)
297 {
298         mutex_lock(&ts->lock);
299
300         if (ts->disabled) {
301
302                 ts->disabled = false;
303
304                 if (!ts->suspended)
305                         __ads7846_enable(ts);
306         }
307
308         mutex_unlock(&ts->lock);
309 }
310
311 /*--------------------------------------------------------------------------*/
312
313 /*
314  * Non-touchscreen sensors only use single-ended conversions.
315  * The range is GND..vREF. The ads7843 and ads7835 must use external vREF;
316  * ads7846 lets that pin be unconnected, to use internal vREF.
317  */
318
319 struct ser_req {
320         u8                      ref_on;
321         u8                      command;
322         u8                      ref_off;
323         u16                     scratch;
324         struct spi_message      msg;
325         struct spi_transfer     xfer[6];
326         /*
327          * DMA (thus cache coherency maintenance) requires the
328          * transfer buffers to live in their own cache lines.
329          */
330         __be16 sample ____cacheline_aligned;
331 };
332
333 struct ads7845_ser_req {
334         u8                      command[3];
335         struct spi_message      msg;
336         struct spi_transfer     xfer[2];
337         /*
338          * DMA (thus cache coherency maintenance) requires the
339          * transfer buffers to live in their own cache lines.
340          */
341         u8 sample[3] ____cacheline_aligned;
342 };
343
344 static int ads7846_read12_ser(struct device *dev, unsigned command)
345 {
346         struct spi_device *spi = to_spi_device(dev);
347         struct ads7846 *ts = dev_get_drvdata(dev);
348         struct ser_req *req;
349         int status;
350
351         req = kzalloc(sizeof *req, GFP_KERNEL);
352         if (!req)
353                 return -ENOMEM;
354
355         spi_message_init(&req->msg);
356
357         /* maybe turn on internal vREF, and let it settle */
358         if (ts->use_internal) {
359                 req->ref_on = REF_ON;
360                 req->xfer[0].tx_buf = &req->ref_on;
361                 req->xfer[0].len = 1;
362                 spi_message_add_tail(&req->xfer[0], &req->msg);
363
364                 req->xfer[1].rx_buf = &req->scratch;
365                 req->xfer[1].len = 2;
366
367                 /* for 1uF, settle for 800 usec; no cap, 100 usec.  */
368                 req->xfer[1].delay.value = ts->vref_delay_usecs;
369                 req->xfer[1].delay.unit = SPI_DELAY_UNIT_USECS;
370                 spi_message_add_tail(&req->xfer[1], &req->msg);
371
372                 /* Enable reference voltage */
373                 command |= ADS_PD10_REF_ON;
374         }
375
376         /* Enable ADC in every case */
377         command |= ADS_PD10_ADC_ON;
378
379         /* take sample */
380         req->command = (u8) command;
381         req->xfer[2].tx_buf = &req->command;
382         req->xfer[2].len = 1;
383         spi_message_add_tail(&req->xfer[2], &req->msg);
384
385         req->xfer[3].rx_buf = &req->sample;
386         req->xfer[3].len = 2;
387         spi_message_add_tail(&req->xfer[3], &req->msg);
388
389         /* REVISIT:  take a few more samples, and compare ... */
390
391         /* converter in low power mode & enable PENIRQ */
392         req->ref_off = PWRDOWN;
393         req->xfer[4].tx_buf = &req->ref_off;
394         req->xfer[4].len = 1;
395         spi_message_add_tail(&req->xfer[4], &req->msg);
396
397         req->xfer[5].rx_buf = &req->scratch;
398         req->xfer[5].len = 2;
399         CS_CHANGE(req->xfer[5]);
400         spi_message_add_tail(&req->xfer[5], &req->msg);
401
402         mutex_lock(&ts->lock);
403         ads7846_stop(ts);
404         status = spi_sync(spi, &req->msg);
405         ads7846_restart(ts);
406         mutex_unlock(&ts->lock);
407
408         if (status == 0) {
409                 /* on-wire is a must-ignore bit, a BE12 value, then padding */
410                 status = be16_to_cpu(req->sample);
411                 status = status >> 3;
412                 status &= 0x0fff;
413         }
414
415         kfree(req);
416         return status;
417 }
418
419 static int ads7845_read12_ser(struct device *dev, unsigned command)
420 {
421         struct spi_device *spi = to_spi_device(dev);
422         struct ads7846 *ts = dev_get_drvdata(dev);
423         struct ads7845_ser_req *req;
424         int status;
425
426         req = kzalloc(sizeof *req, GFP_KERNEL);
427         if (!req)
428                 return -ENOMEM;
429
430         spi_message_init(&req->msg);
431
432         req->command[0] = (u8) command;
433         req->xfer[0].tx_buf = req->command;
434         req->xfer[0].rx_buf = req->sample;
435         req->xfer[0].len = 3;
436         spi_message_add_tail(&req->xfer[0], &req->msg);
437
438         mutex_lock(&ts->lock);
439         ads7846_stop(ts);
440         status = spi_sync(spi, &req->msg);
441         ads7846_restart(ts);
442         mutex_unlock(&ts->lock);
443
444         if (status == 0) {
445                 /* BE12 value, then padding */
446                 status = get_unaligned_be16(&req->sample[1]);
447                 status = status >> 3;
448                 status &= 0x0fff;
449         }
450
451         kfree(req);
452         return status;
453 }
454
455 #if IS_ENABLED(CONFIG_HWMON)
456
457 #define SHOW(name, var, adjust) static ssize_t \
458 name ## _show(struct device *dev, struct device_attribute *attr, char *buf) \
459 { \
460         struct ads7846 *ts = dev_get_drvdata(dev); \
461         ssize_t v = ads7846_read12_ser(&ts->spi->dev, \
462                         READ_12BIT_SER(var)); \
463         if (v < 0) \
464                 return v; \
465         return sprintf(buf, "%u\n", adjust(ts, v)); \
466 } \
467 static DEVICE_ATTR(name, S_IRUGO, name ## _show, NULL);
468
469
470 /* Sysfs conventions report temperatures in millidegrees Celsius.
471  * ADS7846 could use the low-accuracy two-sample scheme, but can't do the high
472  * accuracy scheme without calibration data.  For now we won't try either;
473  * userspace sees raw sensor values, and must scale/calibrate appropriately.
474  */
475 static inline unsigned null_adjust(struct ads7846 *ts, ssize_t v)
476 {
477         return v;
478 }
479
480 SHOW(temp0, temp0, null_adjust)         /* temp1_input */
481 SHOW(temp1, temp1, null_adjust)         /* temp2_input */
482
483
484 /* sysfs conventions report voltages in millivolts.  We can convert voltages
485  * if we know vREF.  userspace may need to scale vAUX to match the board's
486  * external resistors; we assume that vBATT only uses the internal ones.
487  */
488 static inline unsigned vaux_adjust(struct ads7846 *ts, ssize_t v)
489 {
490         unsigned retval = v;
491
492         /* external resistors may scale vAUX into 0..vREF */
493         retval *= ts->vref_mv;
494         retval = retval >> 12;
495
496         return retval;
497 }
498
499 static inline unsigned vbatt_adjust(struct ads7846 *ts, ssize_t v)
500 {
501         unsigned retval = vaux_adjust(ts, v);
502
503         /* ads7846 has a resistor ladder to scale this signal down */
504         if (ts->model == 7846)
505                 retval *= 4;
506
507         return retval;
508 }
509
510 SHOW(in0_input, vaux, vaux_adjust)
511 SHOW(in1_input, vbatt, vbatt_adjust)
512
513 static umode_t ads7846_is_visible(struct kobject *kobj, struct attribute *attr,
514                                   int index)
515 {
516         struct device *dev = kobj_to_dev(kobj);
517         struct ads7846 *ts = dev_get_drvdata(dev);
518
519         if (ts->model == 7843 && index < 2)     /* in0, in1 */
520                 return 0;
521         if (ts->model == 7845 && index != 2)    /* in0 */
522                 return 0;
523
524         return attr->mode;
525 }
526
527 static struct attribute *ads7846_attributes[] = {
528         &dev_attr_temp0.attr,           /* 0 */
529         &dev_attr_temp1.attr,           /* 1 */
530         &dev_attr_in0_input.attr,       /* 2 */
531         &dev_attr_in1_input.attr,       /* 3 */
532         NULL,
533 };
534
535 static const struct attribute_group ads7846_attr_group = {
536         .attrs = ads7846_attributes,
537         .is_visible = ads7846_is_visible,
538 };
539 __ATTRIBUTE_GROUPS(ads7846_attr);
540
541 static int ads784x_hwmon_register(struct spi_device *spi, struct ads7846 *ts)
542 {
543         /* hwmon sensors need a reference voltage */
544         switch (ts->model) {
545         case 7846:
546                 if (!ts->vref_mv) {
547                         dev_dbg(&spi->dev, "assuming 2.5V internal vREF\n");
548                         ts->vref_mv = 2500;
549                         ts->use_internal = true;
550                 }
551                 break;
552         case 7845:
553         case 7843:
554                 if (!ts->vref_mv) {
555                         dev_warn(&spi->dev,
556                                 "external vREF for ADS%d not specified\n",
557                                 ts->model);
558                         return 0;
559                 }
560                 break;
561         }
562
563         ts->hwmon = hwmon_device_register_with_groups(&spi->dev, spi->modalias,
564                                                       ts, ads7846_attr_groups);
565
566         return PTR_ERR_OR_ZERO(ts->hwmon);
567 }
568
569 static void ads784x_hwmon_unregister(struct spi_device *spi,
570                                      struct ads7846 *ts)
571 {
572         if (ts->hwmon)
573                 hwmon_device_unregister(ts->hwmon);
574 }
575
576 #else
577 static inline int ads784x_hwmon_register(struct spi_device *spi,
578                                          struct ads7846 *ts)
579 {
580         return 0;
581 }
582
583 static inline void ads784x_hwmon_unregister(struct spi_device *spi,
584                                             struct ads7846 *ts)
585 {
586 }
587 #endif
588
589 static ssize_t ads7846_pen_down_show(struct device *dev,
590                                      struct device_attribute *attr, char *buf)
591 {
592         struct ads7846 *ts = dev_get_drvdata(dev);
593
594         return sprintf(buf, "%u\n", ts->pendown);
595 }
596
597 static DEVICE_ATTR(pen_down, S_IRUGO, ads7846_pen_down_show, NULL);
598
599 static ssize_t ads7846_disable_show(struct device *dev,
600                                      struct device_attribute *attr, char *buf)
601 {
602         struct ads7846 *ts = dev_get_drvdata(dev);
603
604         return sprintf(buf, "%u\n", ts->disabled);
605 }
606
607 static ssize_t ads7846_disable_store(struct device *dev,
608                                      struct device_attribute *attr,
609                                      const char *buf, size_t count)
610 {
611         struct ads7846 *ts = dev_get_drvdata(dev);
612         unsigned int i;
613         int err;
614
615         err = kstrtouint(buf, 10, &i);
616         if (err)
617                 return err;
618
619         if (i)
620                 ads7846_disable(ts);
621         else
622                 ads7846_enable(ts);
623
624         return count;
625 }
626
627 static DEVICE_ATTR(disable, 0664, ads7846_disable_show, ads7846_disable_store);
628
629 static struct attribute *ads784x_attributes[] = {
630         &dev_attr_pen_down.attr,
631         &dev_attr_disable.attr,
632         NULL,
633 };
634
635 static const struct attribute_group ads784x_attr_group = {
636         .attrs = ads784x_attributes,
637 };
638
639 /*--------------------------------------------------------------------------*/
640
641 static void null_wait_for_sync(void)
642 {
643 }
644
645 static int ads7846_debounce_filter(void *ads, int data_idx, int *val)
646 {
647         struct ads7846 *ts = ads;
648
649         if (!ts->read_cnt || (abs(ts->last_read - *val) > ts->debounce_tol)) {
650                 /* Start over collecting consistent readings. */
651                 ts->read_rep = 0;
652                 /*
653                  * Repeat it, if this was the first read or the read
654                  * wasn't consistent enough.
655                  */
656                 if (ts->read_cnt < ts->debounce_max) {
657                         ts->last_read = *val;
658                         ts->read_cnt++;
659                         return ADS7846_FILTER_REPEAT;
660                 } else {
661                         /*
662                          * Maximum number of debouncing reached and still
663                          * not enough number of consistent readings. Abort
664                          * the whole sample, repeat it in the next sampling
665                          * period.
666                          */
667                         ts->read_cnt = 0;
668                         return ADS7846_FILTER_IGNORE;
669                 }
670         } else {
671                 if (++ts->read_rep > ts->debounce_rep) {
672                         /*
673                          * Got a good reading for this coordinate,
674                          * go for the next one.
675                          */
676                         ts->read_cnt = 0;
677                         ts->read_rep = 0;
678                         return ADS7846_FILTER_OK;
679                 } else {
680                         /* Read more values that are consistent. */
681                         ts->read_cnt++;
682                         return ADS7846_FILTER_REPEAT;
683                 }
684         }
685 }
686
687 static int ads7846_no_filter(void *ads, int data_idx, int *val)
688 {
689         return ADS7846_FILTER_OK;
690 }
691
692 static int ads7846_get_value(struct ads7846 *ts, struct spi_message *m)
693 {
694         int value;
695         struct spi_transfer *t =
696                 list_entry(m->transfers.prev, struct spi_transfer, transfer_list);
697         struct ads7846_buf *buf = t->rx_buf;
698
699         value = be16_to_cpup(&buf->data_be16);
700
701         /* enforce ADC output is 12 bits width */
702         return (value >> 3) & 0xfff;
703 }
704
705 static void ads7846_update_value(struct spi_message *m, int val)
706 {
707         struct spi_transfer *t =
708                 list_entry(m->transfers.prev, struct spi_transfer, transfer_list);
709         struct ads7846_buf *buf = t->rx_buf;
710
711         buf->data = val;
712 }
713
714 static void ads7846_read_state(struct ads7846 *ts)
715 {
716         struct ads7846_packet *packet = ts->packet;
717         struct spi_message *m;
718         int msg_idx = 0;
719         int val;
720         int action;
721         int error;
722
723         while (msg_idx < ts->msg_count) {
724
725                 ts->wait_for_sync();
726
727                 m = &ts->msg[msg_idx];
728                 error = spi_sync(ts->spi, m);
729                 if (error) {
730                         dev_err(&ts->spi->dev, "spi_sync --> %d\n", error);
731                         packet->tc.ignore = true;
732                         return;
733                 }
734
735                 /*
736                  * Last message is power down request, no need to convert
737                  * or filter the value.
738                  */
739                 if (msg_idx < ts->msg_count - 1) {
740
741                         val = ads7846_get_value(ts, m);
742
743                         action = ts->filter(ts->filter_data, msg_idx, &val);
744                         switch (action) {
745                         case ADS7846_FILTER_REPEAT:
746                                 continue;
747
748                         case ADS7846_FILTER_IGNORE:
749                                 packet->tc.ignore = true;
750                                 msg_idx = ts->msg_count - 1;
751                                 continue;
752
753                         case ADS7846_FILTER_OK:
754                                 ads7846_update_value(m, val);
755                                 packet->tc.ignore = false;
756                                 msg_idx++;
757                                 break;
758
759                         default:
760                                 BUG();
761                         }
762                 } else {
763                         msg_idx++;
764                 }
765         }
766 }
767
768 static void ads7846_report_state(struct ads7846 *ts)
769 {
770         struct ads7846_packet *packet = ts->packet;
771         unsigned int Rt;
772         u16 x, y, z1, z2;
773
774         /*
775          * ads7846_get_value() does in-place conversion (including byte swap)
776          * from on-the-wire format as part of debouncing to get stable
777          * readings.
778          */
779         x = packet->tc.x.data;
780         y = packet->tc.y.data;
781         if (ts->model == 7845) {
782                 z1 = 0;
783                 z2 = 0;
784         } else {
785                 z1 = packet->tc.z1.data;
786                 z2 = packet->tc.z2.data;
787         }
788
789         /* range filtering */
790         if (x == MAX_12BIT)
791                 x = 0;
792
793         if (ts->model == 7843) {
794                 Rt = ts->pressure_max / 2;
795         } else if (ts->model == 7845) {
796                 if (get_pendown_state(ts))
797                         Rt = ts->pressure_max / 2;
798                 else
799                         Rt = 0;
800                 dev_vdbg(&ts->spi->dev, "x/y: %d/%d, PD %d\n", x, y, Rt);
801         } else if (likely(x && z1)) {
802                 /* compute touch pressure resistance using equation #2 */
803                 Rt = z2;
804                 Rt -= z1;
805                 Rt *= ts->x_plate_ohms;
806                 Rt = DIV_ROUND_CLOSEST(Rt, 16);
807                 Rt *= x;
808                 Rt /= z1;
809                 Rt = DIV_ROUND_CLOSEST(Rt, 256);
810         } else {
811                 Rt = 0;
812         }
813
814         /*
815          * Sample found inconsistent by debouncing or pressure is beyond
816          * the maximum. Don't report it to user space, repeat at least
817          * once more the measurement
818          */
819         if (packet->tc.ignore || Rt > ts->pressure_max) {
820                 dev_vdbg(&ts->spi->dev, "ignored %d pressure %d\n",
821                          packet->tc.ignore, Rt);
822                 return;
823         }
824
825         /*
826          * Maybe check the pendown state before reporting. This discards
827          * false readings when the pen is lifted.
828          */
829         if (ts->penirq_recheck_delay_usecs) {
830                 udelay(ts->penirq_recheck_delay_usecs);
831                 if (!get_pendown_state(ts))
832                         Rt = 0;
833         }
834
835         /*
836          * NOTE: We can't rely on the pressure to determine the pen down
837          * state, even this controller has a pressure sensor. The pressure
838          * value can fluctuate for quite a while after lifting the pen and
839          * in some cases may not even settle at the expected value.
840          *
841          * The only safe way to check for the pen up condition is in the
842          * timer by reading the pen signal state (it's a GPIO _and_ IRQ).
843          */
844         if (Rt) {
845                 struct input_dev *input = ts->input;
846
847                 if (!ts->pendown) {
848                         input_report_key(input, BTN_TOUCH, 1);
849                         ts->pendown = true;
850                         dev_vdbg(&ts->spi->dev, "DOWN\n");
851                 }
852
853                 touchscreen_report_pos(input, &ts->core_prop, x, y, false);
854                 input_report_abs(input, ABS_PRESSURE, ts->pressure_max - Rt);
855
856                 input_sync(input);
857                 dev_vdbg(&ts->spi->dev, "%4d/%4d/%4d\n", x, y, Rt);
858         }
859 }
860
861 static irqreturn_t ads7846_hard_irq(int irq, void *handle)
862 {
863         struct ads7846 *ts = handle;
864
865         return get_pendown_state(ts) ? IRQ_WAKE_THREAD : IRQ_HANDLED;
866 }
867
868
869 static irqreturn_t ads7846_irq(int irq, void *handle)
870 {
871         struct ads7846 *ts = handle;
872
873         /* Start with a small delay before checking pendown state */
874         msleep(TS_POLL_DELAY);
875
876         while (!ts->stopped && get_pendown_state(ts)) {
877
878                 /* pen is down, continue with the measurement */
879                 ads7846_read_state(ts);
880
881                 if (!ts->stopped)
882                         ads7846_report_state(ts);
883
884                 wait_event_timeout(ts->wait, ts->stopped,
885                                    msecs_to_jiffies(TS_POLL_PERIOD));
886         }
887
888         if (ts->pendown && !ts->stopped)
889                 ads7846_report_pen_up(ts);
890
891         return IRQ_HANDLED;
892 }
893
894 static int __maybe_unused ads7846_suspend(struct device *dev)
895 {
896         struct ads7846 *ts = dev_get_drvdata(dev);
897
898         mutex_lock(&ts->lock);
899
900         if (!ts->suspended) {
901
902                 if (!ts->disabled)
903                         __ads7846_disable(ts);
904
905                 if (device_may_wakeup(&ts->spi->dev))
906                         enable_irq_wake(ts->spi->irq);
907
908                 ts->suspended = true;
909         }
910
911         mutex_unlock(&ts->lock);
912
913         return 0;
914 }
915
916 static int __maybe_unused ads7846_resume(struct device *dev)
917 {
918         struct ads7846 *ts = dev_get_drvdata(dev);
919
920         mutex_lock(&ts->lock);
921
922         if (ts->suspended) {
923
924                 ts->suspended = false;
925
926                 if (device_may_wakeup(&ts->spi->dev))
927                         disable_irq_wake(ts->spi->irq);
928
929                 if (!ts->disabled)
930                         __ads7846_enable(ts);
931         }
932
933         mutex_unlock(&ts->lock);
934
935         return 0;
936 }
937
938 static SIMPLE_DEV_PM_OPS(ads7846_pm, ads7846_suspend, ads7846_resume);
939
940 static int ads7846_setup_pendown(struct spi_device *spi,
941                                  struct ads7846 *ts,
942                                  const struct ads7846_platform_data *pdata)
943 {
944         int err;
945
946         /*
947          * REVISIT when the irq can be triggered active-low, or if for some
948          * reason the touchscreen isn't hooked up, we don't need to access
949          * the pendown state.
950          */
951
952         if (pdata->get_pendown_state) {
953                 ts->get_pendown_state = pdata->get_pendown_state;
954         } else if (gpio_is_valid(pdata->gpio_pendown)) {
955
956                 err = gpio_request_one(pdata->gpio_pendown, GPIOF_IN,
957                                        "ads7846_pendown");
958                 if (err) {
959                         dev_err(&spi->dev,
960                                 "failed to request/setup pendown GPIO%d: %d\n",
961                                 pdata->gpio_pendown, err);
962                         return err;
963                 }
964
965                 ts->gpio_pendown = pdata->gpio_pendown;
966
967                 if (pdata->gpio_pendown_debounce)
968                         gpio_set_debounce(pdata->gpio_pendown,
969                                           pdata->gpio_pendown_debounce);
970         } else {
971                 dev_err(&spi->dev, "no get_pendown_state nor gpio_pendown?\n");
972                 return -EINVAL;
973         }
974
975         return 0;
976 }
977
978 /*
979  * Set up the transfers to read touchscreen state; this assumes we
980  * use formula #2 for pressure, not #3.
981  */
982 static void ads7846_setup_spi_msg(struct ads7846 *ts,
983                                   const struct ads7846_platform_data *pdata)
984 {
985         struct spi_message *m = &ts->msg[0];
986         struct spi_transfer *x = ts->xfer;
987         struct ads7846_packet *packet = ts->packet;
988         int vref = pdata->keep_vref_on;
989
990         if (ts->model == 7873) {
991                 /*
992                  * The AD7873 is almost identical to the ADS7846
993                  * keep VREF off during differential/ratiometric
994                  * conversion modes.
995                  */
996                 ts->model = 7846;
997                 vref = 0;
998         }
999
1000         ts->msg_count = 1;
1001         spi_message_init(m);
1002         m->context = ts;
1003
1004         packet->read_y_cmd.cmd = READ_Y(vref);
1005         x->tx_buf = &packet->read_y_cmd;
1006         x->rx_buf = &packet->tc.y;
1007         x->len = 3;
1008         spi_message_add_tail(x, m);
1009
1010         /*
1011          * The first sample after switching drivers can be low quality;
1012          * optionally discard it, using a second one after the signals
1013          * have had enough time to stabilize.
1014          */
1015         if (pdata->settle_delay_usecs) {
1016                 x->delay.value = pdata->settle_delay_usecs;
1017                 x->delay.unit = SPI_DELAY_UNIT_USECS;
1018                 x++;
1019
1020                 x->tx_buf = &packet->read_y_cmd;
1021                 x->rx_buf = &packet->tc.y;
1022                 x->len = 3;
1023                 spi_message_add_tail(x, m);
1024         }
1025
1026         ts->msg_count++;
1027         m++;
1028         spi_message_init(m);
1029         m->context = ts;
1030
1031         /* turn y- off, x+ on, then leave in lowpower */
1032         x++;
1033         packet->read_x_cmd.cmd = READ_X(vref);
1034         x->tx_buf = &packet->read_x_cmd;
1035         x->rx_buf = &packet->tc.x;
1036         x->len = 3;
1037         spi_message_add_tail(x, m);
1038
1039         /* ... maybe discard first sample ... */
1040         if (pdata->settle_delay_usecs) {
1041                 x->delay.value = pdata->settle_delay_usecs;
1042                 x->delay.unit = SPI_DELAY_UNIT_USECS;
1043
1044                 x++;
1045                 x->tx_buf = &packet->read_x_cmd;
1046                 x->rx_buf = &packet->tc.x;
1047                 x->len = 3;
1048                 spi_message_add_tail(x, m);
1049         }
1050
1051         /* turn y+ off, x- on; we'll use formula #2 */
1052         if (ts->model == 7846) {
1053                 ts->msg_count++;
1054                 m++;
1055                 spi_message_init(m);
1056                 m->context = ts;
1057
1058                 x++;
1059                 packet->read_z1_cmd.cmd = READ_Z1(vref);
1060                 x->tx_buf = &packet->read_z1_cmd;
1061                 x->rx_buf = &packet->tc.z1;
1062                 x->len = 3;
1063                 spi_message_add_tail(x, m);
1064
1065                 /* ... maybe discard first sample ... */
1066                 if (pdata->settle_delay_usecs) {
1067                         x->delay.value = pdata->settle_delay_usecs;
1068                         x->delay.unit = SPI_DELAY_UNIT_USECS;
1069
1070                         x++;
1071                         x->tx_buf = &packet->read_z1_cmd;
1072                         x->rx_buf = &packet->tc.z1;
1073                         x->len = 3;
1074                         spi_message_add_tail(x, m);
1075                 }
1076
1077                 ts->msg_count++;
1078                 m++;
1079                 spi_message_init(m);
1080                 m->context = ts;
1081
1082                 x++;
1083                 packet->read_z2_cmd.cmd = READ_Z2(vref);
1084                 x->tx_buf = &packet->read_z2_cmd;
1085                 x->rx_buf = &packet->tc.z2;
1086                 x->len = 3;
1087                 spi_message_add_tail(x, m);
1088
1089                 /* ... maybe discard first sample ... */
1090                 if (pdata->settle_delay_usecs) {
1091                         x->delay.value = pdata->settle_delay_usecs;
1092                         x->delay.unit = SPI_DELAY_UNIT_USECS;
1093
1094                         x++;
1095                         x->tx_buf = &packet->read_z2_cmd;
1096                         x->rx_buf = &packet->tc.z2;
1097                         x->len = 3;
1098                         spi_message_add_tail(x, m);
1099                 }
1100         }
1101
1102         /* power down */
1103         ts->msg_count++;
1104         m++;
1105         spi_message_init(m);
1106         m->context = ts;
1107
1108         x++;
1109         packet->pwrdown_cmd.cmd = PWRDOWN;
1110         x->tx_buf = &packet->pwrdown_cmd;
1111         x->len = 3;
1112
1113         CS_CHANGE(*x);
1114         spi_message_add_tail(x, m);
1115 }
1116
1117 #ifdef CONFIG_OF
1118 static const struct of_device_id ads7846_dt_ids[] = {
1119         { .compatible = "ti,tsc2046",   .data = (void *) 7846 },
1120         { .compatible = "ti,ads7843",   .data = (void *) 7843 },
1121         { .compatible = "ti,ads7845",   .data = (void *) 7845 },
1122         { .compatible = "ti,ads7846",   .data = (void *) 7846 },
1123         { .compatible = "ti,ads7873",   .data = (void *) 7873 },
1124         { }
1125 };
1126 MODULE_DEVICE_TABLE(of, ads7846_dt_ids);
1127
1128 static const struct ads7846_platform_data *ads7846_probe_dt(struct device *dev)
1129 {
1130         struct ads7846_platform_data *pdata;
1131         struct device_node *node = dev->of_node;
1132         const struct of_device_id *match;
1133         u32 value;
1134
1135         if (!node) {
1136                 dev_err(dev, "Device does not have associated DT data\n");
1137                 return ERR_PTR(-EINVAL);
1138         }
1139
1140         match = of_match_device(ads7846_dt_ids, dev);
1141         if (!match) {
1142                 dev_err(dev, "Unknown device model\n");
1143                 return ERR_PTR(-EINVAL);
1144         }
1145
1146         pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
1147         if (!pdata)
1148                 return ERR_PTR(-ENOMEM);
1149
1150         pdata->model = (unsigned long)match->data;
1151
1152         of_property_read_u16(node, "ti,vref-delay-usecs",
1153                              &pdata->vref_delay_usecs);
1154         of_property_read_u16(node, "ti,vref-mv", &pdata->vref_mv);
1155         pdata->keep_vref_on = of_property_read_bool(node, "ti,keep-vref-on");
1156
1157         pdata->swap_xy = of_property_read_bool(node, "ti,swap-xy");
1158
1159         of_property_read_u16(node, "ti,settle-delay-usec",
1160                              &pdata->settle_delay_usecs);
1161         of_property_read_u16(node, "ti,penirq-recheck-delay-usecs",
1162                              &pdata->penirq_recheck_delay_usecs);
1163
1164         of_property_read_u16(node, "ti,x-plate-ohms", &pdata->x_plate_ohms);
1165         of_property_read_u16(node, "ti,y-plate-ohms", &pdata->y_plate_ohms);
1166
1167         of_property_read_u16(node, "ti,x-min", &pdata->x_min);
1168         of_property_read_u16(node, "ti,y-min", &pdata->y_min);
1169         of_property_read_u16(node, "ti,x-max", &pdata->x_max);
1170         of_property_read_u16(node, "ti,y-max", &pdata->y_max);
1171
1172         /*
1173          * touchscreen-max-pressure gets parsed during
1174          * touchscreen_parse_properties()
1175          */
1176         of_property_read_u16(node, "ti,pressure-min", &pdata->pressure_min);
1177         if (!of_property_read_u32(node, "touchscreen-min-pressure", &value))
1178                 pdata->pressure_min = (u16) value;
1179         of_property_read_u16(node, "ti,pressure-max", &pdata->pressure_max);
1180
1181         of_property_read_u16(node, "ti,debounce-max", &pdata->debounce_max);
1182         if (!of_property_read_u32(node, "touchscreen-average-samples", &value))
1183                 pdata->debounce_max = (u16) value;
1184         of_property_read_u16(node, "ti,debounce-tol", &pdata->debounce_tol);
1185         of_property_read_u16(node, "ti,debounce-rep", &pdata->debounce_rep);
1186
1187         of_property_read_u32(node, "ti,pendown-gpio-debounce",
1188                              &pdata->gpio_pendown_debounce);
1189
1190         pdata->wakeup = of_property_read_bool(node, "wakeup-source") ||
1191                         of_property_read_bool(node, "linux,wakeup");
1192
1193         pdata->gpio_pendown = of_get_named_gpio(dev->of_node, "pendown-gpio", 0);
1194
1195         return pdata;
1196 }
1197 #else
1198 static const struct ads7846_platform_data *ads7846_probe_dt(struct device *dev)
1199 {
1200         dev_err(dev, "no platform data defined\n");
1201         return ERR_PTR(-EINVAL);
1202 }
1203 #endif
1204
1205 static int ads7846_probe(struct spi_device *spi)
1206 {
1207         const struct ads7846_platform_data *pdata;
1208         struct ads7846 *ts;
1209         struct ads7846_packet *packet;
1210         struct input_dev *input_dev;
1211         unsigned long irq_flags;
1212         int err;
1213
1214         if (!spi->irq) {
1215                 dev_dbg(&spi->dev, "no IRQ?\n");
1216                 return -EINVAL;
1217         }
1218
1219         /* don't exceed max specified sample rate */
1220         if (spi->max_speed_hz > (125000 * SAMPLE_BITS)) {
1221                 dev_err(&spi->dev, "f(sample) %d KHz?\n",
1222                                 (spi->max_speed_hz/SAMPLE_BITS)/1000);
1223                 return -EINVAL;
1224         }
1225
1226         /*
1227          * We'd set TX word size 8 bits and RX word size to 13 bits ... except
1228          * that even if the hardware can do that, the SPI controller driver
1229          * may not.  So we stick to very-portable 8 bit words, both RX and TX.
1230          */
1231         spi->bits_per_word = 8;
1232         spi->mode &= ~SPI_MODE_X_MASK;
1233         spi->mode |= SPI_MODE_0;
1234         err = spi_setup(spi);
1235         if (err < 0)
1236                 return err;
1237
1238         ts = kzalloc(sizeof(struct ads7846), GFP_KERNEL);
1239         packet = kzalloc(sizeof(struct ads7846_packet), GFP_KERNEL);
1240         input_dev = input_allocate_device();
1241         if (!ts || !packet || !input_dev) {
1242                 err = -ENOMEM;
1243                 goto err_free_mem;
1244         }
1245
1246         spi_set_drvdata(spi, ts);
1247
1248         ts->packet = packet;
1249         ts->spi = spi;
1250         ts->input = input_dev;
1251
1252         mutex_init(&ts->lock);
1253         init_waitqueue_head(&ts->wait);
1254
1255         pdata = dev_get_platdata(&spi->dev);
1256         if (!pdata) {
1257                 pdata = ads7846_probe_dt(&spi->dev);
1258                 if (IS_ERR(pdata)) {
1259                         err = PTR_ERR(pdata);
1260                         goto err_free_mem;
1261                 }
1262         }
1263
1264         ts->model = pdata->model ? : 7846;
1265         ts->vref_delay_usecs = pdata->vref_delay_usecs ? : 100;
1266         ts->x_plate_ohms = pdata->x_plate_ohms ? : 400;
1267         ts->vref_mv = pdata->vref_mv;
1268
1269         if (pdata->filter != NULL) {
1270                 if (pdata->filter_init != NULL) {
1271                         err = pdata->filter_init(pdata, &ts->filter_data);
1272                         if (err < 0)
1273                                 goto err_free_mem;
1274                 }
1275                 ts->filter = pdata->filter;
1276                 ts->filter_cleanup = pdata->filter_cleanup;
1277         } else if (pdata->debounce_max) {
1278                 ts->debounce_max = pdata->debounce_max;
1279                 if (ts->debounce_max < 2)
1280                         ts->debounce_max = 2;
1281                 ts->debounce_tol = pdata->debounce_tol;
1282                 ts->debounce_rep = pdata->debounce_rep;
1283                 ts->filter = ads7846_debounce_filter;
1284                 ts->filter_data = ts;
1285         } else {
1286                 ts->filter = ads7846_no_filter;
1287         }
1288
1289         err = ads7846_setup_pendown(spi, ts, pdata);
1290         if (err)
1291                 goto err_cleanup_filter;
1292
1293         if (pdata->penirq_recheck_delay_usecs)
1294                 ts->penirq_recheck_delay_usecs =
1295                                 pdata->penirq_recheck_delay_usecs;
1296
1297         ts->wait_for_sync = pdata->wait_for_sync ? : null_wait_for_sync;
1298
1299         snprintf(ts->phys, sizeof(ts->phys), "%s/input0", dev_name(&spi->dev));
1300         snprintf(ts->name, sizeof(ts->name), "ADS%d Touchscreen", ts->model);
1301
1302         input_dev->name = ts->name;
1303         input_dev->phys = ts->phys;
1304         input_dev->dev.parent = &spi->dev;
1305
1306         input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
1307         input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
1308         input_set_abs_params(input_dev, ABS_X,
1309                         pdata->x_min ? : 0,
1310                         pdata->x_max ? : MAX_12BIT,
1311                         0, 0);
1312         input_set_abs_params(input_dev, ABS_Y,
1313                         pdata->y_min ? : 0,
1314                         pdata->y_max ? : MAX_12BIT,
1315                         0, 0);
1316         input_set_abs_params(input_dev, ABS_PRESSURE,
1317                         pdata->pressure_min, pdata->pressure_max, 0, 0);
1318
1319         /*
1320          * Parse common framework properties. Must be done here to ensure the
1321          * correct behaviour in case of using the legacy vendor bindings. The
1322          * general binding value overrides the vendor specific one.
1323          */
1324         touchscreen_parse_properties(ts->input, false, &ts->core_prop);
1325         ts->pressure_max = input_abs_get_max(input_dev, ABS_PRESSURE) ? : ~0;
1326
1327         /*
1328          * Check if legacy ti,swap-xy binding is used instead of
1329          * touchscreen-swapped-x-y
1330          */
1331         if (!ts->core_prop.swap_x_y && pdata->swap_xy) {
1332                 swap(input_dev->absinfo[ABS_X], input_dev->absinfo[ABS_Y]);
1333                 ts->core_prop.swap_x_y = true;
1334         }
1335
1336         ads7846_setup_spi_msg(ts, pdata);
1337
1338         ts->reg = regulator_get(&spi->dev, "vcc");
1339         if (IS_ERR(ts->reg)) {
1340                 err = PTR_ERR(ts->reg);
1341                 dev_err(&spi->dev, "unable to get regulator: %d\n", err);
1342                 goto err_free_gpio;
1343         }
1344
1345         err = regulator_enable(ts->reg);
1346         if (err) {
1347                 dev_err(&spi->dev, "unable to enable regulator: %d\n", err);
1348                 goto err_put_regulator;
1349         }
1350
1351         irq_flags = pdata->irq_flags ? : IRQF_TRIGGER_FALLING;
1352         irq_flags |= IRQF_ONESHOT;
1353
1354         err = request_threaded_irq(spi->irq, ads7846_hard_irq, ads7846_irq,
1355                                    irq_flags, spi->dev.driver->name, ts);
1356         if (err && !pdata->irq_flags) {
1357                 dev_info(&spi->dev,
1358                         "trying pin change workaround on irq %d\n", spi->irq);
1359                 irq_flags |= IRQF_TRIGGER_RISING;
1360                 err = request_threaded_irq(spi->irq,
1361                                   ads7846_hard_irq, ads7846_irq,
1362                                   irq_flags, spi->dev.driver->name, ts);
1363         }
1364
1365         if (err) {
1366                 dev_dbg(&spi->dev, "irq %d busy?\n", spi->irq);
1367                 goto err_disable_regulator;
1368         }
1369
1370         err = ads784x_hwmon_register(spi, ts);
1371         if (err)
1372                 goto err_free_irq;
1373
1374         dev_info(&spi->dev, "touchscreen, irq %d\n", spi->irq);
1375
1376         /*
1377          * Take a first sample, leaving nPENIRQ active and vREF off; avoid
1378          * the touchscreen, in case it's not connected.
1379          */
1380         if (ts->model == 7845)
1381                 ads7845_read12_ser(&spi->dev, PWRDOWN);
1382         else
1383                 (void) ads7846_read12_ser(&spi->dev, READ_12BIT_SER(vaux));
1384
1385         err = sysfs_create_group(&spi->dev.kobj, &ads784x_attr_group);
1386         if (err)
1387                 goto err_remove_hwmon;
1388
1389         err = input_register_device(input_dev);
1390         if (err)
1391                 goto err_remove_attr_group;
1392
1393         device_init_wakeup(&spi->dev, pdata->wakeup);
1394
1395         /*
1396          * If device does not carry platform data we must have allocated it
1397          * when parsing DT data.
1398          */
1399         if (!dev_get_platdata(&spi->dev))
1400                 devm_kfree(&spi->dev, (void *)pdata);
1401
1402         return 0;
1403
1404  err_remove_attr_group:
1405         sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group);
1406  err_remove_hwmon:
1407         ads784x_hwmon_unregister(spi, ts);
1408  err_free_irq:
1409         free_irq(spi->irq, ts);
1410  err_disable_regulator:
1411         regulator_disable(ts->reg);
1412  err_put_regulator:
1413         regulator_put(ts->reg);
1414  err_free_gpio:
1415         if (!ts->get_pendown_state)
1416                 gpio_free(ts->gpio_pendown);
1417  err_cleanup_filter:
1418         if (ts->filter_cleanup)
1419                 ts->filter_cleanup(ts->filter_data);
1420  err_free_mem:
1421         input_free_device(input_dev);
1422         kfree(packet);
1423         kfree(ts);
1424         return err;
1425 }
1426
1427 static int ads7846_remove(struct spi_device *spi)
1428 {
1429         struct ads7846 *ts = spi_get_drvdata(spi);
1430
1431         sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group);
1432
1433         ads7846_disable(ts);
1434         free_irq(ts->spi->irq, ts);
1435
1436         input_unregister_device(ts->input);
1437
1438         ads784x_hwmon_unregister(spi, ts);
1439
1440         regulator_put(ts->reg);
1441
1442         if (!ts->get_pendown_state) {
1443                 /*
1444                  * If we are not using specialized pendown method we must
1445                  * have been relying on gpio we set up ourselves.
1446                  */
1447                 gpio_free(ts->gpio_pendown);
1448         }
1449
1450         if (ts->filter_cleanup)
1451                 ts->filter_cleanup(ts->filter_data);
1452
1453         kfree(ts->packet);
1454         kfree(ts);
1455
1456         dev_dbg(&spi->dev, "unregistered touchscreen\n");
1457
1458         return 0;
1459 }
1460
1461 static struct spi_driver ads7846_driver = {
1462         .driver = {
1463                 .name   = "ads7846",
1464                 .pm     = &ads7846_pm,
1465                 .of_match_table = of_match_ptr(ads7846_dt_ids),
1466         },
1467         .probe          = ads7846_probe,
1468         .remove         = ads7846_remove,
1469 };
1470
1471 module_spi_driver(ads7846_driver);
1472
1473 MODULE_DESCRIPTION("ADS7846 TouchScreen Driver");
1474 MODULE_LICENSE("GPL");
1475 MODULE_ALIAS("spi:ads7846");