| /* |
| * ADS7846 based touchscreen and sensor driver |
| * |
| * Copyright (c) 2005 David Brownell |
| * Copyright (c) 2006 Nokia Corporation |
| * Various changes: Imre Deak <imre.deak@nokia.com> |
| * |
| * Using code from: |
| * - corgi_ts.c |
| * Copyright (C) 2004-2005 Richard Purdie |
| * - omap_ts.[hc], ads7846.h, ts_osk.c |
| * Copyright (C) 2002 MontaVista Software |
| * Copyright (C) 2004 Texas Instruments |
| * Copyright (C) 2005 Dirk Behme |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| #include <linux/types.h> |
| #include <linux/hwmon.h> |
| #include <linux/err.h> |
| #include <linux/sched.h> |
| #include <linux/delay.h> |
| #include <linux/input.h> |
| #include <linux/interrupt.h> |
| #include <linux/slab.h> |
| #include <linux/pm.h> |
| #include <linux/of.h> |
| #include <linux/of_gpio.h> |
| #include <linux/of_device.h> |
| #include <linux/gpio.h> |
| #include <linux/spi/spi.h> |
| #include <linux/spi/ads7846.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/module.h> |
| #include <asm/irq.h> |
| |
| /* |
| * This code has been heavily tested on a Nokia 770, and lightly |
| * tested on other ads7846 devices (OSK/Mistral, Lubbock, Spitz). |
| * TSC2046 is just newer ads7846 silicon. |
| * Support for ads7843 tested on Atmel at91sam926x-EK. |
| * Support for ads7845 has only been stubbed in. |
| * Support for Analog Devices AD7873 and AD7843 tested. |
| * |
| * IRQ handling needs a workaround because of a shortcoming in handling |
| * edge triggered IRQs on some platforms like the OMAP1/2. These |
| * platforms don't handle the ARM lazy IRQ disabling properly, thus we |
| * have to maintain our own SW IRQ disabled status. This should be |
| * removed as soon as the affected platform's IRQ handling is fixed. |
| * |
| * App note sbaa036 talks in more detail about accurate sampling... |
| * that ought to help in situations like LCDs inducing noise (which |
| * can also be helped by using synch signals) and more generally. |
| * This driver tries to utilize the measures described in the app |
| * note. The strength of filtering can be set in the board-* specific |
| * files. |
| */ |
| |
| #define TS_POLL_DELAY 1 /* ms delay before the first sample */ |
| #define TS_POLL_PERIOD 5 /* ms delay between samples */ |
| |
| /* this driver doesn't aim at the peak continuous sample rate */ |
| #define SAMPLE_BITS (8 /*cmd*/ + 16 /*sample*/ + 2 /* before, after */) |
| |
| struct ts_event { |
| /* |
| * For portability, we can't read 12 bit values using SPI (which |
| * would make the controller deliver them as native byte order u16 |
| * with msbs zeroed). Instead, we read them as two 8-bit values, |
| * *** WHICH NEED BYTESWAPPING *** and range adjustment. |
| */ |
| u16 x; |
| u16 y; |
| u16 z1, z2; |
| bool ignore; |
| u8 x_buf[3]; |
| u8 y_buf[3]; |
| }; |
| |
| /* |
| * We allocate this separately to avoid cache line sharing issues when |
| * driver is used with DMA-based SPI controllers (like atmel_spi) on |
| * systems where main memory is not DMA-coherent (most non-x86 boards). |
| */ |
| struct ads7846_packet { |
| u8 read_x, read_y, read_z1, read_z2, pwrdown; |
| u16 dummy; /* for the pwrdown read */ |
| struct ts_event tc; |
| /* for ads7845 with mpc5121 psc spi we use 3-byte buffers */ |
| u8 read_x_cmd[3], read_y_cmd[3], pwrdown_cmd[3]; |
| }; |
| |
| struct ads7846 { |
| struct input_dev *input; |
| char phys[32]; |
| char name[32]; |
| |
| struct spi_device *spi; |
| struct regulator *reg; |
| |
| #if IS_ENABLED(CONFIG_HWMON) |
| struct device *hwmon; |
| #endif |
| |
| u16 model; |
| u16 vref_mv; |
| u16 vref_delay_usecs; |
| u16 x_plate_ohms; |
| u16 pressure_max; |
| |
| bool swap_xy; |
| bool use_internal; |
| |
| struct ads7846_packet *packet; |
| |
| struct spi_transfer xfer[18]; |
| struct spi_message msg[5]; |
| int msg_count; |
| wait_queue_head_t wait; |
| |
| bool pendown; |
| |
| int read_cnt; |
| int read_rep; |
| int last_read; |
| |
| u16 debounce_max; |
| u16 debounce_tol; |
| u16 debounce_rep; |
| |
| u16 penirq_recheck_delay_usecs; |
| |
| struct mutex lock; |
| bool stopped; /* P: lock */ |
| bool disabled; /* P: lock */ |
| bool suspended; /* P: lock */ |
| |
| int (*filter)(void *data, int data_idx, int *val); |
| void *filter_data; |
| void (*filter_cleanup)(void *data); |
| int (*get_pendown_state)(void); |
| int gpio_pendown; |
| |
| void (*wait_for_sync)(void); |
| }; |
| |
| /* leave chip selected when we're done, for quicker re-select? */ |
| #if 0 |
| #define CS_CHANGE(xfer) ((xfer).cs_change = 1) |
| #else |
| #define CS_CHANGE(xfer) ((xfer).cs_change = 0) |
| #endif |
| |
| /*--------------------------------------------------------------------------*/ |
| |
| /* The ADS7846 has touchscreen and other sensors. |
| * Earlier ads784x chips are somewhat compatible. |
| */ |
| #define ADS_START (1 << 7) |
| #define ADS_A2A1A0_d_y (1 << 4) /* differential */ |
| #define ADS_A2A1A0_d_z1 (3 << 4) /* differential */ |
| #define ADS_A2A1A0_d_z2 (4 << 4) /* differential */ |
| #define ADS_A2A1A0_d_x (5 << 4) /* differential */ |
| #define ADS_A2A1A0_temp0 (0 << 4) /* non-differential */ |
| #define ADS_A2A1A0_vbatt (2 << 4) /* non-differential */ |
| #define ADS_A2A1A0_vaux (6 << 4) /* non-differential */ |
| #define ADS_A2A1A0_temp1 (7 << 4) /* non-differential */ |
| #define ADS_8_BIT (1 << 3) |
| #define ADS_12_BIT (0 << 3) |
| #define ADS_SER (1 << 2) /* non-differential */ |
| #define ADS_DFR (0 << 2) /* differential */ |
| #define ADS_PD10_PDOWN (0 << 0) /* low power mode + penirq */ |
| #define ADS_PD10_ADC_ON (1 << 0) /* ADC on */ |
| #define ADS_PD10_REF_ON (2 << 0) /* vREF on + penirq */ |
| #define ADS_PD10_ALL_ON (3 << 0) /* ADC + vREF on */ |
| |
| #define MAX_12BIT ((1<<12)-1) |
| |
| /* leave ADC powered up (disables penirq) between differential samples */ |
| #define READ_12BIT_DFR(x, adc, vref) (ADS_START | ADS_A2A1A0_d_ ## x \ |
| | ADS_12_BIT | ADS_DFR | \ |
| (adc ? ADS_PD10_ADC_ON : 0) | (vref ? ADS_PD10_REF_ON : 0)) |
| |
| #define READ_Y(vref) (READ_12BIT_DFR(y, 1, vref)) |
| #define READ_Z1(vref) (READ_12BIT_DFR(z1, 1, vref)) |
| #define READ_Z2(vref) (READ_12BIT_DFR(z2, 1, vref)) |
| |
| #define READ_X(vref) (READ_12BIT_DFR(x, 1, vref)) |
| #define PWRDOWN (READ_12BIT_DFR(y, 0, 0)) /* LAST */ |
| |
| /* single-ended samples need to first power up reference voltage; |
| * we leave both ADC and VREF powered |
| */ |
| #define READ_12BIT_SER(x) (ADS_START | ADS_A2A1A0_ ## x \ |
| | ADS_12_BIT | ADS_SER) |
| |
| #define REF_ON (READ_12BIT_DFR(x, 1, 1)) |
| #define REF_OFF (READ_12BIT_DFR(y, 0, 0)) |
| |
| /* Must be called with ts->lock held */ |
| static void ads7846_stop(struct ads7846 *ts) |
| { |
| if (!ts->disabled && !ts->suspended) { |
| /* Signal IRQ thread to stop polling and disable the handler. */ |
| ts->stopped = true; |
| mb(); |
| wake_up(&ts->wait); |
| disable_irq(ts->spi->irq); |
| } |
| } |
| |
| /* Must be called with ts->lock held */ |
| static void ads7846_restart(struct ads7846 *ts) |
| { |
| if (!ts->disabled && !ts->suspended) { |
| /* Tell IRQ thread that it may poll the device. */ |
| ts->stopped = false; |
| mb(); |
| enable_irq(ts->spi->irq); |
| } |
| } |
| |
| /* Must be called with ts->lock held */ |
| static void __ads7846_disable(struct ads7846 *ts) |
| { |
| ads7846_stop(ts); |
| regulator_disable(ts->reg); |
| |
| /* |
| * We know the chip's in low power mode since we always |
| * leave it that way after every request |
| */ |
| } |
| |
| /* Must be called with ts->lock held */ |
| static void __ads7846_enable(struct ads7846 *ts) |
| { |
| int error; |
| |
| error = regulator_enable(ts->reg); |
| if (error != 0) |
| dev_err(&ts->spi->dev, "Failed to enable supply: %d\n", error); |
| |
| ads7846_restart(ts); |
| } |
| |
| static void ads7846_disable(struct ads7846 *ts) |
| { |
| mutex_lock(&ts->lock); |
| |
| if (!ts->disabled) { |
| |
| if (!ts->suspended) |
| __ads7846_disable(ts); |
| |
| ts->disabled = true; |
| } |
| |
| mutex_unlock(&ts->lock); |
| } |
| |
| static void ads7846_enable(struct ads7846 *ts) |
| { |
| mutex_lock(&ts->lock); |
| |
| if (ts->disabled) { |
| |
| ts->disabled = false; |
| |
| if (!ts->suspended) |
| __ads7846_enable(ts); |
| } |
| |
| mutex_unlock(&ts->lock); |
| } |
| |
| /*--------------------------------------------------------------------------*/ |
| |
| /* |
| * Non-touchscreen sensors only use single-ended conversions. |
| * The range is GND..vREF. The ads7843 and ads7835 must use external vREF; |
| * ads7846 lets that pin be unconnected, to use internal vREF. |
| */ |
| |
| struct ser_req { |
| u8 ref_on; |
| u8 command; |
| u8 ref_off; |
| u16 scratch; |
| struct spi_message msg; |
| struct spi_transfer xfer[6]; |
| /* |
| * DMA (thus cache coherency maintenance) requires the |
| * transfer buffers to live in their own cache lines. |
| */ |
| __be16 sample ____cacheline_aligned; |
| }; |
| |
| struct ads7845_ser_req { |
| u8 command[3]; |
| struct spi_message msg; |
| struct spi_transfer xfer[2]; |
| /* |
| * DMA (thus cache coherency maintenance) requires the |
| * transfer buffers to live in their own cache lines. |
| */ |
| u8 sample[3] ____cacheline_aligned; |
| }; |
| |
| static int ads7846_read12_ser(struct device *dev, unsigned command) |
| { |
| struct spi_device *spi = to_spi_device(dev); |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| struct ser_req *req; |
| int status; |
| |
| req = kzalloc(sizeof *req, GFP_KERNEL); |
| if (!req) |
| return -ENOMEM; |
| |
| spi_message_init(&req->msg); |
| |
| /* maybe turn on internal vREF, and let it settle */ |
| if (ts->use_internal) { |
| req->ref_on = REF_ON; |
| req->xfer[0].tx_buf = &req->ref_on; |
| req->xfer[0].len = 1; |
| spi_message_add_tail(&req->xfer[0], &req->msg); |
| |
| req->xfer[1].rx_buf = &req->scratch; |
| req->xfer[1].len = 2; |
| |
| /* for 1uF, settle for 800 usec; no cap, 100 usec. */ |
| req->xfer[1].delay_usecs = ts->vref_delay_usecs; |
| spi_message_add_tail(&req->xfer[1], &req->msg); |
| |
| /* Enable reference voltage */ |
| command |= ADS_PD10_REF_ON; |
| } |
| |
| /* Enable ADC in every case */ |
| command |= ADS_PD10_ADC_ON; |
| |
| /* take sample */ |
| req->command = (u8) command; |
| req->xfer[2].tx_buf = &req->command; |
| req->xfer[2].len = 1; |
| spi_message_add_tail(&req->xfer[2], &req->msg); |
| |
| req->xfer[3].rx_buf = &req->sample; |
| req->xfer[3].len = 2; |
| spi_message_add_tail(&req->xfer[3], &req->msg); |
| |
| /* REVISIT: take a few more samples, and compare ... */ |
| |
| /* converter in low power mode & enable PENIRQ */ |
| req->ref_off = PWRDOWN; |
| req->xfer[4].tx_buf = &req->ref_off; |
| req->xfer[4].len = 1; |
| spi_message_add_tail(&req->xfer[4], &req->msg); |
| |
| req->xfer[5].rx_buf = &req->scratch; |
| req->xfer[5].len = 2; |
| CS_CHANGE(req->xfer[5]); |
| spi_message_add_tail(&req->xfer[5], &req->msg); |
| |
| mutex_lock(&ts->lock); |
| ads7846_stop(ts); |
| status = spi_sync(spi, &req->msg); |
| ads7846_restart(ts); |
| mutex_unlock(&ts->lock); |
| |
| if (status == 0) { |
| /* on-wire is a must-ignore bit, a BE12 value, then padding */ |
| status = be16_to_cpu(req->sample); |
| status = status >> 3; |
| status &= 0x0fff; |
| } |
| |
| kfree(req); |
| return status; |
| } |
| |
| static int ads7845_read12_ser(struct device *dev, unsigned command) |
| { |
| struct spi_device *spi = to_spi_device(dev); |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| struct ads7845_ser_req *req; |
| int status; |
| |
| req = kzalloc(sizeof *req, GFP_KERNEL); |
| if (!req) |
| return -ENOMEM; |
| |
| spi_message_init(&req->msg); |
| |
| req->command[0] = (u8) command; |
| req->xfer[0].tx_buf = req->command; |
| req->xfer[0].rx_buf = req->sample; |
| req->xfer[0].len = 3; |
| spi_message_add_tail(&req->xfer[0], &req->msg); |
| |
| mutex_lock(&ts->lock); |
| ads7846_stop(ts); |
| status = spi_sync(spi, &req->msg); |
| ads7846_restart(ts); |
| mutex_unlock(&ts->lock); |
| |
| if (status == 0) { |
| /* BE12 value, then padding */ |
| status = be16_to_cpu(*((u16 *)&req->sample[1])); |
| status = status >> 3; |
| status &= 0x0fff; |
| } |
| |
| kfree(req); |
| return status; |
| } |
| |
| #if IS_ENABLED(CONFIG_HWMON) |
| |
| #define SHOW(name, var, adjust) static ssize_t \ |
| name ## _show(struct device *dev, struct device_attribute *attr, char *buf) \ |
| { \ |
| struct ads7846 *ts = dev_get_drvdata(dev); \ |
| ssize_t v = ads7846_read12_ser(dev, \ |
| READ_12BIT_SER(var)); \ |
| if (v < 0) \ |
| return v; \ |
| return sprintf(buf, "%u\n", adjust(ts, v)); \ |
| } \ |
| static DEVICE_ATTR(name, S_IRUGO, name ## _show, NULL); |
| |
| |
| /* Sysfs conventions report temperatures in millidegrees Celsius. |
| * ADS7846 could use the low-accuracy two-sample scheme, but can't do the high |
| * accuracy scheme without calibration data. For now we won't try either; |
| * userspace sees raw sensor values, and must scale/calibrate appropriately. |
| */ |
| static inline unsigned null_adjust(struct ads7846 *ts, ssize_t v) |
| { |
| return v; |
| } |
| |
| SHOW(temp0, temp0, null_adjust) /* temp1_input */ |
| SHOW(temp1, temp1, null_adjust) /* temp2_input */ |
| |
| |
| /* sysfs conventions report voltages in millivolts. We can convert voltages |
| * if we know vREF. userspace may need to scale vAUX to match the board's |
| * external resistors; we assume that vBATT only uses the internal ones. |
| */ |
| static inline unsigned vaux_adjust(struct ads7846 *ts, ssize_t v) |
| { |
| unsigned retval = v; |
| |
| /* external resistors may scale vAUX into 0..vREF */ |
| retval *= ts->vref_mv; |
| retval = retval >> 12; |
| |
| return retval; |
| } |
| |
| static inline unsigned vbatt_adjust(struct ads7846 *ts, ssize_t v) |
| { |
| unsigned retval = vaux_adjust(ts, v); |
| |
| /* ads7846 has a resistor ladder to scale this signal down */ |
| if (ts->model == 7846) |
| retval *= 4; |
| |
| return retval; |
| } |
| |
| SHOW(in0_input, vaux, vaux_adjust) |
| SHOW(in1_input, vbatt, vbatt_adjust) |
| |
| static umode_t ads7846_is_visible(struct kobject *kobj, struct attribute *attr, |
| int index) |
| { |
| struct device *dev = container_of(kobj, struct device, kobj); |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| |
| if (ts->model == 7843 && index < 2) /* in0, in1 */ |
| return 0; |
| if (ts->model == 7845 && index != 2) /* in0 */ |
| return 0; |
| |
| return attr->mode; |
| } |
| |
| static struct attribute *ads7846_attributes[] = { |
| &dev_attr_temp0.attr, /* 0 */ |
| &dev_attr_temp1.attr, /* 1 */ |
| &dev_attr_in0_input.attr, /* 2 */ |
| &dev_attr_in1_input.attr, /* 3 */ |
| NULL, |
| }; |
| |
| static struct attribute_group ads7846_attr_group = { |
| .attrs = ads7846_attributes, |
| .is_visible = ads7846_is_visible, |
| }; |
| __ATTRIBUTE_GROUPS(ads7846_attr); |
| |
| static int ads784x_hwmon_register(struct spi_device *spi, struct ads7846 *ts) |
| { |
| /* hwmon sensors need a reference voltage */ |
| switch (ts->model) { |
| case 7846: |
| if (!ts->vref_mv) { |
| dev_dbg(&spi->dev, "assuming 2.5V internal vREF\n"); |
| ts->vref_mv = 2500; |
| ts->use_internal = true; |
| } |
| break; |
| case 7845: |
| case 7843: |
| if (!ts->vref_mv) { |
| dev_warn(&spi->dev, |
| "external vREF for ADS%d not specified\n", |
| ts->model); |
| return 0; |
| } |
| break; |
| } |
| |
| ts->hwmon = hwmon_device_register_with_groups(&spi->dev, spi->modalias, |
| ts, ads7846_attr_groups); |
| if (IS_ERR(ts->hwmon)) |
| return PTR_ERR(ts->hwmon); |
| |
| return 0; |
| } |
| |
| static void ads784x_hwmon_unregister(struct spi_device *spi, |
| struct ads7846 *ts) |
| { |
| if (ts->hwmon) |
| hwmon_device_unregister(ts->hwmon); |
| } |
| |
| #else |
| static inline int ads784x_hwmon_register(struct spi_device *spi, |
| struct ads7846 *ts) |
| { |
| return 0; |
| } |
| |
| static inline void ads784x_hwmon_unregister(struct spi_device *spi, |
| struct ads7846 *ts) |
| { |
| } |
| #endif |
| |
| static ssize_t ads7846_pen_down_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| |
| return sprintf(buf, "%u\n", ts->pendown); |
| } |
| |
| static DEVICE_ATTR(pen_down, S_IRUGO, ads7846_pen_down_show, NULL); |
| |
| static ssize_t ads7846_disable_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| |
| return sprintf(buf, "%u\n", ts->disabled); |
| } |
| |
| static ssize_t ads7846_disable_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| unsigned int i; |
| int err; |
| |
| err = kstrtouint(buf, 10, &i); |
| if (err) |
| return err; |
| |
| if (i) |
| ads7846_disable(ts); |
| else |
| ads7846_enable(ts); |
| |
| return count; |
| } |
| |
| static DEVICE_ATTR(disable, 0664, ads7846_disable_show, ads7846_disable_store); |
| |
| static struct attribute *ads784x_attributes[] = { |
| &dev_attr_pen_down.attr, |
| &dev_attr_disable.attr, |
| NULL, |
| }; |
| |
| static struct attribute_group ads784x_attr_group = { |
| .attrs = ads784x_attributes, |
| }; |
| |
| /*--------------------------------------------------------------------------*/ |
| |
| static int get_pendown_state(struct ads7846 *ts) |
| { |
| if (ts->get_pendown_state) |
| return ts->get_pendown_state(); |
| |
| return !gpio_get_value(ts->gpio_pendown); |
| } |
| |
| static void null_wait_for_sync(void) |
| { |
| } |
| |
| static int ads7846_debounce_filter(void *ads, int data_idx, int *val) |
| { |
| struct ads7846 *ts = ads; |
| |
| if (!ts->read_cnt || (abs(ts->last_read - *val) > ts->debounce_tol)) { |
| /* Start over collecting consistent readings. */ |
| ts->read_rep = 0; |
| /* |
| * Repeat it, if this was the first read or the read |
| * wasn't consistent enough. |
| */ |
| if (ts->read_cnt < ts->debounce_max) { |
| ts->last_read = *val; |
| ts->read_cnt++; |
| return ADS7846_FILTER_REPEAT; |
| } else { |
| /* |
| * Maximum number of debouncing reached and still |
| * not enough number of consistent readings. Abort |
| * the whole sample, repeat it in the next sampling |
| * period. |
| */ |
| ts->read_cnt = 0; |
| return ADS7846_FILTER_IGNORE; |
| } |
| } else { |
| if (++ts->read_rep > ts->debounce_rep) { |
| /* |
| * Got a good reading for this coordinate, |
| * go for the next one. |
| */ |
| ts->read_cnt = 0; |
| ts->read_rep = 0; |
| return ADS7846_FILTER_OK; |
| } else { |
| /* Read more values that are consistent. */ |
| ts->read_cnt++; |
| return ADS7846_FILTER_REPEAT; |
| } |
| } |
| } |
| |
| static int ads7846_no_filter(void *ads, int data_idx, int *val) |
| { |
| return ADS7846_FILTER_OK; |
| } |
| |
| static int ads7846_get_value(struct ads7846 *ts, struct spi_message *m) |
| { |
| struct spi_transfer *t = |
| list_entry(m->transfers.prev, struct spi_transfer, transfer_list); |
| |
| if (ts->model == 7845) { |
| return be16_to_cpup((__be16 *)&(((char*)t->rx_buf)[1])) >> 3; |
| } else { |
| /* |
| * adjust: on-wire is a must-ignore bit, a BE12 value, then |
| * padding; built from two 8 bit values written msb-first. |
| */ |
| return be16_to_cpup((__be16 *)t->rx_buf) >> 3; |
| } |
| } |
| |
| static void ads7846_update_value(struct spi_message *m, int val) |
| { |
| struct spi_transfer *t = |
| list_entry(m->transfers.prev, struct spi_transfer, transfer_list); |
| |
| *(u16 *)t->rx_buf = val; |
| } |
| |
| static void ads7846_read_state(struct ads7846 *ts) |
| { |
| struct ads7846_packet *packet = ts->packet; |
| struct spi_message *m; |
| int msg_idx = 0; |
| int val; |
| int action; |
| int error; |
| |
| while (msg_idx < ts->msg_count) { |
| |
| ts->wait_for_sync(); |
| |
| m = &ts->msg[msg_idx]; |
| error = spi_sync(ts->spi, m); |
| if (error) { |
| dev_err(&ts->spi->dev, "spi_async --> %d\n", error); |
| packet->tc.ignore = true; |
| return; |
| } |
| |
| /* |
| * Last message is power down request, no need to convert |
| * or filter the value. |
| */ |
| if (msg_idx < ts->msg_count - 1) { |
| |
| val = ads7846_get_value(ts, m); |
| |
| action = ts->filter(ts->filter_data, msg_idx, &val); |
| switch (action) { |
| case ADS7846_FILTER_REPEAT: |
| continue; |
| |
| case ADS7846_FILTER_IGNORE: |
| packet->tc.ignore = true; |
| msg_idx = ts->msg_count - 1; |
| continue; |
| |
| case ADS7846_FILTER_OK: |
| ads7846_update_value(m, val); |
| packet->tc.ignore = false; |
| msg_idx++; |
| break; |
| |
| default: |
| BUG(); |
| } |
| } else { |
| msg_idx++; |
| } |
| } |
| } |
| |
| static void ads7846_report_state(struct ads7846 *ts) |
| { |
| struct ads7846_packet *packet = ts->packet; |
| unsigned int Rt; |
| u16 x, y, z1, z2; |
| |
| /* |
| * ads7846_get_value() does in-place conversion (including byte swap) |
| * from on-the-wire format as part of debouncing to get stable |
| * readings. |
| */ |
| if (ts->model == 7845) { |
| x = *(u16 *)packet->tc.x_buf; |
| y = *(u16 *)packet->tc.y_buf; |
| z1 = 0; |
| z2 = 0; |
| } else { |
| x = packet->tc.x; |
| y = packet->tc.y; |
| z1 = packet->tc.z1; |
| z2 = packet->tc.z2; |
| } |
| |
| /* range filtering */ |
| if (x == MAX_12BIT) |
| x = 0; |
| |
| if (ts->model == 7843) { |
| Rt = ts->pressure_max / 2; |
| } else if (ts->model == 7845) { |
| if (get_pendown_state(ts)) |
| Rt = ts->pressure_max / 2; |
| else |
| Rt = 0; |
| dev_vdbg(&ts->spi->dev, "x/y: %d/%d, PD %d\n", x, y, Rt); |
| } else if (likely(x && z1)) { |
| /* compute touch pressure resistance using equation #2 */ |
| Rt = z2; |
| Rt -= z1; |
| Rt *= x; |
| Rt *= ts->x_plate_ohms; |
| Rt /= z1; |
| Rt = (Rt + 2047) >> 12; |
| } else { |
| Rt = 0; |
| } |
| |
| /* |
| * Sample found inconsistent by debouncing or pressure is beyond |
| * the maximum. Don't report it to user space, repeat at least |
| * once more the measurement |
| */ |
| if (packet->tc.ignore || Rt > ts->pressure_max) { |
| dev_vdbg(&ts->spi->dev, "ignored %d pressure %d\n", |
| packet->tc.ignore, Rt); |
| return; |
| } |
| |
| /* |
| * Maybe check the pendown state before reporting. This discards |
| * false readings when the pen is lifted. |
| */ |
| if (ts->penirq_recheck_delay_usecs) { |
| udelay(ts->penirq_recheck_delay_usecs); |
| if (!get_pendown_state(ts)) |
| Rt = 0; |
| } |
| |
| /* |
| * NOTE: We can't rely on the pressure to determine the pen down |
| * state, even this controller has a pressure sensor. The pressure |
| * value can fluctuate for quite a while after lifting the pen and |
| * in some cases may not even settle at the expected value. |
| * |
| * The only safe way to check for the pen up condition is in the |
| * timer by reading the pen signal state (it's a GPIO _and_ IRQ). |
| */ |
| if (Rt) { |
| struct input_dev *input = ts->input; |
| |
| if (ts->swap_xy) |
| swap(x, y); |
| |
| if (!ts->pendown) { |
| input_report_key(input, BTN_TOUCH, 1); |
| ts->pendown = true; |
| dev_vdbg(&ts->spi->dev, "DOWN\n"); |
| } |
| |
| input_report_abs(input, ABS_X, x); |
| input_report_abs(input, ABS_Y, y); |
| input_report_abs(input, ABS_PRESSURE, ts->pressure_max - Rt); |
| |
| input_sync(input); |
| dev_vdbg(&ts->spi->dev, "%4d/%4d/%4d\n", x, y, Rt); |
| } |
| } |
| |
| static irqreturn_t ads7846_hard_irq(int irq, void *handle) |
| { |
| struct ads7846 *ts = handle; |
| |
| return get_pendown_state(ts) ? IRQ_WAKE_THREAD : IRQ_HANDLED; |
| } |
| |
| |
| static irqreturn_t ads7846_irq(int irq, void *handle) |
| { |
| struct ads7846 *ts = handle; |
| |
| /* Start with a small delay before checking pendown state */ |
| msleep(TS_POLL_DELAY); |
| |
| while (!ts->stopped && get_pendown_state(ts)) { |
| |
| /* pen is down, continue with the measurement */ |
| ads7846_read_state(ts); |
| |
| if (!ts->stopped) |
| ads7846_report_state(ts); |
| |
| wait_event_timeout(ts->wait, ts->stopped, |
| msecs_to_jiffies(TS_POLL_PERIOD)); |
| } |
| |
| if (ts->pendown) { |
| struct input_dev *input = ts->input; |
| |
| input_report_key(input, BTN_TOUCH, 0); |
| input_report_abs(input, ABS_PRESSURE, 0); |
| input_sync(input); |
| |
| ts->pendown = false; |
| dev_vdbg(&ts->spi->dev, "UP\n"); |
| } |
| |
| return IRQ_HANDLED; |
| } |
| |
| #ifdef CONFIG_PM_SLEEP |
| static int ads7846_suspend(struct device *dev) |
| { |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| |
| mutex_lock(&ts->lock); |
| |
| if (!ts->suspended) { |
| |
| if (!ts->disabled) |
| __ads7846_disable(ts); |
| |
| if (device_may_wakeup(&ts->spi->dev)) |
| enable_irq_wake(ts->spi->irq); |
| |
| ts->suspended = true; |
| } |
| |
| mutex_unlock(&ts->lock); |
| |
| return 0; |
| } |
| |
| static int ads7846_resume(struct device *dev) |
| { |
| struct ads7846 *ts = dev_get_drvdata(dev); |
| |
| mutex_lock(&ts->lock); |
| |
| if (ts->suspended) { |
| |
| ts->suspended = false; |
| |
| if (device_may_wakeup(&ts->spi->dev)) |
| disable_irq_wake(ts->spi->irq); |
| |
| if (!ts->disabled) |
| __ads7846_enable(ts); |
| } |
| |
| mutex_unlock(&ts->lock); |
| |
| return 0; |
| } |
| #endif |
| |
| static SIMPLE_DEV_PM_OPS(ads7846_pm, ads7846_suspend, ads7846_resume); |
| |
| static int ads7846_setup_pendown(struct spi_device *spi, |
| struct ads7846 *ts, |
| const struct ads7846_platform_data *pdata) |
| { |
| int err; |
| |
| /* |
| * REVISIT when the irq can be triggered active-low, or if for some |
| * reason the touchscreen isn't hooked up, we don't need to access |
| * the pendown state. |
| */ |
| |
| if (pdata->get_pendown_state) { |
| ts->get_pendown_state = pdata->get_pendown_state; |
| } else if (gpio_is_valid(pdata->gpio_pendown)) { |
| |
| err = gpio_request_one(pdata->gpio_pendown, GPIOF_IN, |
| "ads7846_pendown"); |
| if (err) { |
| dev_err(&spi->dev, |
| "failed to request/setup pendown GPIO%d: %d\n", |
| pdata->gpio_pendown, err); |
| return err; |
| } |
| |
| ts->gpio_pendown = pdata->gpio_pendown; |
| |
| if (pdata->gpio_pendown_debounce) |
| gpio_set_debounce(pdata->gpio_pendown, |
| pdata->gpio_pendown_debounce); |
| } else { |
| dev_err(&spi->dev, "no get_pendown_state nor gpio_pendown?\n"); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * Set up the transfers to read touchscreen state; this assumes we |
| * use formula #2 for pressure, not #3. |
| */ |
| static void ads7846_setup_spi_msg(struct ads7846 *ts, |
| const struct ads7846_platform_data *pdata) |
| { |
| struct spi_message *m = &ts->msg[0]; |
| struct spi_transfer *x = ts->xfer; |
| struct ads7846_packet *packet = ts->packet; |
| int vref = pdata->keep_vref_on; |
| |
| if (ts->model == 7873) { |
| /* |
| * The AD7873 is almost identical to the ADS7846 |
| * keep VREF off during differential/ratiometric |
| * conversion modes. |
| */ |
| ts->model = 7846; |
| vref = 0; |
| } |
| |
| ts->msg_count = 1; |
| spi_message_init(m); |
| m->context = ts; |
| |
| if (ts->model == 7845) { |
| packet->read_y_cmd[0] = READ_Y(vref); |
| packet->read_y_cmd[1] = 0; |
| packet->read_y_cmd[2] = 0; |
| x->tx_buf = &packet->read_y_cmd[0]; |
| x->rx_buf = &packet->tc.y_buf[0]; |
| x->len = 3; |
| spi_message_add_tail(x, m); |
| } else { |
| /* y- still on; turn on only y+ (and ADC) */ |
| packet->read_y = READ_Y(vref); |
| x->tx_buf = &packet->read_y; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.y; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| |
| /* |
| * The first sample after switching drivers can be low quality; |
| * optionally discard it, using a second one after the signals |
| * have had enough time to stabilize. |
| */ |
| if (pdata->settle_delay_usecs) { |
| x->delay_usecs = pdata->settle_delay_usecs; |
| |
| x++; |
| x->tx_buf = &packet->read_y; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.y; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| |
| ts->msg_count++; |
| m++; |
| spi_message_init(m); |
| m->context = ts; |
| |
| if (ts->model == 7845) { |
| x++; |
| packet->read_x_cmd[0] = READ_X(vref); |
| packet->read_x_cmd[1] = 0; |
| packet->read_x_cmd[2] = 0; |
| x->tx_buf = &packet->read_x_cmd[0]; |
| x->rx_buf = &packet->tc.x_buf[0]; |
| x->len = 3; |
| spi_message_add_tail(x, m); |
| } else { |
| /* turn y- off, x+ on, then leave in lowpower */ |
| x++; |
| packet->read_x = READ_X(vref); |
| x->tx_buf = &packet->read_x; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.x; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| |
| /* ... maybe discard first sample ... */ |
| if (pdata->settle_delay_usecs) { |
| x->delay_usecs = pdata->settle_delay_usecs; |
| |
| x++; |
| x->tx_buf = &packet->read_x; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.x; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| |
| /* turn y+ off, x- on; we'll use formula #2 */ |
| if (ts->model == 7846) { |
| ts->msg_count++; |
| m++; |
| spi_message_init(m); |
| m->context = ts; |
| |
| x++; |
| packet->read_z1 = READ_Z1(vref); |
| x->tx_buf = &packet->read_z1; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.z1; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| |
| /* ... maybe discard first sample ... */ |
| if (pdata->settle_delay_usecs) { |
| x->delay_usecs = pdata->settle_delay_usecs; |
| |
| x++; |
| x->tx_buf = &packet->read_z1; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.z1; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| |
| ts->msg_count++; |
| m++; |
| spi_message_init(m); |
| m->context = ts; |
| |
| x++; |
| packet->read_z2 = READ_Z2(vref); |
| x->tx_buf = &packet->read_z2; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.z2; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| |
| /* ... maybe discard first sample ... */ |
| if (pdata->settle_delay_usecs) { |
| x->delay_usecs = pdata->settle_delay_usecs; |
| |
| x++; |
| x->tx_buf = &packet->read_z2; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->tc.z2; |
| x->len = 2; |
| spi_message_add_tail(x, m); |
| } |
| } |
| |
| /* power down */ |
| ts->msg_count++; |
| m++; |
| spi_message_init(m); |
| m->context = ts; |
| |
| if (ts->model == 7845) { |
| x++; |
| packet->pwrdown_cmd[0] = PWRDOWN; |
| packet->pwrdown_cmd[1] = 0; |
| packet->pwrdown_cmd[2] = 0; |
| x->tx_buf = &packet->pwrdown_cmd[0]; |
| x->len = 3; |
| } else { |
| x++; |
| packet->pwrdown = PWRDOWN; |
| x->tx_buf = &packet->pwrdown; |
| x->len = 1; |
| spi_message_add_tail(x, m); |
| |
| x++; |
| x->rx_buf = &packet->dummy; |
| x->len = 2; |
| } |
| |
| CS_CHANGE(*x); |
| spi_message_add_tail(x, m); |
| } |
| |
| #ifdef CONFIG_OF |
| static const struct of_device_id ads7846_dt_ids[] = { |
| { .compatible = "ti,tsc2046", .data = (void *) 7846 }, |
| { .compatible = "ti,ads7843", .data = (void *) 7843 }, |
| { .compatible = "ti,ads7845", .data = (void *) 7845 }, |
| { .compatible = "ti,ads7846", .data = (void *) 7846 }, |
| { .compatible = "ti,ads7873", .data = (void *) 7873 }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(of, ads7846_dt_ids); |
| |
| static const struct ads7846_platform_data *ads7846_probe_dt(struct device *dev) |
| { |
| struct ads7846_platform_data *pdata; |
| struct device_node *node = dev->of_node; |
| const struct of_device_id *match; |
| |
| if (!node) { |
| dev_err(dev, "Device does not have associated DT data\n"); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| match = of_match_device(ads7846_dt_ids, dev); |
| if (!match) { |
| dev_err(dev, "Unknown device model\n"); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); |
| if (!pdata) |
| return ERR_PTR(-ENOMEM); |
| |
| pdata->model = (unsigned long)match->data; |
| |
| of_property_read_u16(node, "ti,vref-delay-usecs", |
| &pdata->vref_delay_usecs); |
| of_property_read_u16(node, "ti,vref-mv", &pdata->vref_mv); |
| pdata->keep_vref_on = of_property_read_bool(node, "ti,keep-vref-on"); |
| |
| pdata->swap_xy = of_property_read_bool(node, "ti,swap-xy"); |
| |
| of_property_read_u16(node, "ti,settle-delay-usec", |
| &pdata->settle_delay_usecs); |
| of_property_read_u16(node, "ti,penirq-recheck-delay-usecs", |
| &pdata->penirq_recheck_delay_usecs); |
| |
| of_property_read_u16(node, "ti,x-plate-ohms", &pdata->x_plate_ohms); |
| of_property_read_u16(node, "ti,y-plate-ohms", &pdata->y_plate_ohms); |
| |
| of_property_read_u16(node, "ti,x-min", &pdata->x_min); |
| of_property_read_u16(node, "ti,y-min", &pdata->y_min); |
| of_property_read_u16(node, "ti,x-max", &pdata->x_max); |
| of_property_read_u16(node, "ti,y-max", &pdata->y_max); |
| |
| of_property_read_u16(node, "ti,pressure-min", &pdata->pressure_min); |
| of_property_read_u16(node, "ti,pressure-max", &pdata->pressure_max); |
| |
| of_property_read_u16(node, "ti,debounce-max", &pdata->debounce_max); |
| of_property_read_u16(node, "ti,debounce-tol", &pdata->debounce_tol); |
| of_property_read_u16(node, "ti,debounce-rep", &pdata->debounce_rep); |
| |
| of_property_read_u32(node, "ti,pendown-gpio-debounce", |
| &pdata->gpio_pendown_debounce); |
| |
| pdata->wakeup = of_property_read_bool(node, "linux,wakeup"); |
| |
| pdata->gpio_pendown = of_get_named_gpio(dev->of_node, "pendown-gpio", 0); |
| |
| return pdata; |
| } |
| #else |
| static const struct ads7846_platform_data *ads7846_probe_dt(struct device *dev) |
| { |
| dev_err(dev, "no platform data defined\n"); |
| return ERR_PTR(-EINVAL); |
| } |
| #endif |
| |
| static int ads7846_probe(struct spi_device *spi) |
| { |
| const struct ads7846_platform_data *pdata; |
| struct ads7846 *ts; |
| struct ads7846_packet *packet; |
| struct input_dev *input_dev; |
| unsigned long irq_flags; |
| int err; |
| |
| if (!spi->irq) { |
| dev_dbg(&spi->dev, "no IRQ?\n"); |
| return -EINVAL; |
| } |
| |
| /* don't exceed max specified sample rate */ |
| if (spi->max_speed_hz > (125000 * SAMPLE_BITS)) { |
| dev_err(&spi->dev, "f(sample) %d KHz?\n", |
| (spi->max_speed_hz/SAMPLE_BITS)/1000); |
| return -EINVAL; |
| } |
| |
| /* |
| * We'd set TX word size 8 bits and RX word size to 13 bits ... except |
| * that even if the hardware can do that, the SPI controller driver |
| * may not. So we stick to very-portable 8 bit words, both RX and TX. |
| */ |
| spi->bits_per_word = 8; |
| spi->mode = SPI_MODE_0; |
| err = spi_setup(spi); |
| if (err < 0) |
| return err; |
| |
| ts = kzalloc(sizeof(struct ads7846), GFP_KERNEL); |
| packet = kzalloc(sizeof(struct ads7846_packet), GFP_KERNEL); |
| input_dev = input_allocate_device(); |
| if (!ts || !packet || !input_dev) { |
| err = -ENOMEM; |
| goto err_free_mem; |
| } |
| |
| spi_set_drvdata(spi, ts); |
| |
| ts->packet = packet; |
| ts->spi = spi; |
| ts->input = input_dev; |
| |
| mutex_init(&ts->lock); |
| init_waitqueue_head(&ts->wait); |
| |
| pdata = dev_get_platdata(&spi->dev); |
| if (!pdata) { |
| pdata = ads7846_probe_dt(&spi->dev); |
| if (IS_ERR(pdata)) |
| return PTR_ERR(pdata); |
| } |
| |
| ts->model = pdata->model ? : 7846; |
| ts->vref_delay_usecs = pdata->vref_delay_usecs ? : 100; |
| ts->x_plate_ohms = pdata->x_plate_ohms ? : 400; |
| ts->pressure_max = pdata->pressure_max ? : ~0; |
| |
| ts->vref_mv = pdata->vref_mv; |
| ts->swap_xy = pdata->swap_xy; |
| |
| if (pdata->filter != NULL) { |
| if (pdata->filter_init != NULL) { |
| err = pdata->filter_init(pdata, &ts->filter_data); |
| if (err < 0) |
| goto err_free_mem; |
| } |
| ts->filter = pdata->filter; |
| ts->filter_cleanup = pdata->filter_cleanup; |
| } else if (pdata->debounce_max) { |
| ts->debounce_max = pdata->debounce_max; |
| if (ts->debounce_max < 2) |
| ts->debounce_max = 2; |
| ts->debounce_tol = pdata->debounce_tol; |
| ts->debounce_rep = pdata->debounce_rep; |
| ts->filter = ads7846_debounce_filter; |
| ts->filter_data = ts; |
| } else { |
| ts->filter = ads7846_no_filter; |
| } |
| |
| err = ads7846_setup_pendown(spi, ts, pdata); |
| if (err) |
| goto err_cleanup_filter; |
| |
| if (pdata->penirq_recheck_delay_usecs) |
| ts->penirq_recheck_delay_usecs = |
| pdata->penirq_recheck_delay_usecs; |
| |
| ts->wait_for_sync = pdata->wait_for_sync ? : null_wait_for_sync; |
| |
| snprintf(ts->phys, sizeof(ts->phys), "%s/input0", dev_name(&spi->dev)); |
| snprintf(ts->name, sizeof(ts->name), "ADS%d Touchscreen", ts->model); |
| |
| input_dev->name = ts->name; |
| input_dev->phys = ts->phys; |
| input_dev->dev.parent = &spi->dev; |
| |
| input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
| input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); |
| input_set_abs_params(input_dev, ABS_X, |
| pdata->x_min ? : 0, |
| pdata->x_max ? : MAX_12BIT, |
| 0, 0); |
| input_set_abs_params(input_dev, ABS_Y, |
| pdata->y_min ? : 0, |
| pdata->y_max ? : MAX_12BIT, |
| 0, 0); |
| input_set_abs_params(input_dev, ABS_PRESSURE, |
| pdata->pressure_min, pdata->pressure_max, 0, 0); |
| |
| ads7846_setup_spi_msg(ts, pdata); |
| |
| ts->reg = regulator_get(&spi->dev, "vcc"); |
| if (IS_ERR(ts->reg)) { |
| err = PTR_ERR(ts->reg); |
| dev_err(&spi->dev, "unable to get regulator: %d\n", err); |
| goto err_free_gpio; |
| } |
| |
| err = regulator_enable(ts->reg); |
| if (err) { |
| dev_err(&spi->dev, "unable to enable regulator: %d\n", err); |
| goto err_put_regulator; |
| } |
| |
| irq_flags = pdata->irq_flags ? : IRQF_TRIGGER_FALLING; |
| irq_flags |= IRQF_ONESHOT; |
| |
| err = request_threaded_irq(spi->irq, ads7846_hard_irq, ads7846_irq, |
| irq_flags, spi->dev.driver->name, ts); |
| if (err && !pdata->irq_flags) { |
| dev_info(&spi->dev, |
| "trying pin change workaround on irq %d\n", spi->irq); |
| irq_flags |= IRQF_TRIGGER_RISING; |
| err = request_threaded_irq(spi->irq, |
| ads7846_hard_irq, ads7846_irq, |
| irq_flags, spi->dev.driver->name, ts); |
| } |
| |
| if (err) { |
| dev_dbg(&spi->dev, "irq %d busy?\n", spi->irq); |
| goto err_disable_regulator; |
| } |
| |
| err = ads784x_hwmon_register(spi, ts); |
| if (err) |
| goto err_free_irq; |
| |
| dev_info(&spi->dev, "touchscreen, irq %d\n", spi->irq); |
| |
| /* |
| * Take a first sample, leaving nPENIRQ active and vREF off; avoid |
| * the touchscreen, in case it's not connected. |
| */ |
| if (ts->model == 7845) |
| ads7845_read12_ser(&spi->dev, PWRDOWN); |
| else |
| (void) ads7846_read12_ser(&spi->dev, READ_12BIT_SER(vaux)); |
| |
| err = sysfs_create_group(&spi->dev.kobj, &ads784x_attr_group); |
| if (err) |
| goto err_remove_hwmon; |
| |
| err = input_register_device(input_dev); |
| if (err) |
| goto err_remove_attr_group; |
| |
| device_init_wakeup(&spi->dev, pdata->wakeup); |
| |
| /* |
| * If device does not carry platform data we must have allocated it |
| * when parsing DT data. |
| */ |
| if (!dev_get_platdata(&spi->dev)) |
| devm_kfree(&spi->dev, (void *)pdata); |
| |
| return 0; |
| |
| err_remove_attr_group: |
| sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group); |
| err_remove_hwmon: |
| ads784x_hwmon_unregister(spi, ts); |
| err_free_irq: |
| free_irq(spi->irq, ts); |
| err_disable_regulator: |
| regulator_disable(ts->reg); |
| err_put_regulator: |
| regulator_put(ts->reg); |
| err_free_gpio: |
| if (!ts->get_pendown_state) |
| gpio_free(ts->gpio_pendown); |
| err_cleanup_filter: |
| if (ts->filter_cleanup) |
| ts->filter_cleanup(ts->filter_data); |
| err_free_mem: |
| input_free_device(input_dev); |
| kfree(packet); |
| kfree(ts); |
| return err; |
| } |
| |
| static int ads7846_remove(struct spi_device *spi) |
| { |
| struct ads7846 *ts = spi_get_drvdata(spi); |
| |
| device_init_wakeup(&spi->dev, false); |
| |
| sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group); |
| |
| ads7846_disable(ts); |
| free_irq(ts->spi->irq, ts); |
| |
| input_unregister_device(ts->input); |
| |
| ads784x_hwmon_unregister(spi, ts); |
| |
| regulator_disable(ts->reg); |
| regulator_put(ts->reg); |
| |
| if (!ts->get_pendown_state) { |
| /* |
| * If we are not using specialized pendown method we must |
| * have been relying on gpio we set up ourselves. |
| */ |
| gpio_free(ts->gpio_pendown); |
| } |
| |
| if (ts->filter_cleanup) |
| ts->filter_cleanup(ts->filter_data); |
| |
| kfree(ts->packet); |
| kfree(ts); |
| |
| dev_dbg(&spi->dev, "unregistered touchscreen\n"); |
| |
| return 0; |
| } |
| |
| static struct spi_driver ads7846_driver = { |
| .driver = { |
| .name = "ads7846", |
| .owner = THIS_MODULE, |
| .pm = &ads7846_pm, |
| .of_match_table = of_match_ptr(ads7846_dt_ids), |
| }, |
| .probe = ads7846_probe, |
| .remove = ads7846_remove, |
| }; |
| |
| module_spi_driver(ads7846_driver); |
| |
| MODULE_DESCRIPTION("ADS7846 TouchScreen Driver"); |
| MODULE_LICENSE("GPL"); |
| MODULE_ALIAS("spi:ads7846"); |