[deliverable/linux.git] / drivers / input / touchscreen / ad7879.c

/*
 * AD7879/AD7889 based touchscreen and GPIO driver
 *
 * Copyright (C) 2008-2010 Michael Hennerich, Analog Devices Inc.
 *
 * Licensed under the GPL-2 or later.
 *
 * History:
 * 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
 *  - ad7877.c
 *	Copyright (C) 2006-2008 Analog Devices Inc.
 */

#include <linux/device.h>
#include <linux/delay.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/slab.h>
#include <linux/spi/spi.h>
#include <linux/i2c.h>
#include <linux/gpio.h>

#include <linux/spi/ad7879.h>
#include <linux/module.h>
#include "ad7879.h"

#define AD7879_REG_ZEROS		0
#define AD7879_REG_CTRL1		1
#define AD7879_REG_CTRL2		2
#define AD7879_REG_CTRL3		3
#define AD7879_REG_AUX1HIGH		4
#define AD7879_REG_AUX1LOW		5
#define AD7879_REG_TEMP1HIGH		6
#define AD7879_REG_TEMP1LOW		7
#define AD7879_REG_XPLUS		8
#define AD7879_REG_YPLUS		9
#define AD7879_REG_Z1			10
#define AD7879_REG_Z2			11
#define AD7879_REG_AUXVBAT		12
#define AD7879_REG_TEMP			13
#define AD7879_REG_REVID		14

/* Control REG 1 */
#define AD7879_TMR(x)			((x & 0xFF) << 0)
#define AD7879_ACQ(x)			((x & 0x3) << 8)
#define AD7879_MODE_NOC			(0 << 10)	/* Do not convert */
#define AD7879_MODE_SCC			(1 << 10)	/* Single channel conversion */
#define AD7879_MODE_SEQ0		(2 << 10)	/* Sequence 0 in Slave Mode */
#define AD7879_MODE_SEQ1		(3 << 10)	/* Sequence 1 in Master Mode */
#define AD7879_MODE_INT			(1 << 15)	/* PENIRQ disabled INT enabled */

/* Control REG 2 */
#define AD7879_FCD(x)			((x & 0x3) << 0)
#define AD7879_RESET			(1 << 4)
#define AD7879_MFS(x)			((x & 0x3) << 5)
#define AD7879_AVG(x)			((x & 0x3) << 7)
#define	AD7879_SER			(1 << 9)	/* non-differential */
#define	AD7879_DFR			(0 << 9)	/* differential */
#define AD7879_GPIOPOL			(1 << 10)
#define AD7879_GPIODIR			(1 << 11)
#define AD7879_GPIO_DATA		(1 << 12)
#define AD7879_GPIO_EN			(1 << 13)
#define AD7879_PM(x)			((x & 0x3) << 14)
#define AD7879_PM_SHUTDOWN		(0)
#define AD7879_PM_DYN			(1)
#define AD7879_PM_FULLON		(2)

/* Control REG 3 */
#define AD7879_TEMPMASK_BIT		(1<<15)
#define AD7879_AUXVBATMASK_BIT		(1<<14)
#define AD7879_INTMODE_BIT		(1<<13)
#define AD7879_GPIOALERTMASK_BIT	(1<<12)
#define AD7879_AUXLOW_BIT		(1<<11)
#define AD7879_AUXHIGH_BIT		(1<<10)
#define AD7879_TEMPLOW_BIT		(1<<9)
#define AD7879_TEMPHIGH_BIT		(1<<8)
#define AD7879_YPLUS_BIT		(1<<7)
#define AD7879_XPLUS_BIT		(1<<6)
#define AD7879_Z1_BIT			(1<<5)
#define AD7879_Z2_BIT			(1<<4)
#define AD7879_AUX_BIT			(1<<3)
#define AD7879_VBAT_BIT			(1<<2)
#define AD7879_TEMP_BIT			(1<<1)

enum {
	AD7879_SEQ_XPOS  = 0,
	AD7879_SEQ_YPOS  = 1,
	AD7879_SEQ_Z1    = 2,
	AD7879_SEQ_Z2    = 3,
	AD7879_NR_SENSE  = 4,
};

#define	MAX_12BIT			((1<<12)-1)
#define	TS_PEN_UP_TIMEOUT		msecs_to_jiffies(50)

struct ad7879 {
	const struct ad7879_bus_ops *bops;

	struct device		*dev;
	struct input_dev	*input;
	struct timer_list	timer;
#ifdef CONFIG_GPIOLIB
	struct gpio_chip	gc;
	struct mutex		mutex;
#endif
	unsigned int		irq;
	bool			disabled;	/* P: input->mutex */
	bool			suspended;	/* P: input->mutex */
	bool			swap_xy;
	u16			conversion_data[AD7879_NR_SENSE];
	char			phys[32];
	u8			first_conversion_delay;
	u8			acquisition_time;
	u8			averaging;
	u8			pen_down_acc_interval;
	u8			median;
	u16			x_plate_ohms;
	u16			pressure_max;
	u16			cmd_crtl1;
	u16			cmd_crtl2;
	u16			cmd_crtl3;
	int			x;
	int			y;
	int			Rt;
};

static int ad7879_read(struct ad7879 *ts, u8 reg)
{
	return ts->bops->read(ts->dev, reg);
}

static int ad7879_multi_read(struct ad7879 *ts, u8 first_reg, u8 count, u16 *buf)
{
	return ts->bops->multi_read(ts->dev, first_reg, count, buf);
}

static int ad7879_write(struct ad7879 *ts, u8 reg, u16 val)
{
	return ts->bops->write(ts->dev, reg, val);
}

static int ad7879_report(struct ad7879 *ts)
{
	struct input_dev *input_dev = ts->input;
	unsigned Rt;
	u16 x, y, z1, z2;

	x = ts->conversion_data[AD7879_SEQ_XPOS] & MAX_12BIT;
	y = ts->conversion_data[AD7879_SEQ_YPOS] & MAX_12BIT;
	z1 = ts->conversion_data[AD7879_SEQ_Z1] & MAX_12BIT;
	z2 = ts->conversion_data[AD7879_SEQ_Z2] & MAX_12BIT;

	if (ts->swap_xy)
		swap(x, y);

	/*
	 * The samples processed here are already preprocessed by the AD7879.
	 * The preprocessing function consists of a median and an averaging
	 * filter.  The combination of these two techniques provides a robust
	 * solution, discarding the spurious noise in the signal and keeping
	 * only the data of interest.  The size of both filters is
	 * programmable. (dev.platform_data, see linux/spi/ad7879.h) Other
	 * user-programmable conversion controls include variable acquisition
	 * time, and first conversion delay. Up to 16 averages can be taken
	 * per conversion.
	 */

	if (likely(x && z1)) {
		/* compute touch pressure resistance using equation #1 */
		Rt = (z2 - z1) * x * ts->x_plate_ohms;
		Rt /= z1;
		Rt = (Rt + 2047) >> 12;

		/*
		 * Sample found inconsistent, pressure is beyond
		 * the maximum. Don't report it to user space.
		 */
		if (Rt > ts->pressure_max)
			return -EINVAL;

		/*
		 * Note that we delay reporting events by one sample.
		 * This is done to avoid reporting last sample of the
		 * touch sequence, which may be incomplete if finger
		 * leaves the surface before last reading is taken.
		 */
		if (timer_pending(&ts->timer)) {
			/* Touch continues */
			input_report_key(input_dev, BTN_TOUCH, 1);
			input_report_abs(input_dev, ABS_X, ts->x);
			input_report_abs(input_dev, ABS_Y, ts->y);
			input_report_abs(input_dev, ABS_PRESSURE, ts->Rt);
			input_sync(input_dev);
		}

		ts->x = x;
		ts->y = y;
		ts->Rt = Rt;

		return 0;
	}

	return -EINVAL;
}

static void ad7879_ts_event_release(struct ad7879 *ts)
{
	struct input_dev *input_dev = ts->input;

	input_report_abs(input_dev, ABS_PRESSURE, 0);
	input_report_key(input_dev, BTN_TOUCH, 0);
	input_sync(input_dev);
}

static void ad7879_timer(unsigned long handle)
{
	struct ad7879 *ts = (void *)handle;

	ad7879_ts_event_release(ts);
}

static irqreturn_t ad7879_irq(int irq, void *handle)
{
	struct ad7879 *ts = handle;

	ad7879_multi_read(ts, AD7879_REG_XPLUS, AD7879_NR_SENSE, ts->conversion_data);

	if (!ad7879_report(ts))
		mod_timer(&ts->timer, jiffies + TS_PEN_UP_TIMEOUT);

	return IRQ_HANDLED;
}

static void __ad7879_enable(struct ad7879 *ts)
{
	ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
	ad7879_write(ts, AD7879_REG_CTRL3, ts->cmd_crtl3);
	ad7879_write(ts, AD7879_REG_CTRL1, ts->cmd_crtl1);

	enable_irq(ts->irq);
}

static void __ad7879_disable(struct ad7879 *ts)
{
	u16 reg = (ts->cmd_crtl2 & ~AD7879_PM(-1)) |
		AD7879_PM(AD7879_PM_SHUTDOWN);
	disable_irq(ts->irq);

	if (del_timer_sync(&ts->timer))
		ad7879_ts_event_release(ts);

	ad7879_write(ts, AD7879_REG_CTRL2, reg);
}


static int ad7879_open(struct input_dev *input)
{
	struct ad7879 *ts = input_get_drvdata(input);

	/* protected by input->mutex */
	if (!ts->disabled && !ts->suspended)
		__ad7879_enable(ts);

	return 0;
}

static void ad7879_close(struct input_dev* input)
{
	struct ad7879 *ts = input_get_drvdata(input);

	/* protected by input->mutex */
	if (!ts->disabled && !ts->suspended)
		__ad7879_disable(ts);
}

#ifdef CONFIG_PM_SLEEP
static int ad7879_suspend(struct device *dev)
{
	struct ad7879 *ts = dev_get_drvdata(dev);

	mutex_lock(&ts->input->mutex);

	if (!ts->suspended && !ts->disabled && ts->input->users)
		__ad7879_disable(ts);

	ts->suspended = true;

	mutex_unlock(&ts->input->mutex);

	return 0;
}

static int ad7879_resume(struct device *dev)
{
	struct ad7879 *ts = dev_get_drvdata(dev);

	mutex_lock(&ts->input->mutex);

	if (ts->suspended && !ts->disabled && ts->input->users)
		__ad7879_enable(ts);

	ts->suspended = false;

	mutex_unlock(&ts->input->mutex);

	return 0;
}
#endif

SIMPLE_DEV_PM_OPS(ad7879_pm_ops, ad7879_suspend, ad7879_resume);
EXPORT_SYMBOL(ad7879_pm_ops);

static void ad7879_toggle(struct ad7879 *ts, bool disable)
{
	mutex_lock(&ts->input->mutex);

	if (!ts->suspended && ts->input->users != 0) {

		if (disable) {
			if (ts->disabled)
				__ad7879_enable(ts);
		} else {
			if (!ts->disabled)
				__ad7879_disable(ts);
		}
	}

	ts->disabled = disable;

	mutex_unlock(&ts->input->mutex);
}

static ssize_t ad7879_disable_show(struct device *dev,
				     struct device_attribute *attr, char *buf)
{
	struct ad7879 *ts = dev_get_drvdata(dev);

	return sprintf(buf, "%u\n", ts->disabled);
}

static ssize_t ad7879_disable_store(struct device *dev,
				     struct device_attribute *attr,
				     const char *buf, size_t count)
{
	struct ad7879 *ts = dev_get_drvdata(dev);
	unsigned int val;
	int error;

	error = kstrtouint(buf, 10, &val);
	if (error)
		return error;

	ad7879_toggle(ts, val);

	return count;
}

static DEVICE_ATTR(disable, 0664, ad7879_disable_show, ad7879_disable_store);

static struct attribute *ad7879_attributes[] = {
	&dev_attr_disable.attr,
	NULL
};

static const struct attribute_group ad7879_attr_group = {
	.attrs = ad7879_attributes,
};

#ifdef CONFIG_GPIOLIB
static int ad7879_gpio_direction_input(struct gpio_chip *chip,
					unsigned gpio)
{
	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
	int err;

	mutex_lock(&ts->mutex);
	ts->cmd_crtl2 |= AD7879_GPIO_EN | AD7879_GPIODIR | AD7879_GPIOPOL;
	err = ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
	mutex_unlock(&ts->mutex);

	return err;
}

static int ad7879_gpio_direction_output(struct gpio_chip *chip,
					unsigned gpio, int level)
{
	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
	int err;

	mutex_lock(&ts->mutex);
	ts->cmd_crtl2 &= ~AD7879_GPIODIR;
	ts->cmd_crtl2 |= AD7879_GPIO_EN | AD7879_GPIOPOL;
	if (level)
		ts->cmd_crtl2 |= AD7879_GPIO_DATA;
	else
		ts->cmd_crtl2 &= ~AD7879_GPIO_DATA;

	err = ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
	mutex_unlock(&ts->mutex);

	return err;
}

static int ad7879_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
{
	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
	u16 val;

	mutex_lock(&ts->mutex);
	val = ad7879_read(ts, AD7879_REG_CTRL2);
	mutex_unlock(&ts->mutex);

	return !!(val & AD7879_GPIO_DATA);
}

static void ad7879_gpio_set_value(struct gpio_chip *chip,
				  unsigned gpio, int value)
{
	struct ad7879 *ts = container_of(chip, struct ad7879, gc);

	mutex_lock(&ts->mutex);
	if (value)
		ts->cmd_crtl2 |= AD7879_GPIO_DATA;
	else
		ts->cmd_crtl2 &= ~AD7879_GPIO_DATA;

	ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
	mutex_unlock(&ts->mutex);
}

static int ad7879_gpio_add(struct ad7879 *ts,
			   const struct ad7879_platform_data *pdata)
{
	int ret = 0;

	mutex_init(&ts->mutex);

	if (pdata->gpio_export) {
		ts->gc.direction_input = ad7879_gpio_direction_input;
		ts->gc.direction_output = ad7879_gpio_direction_output;
		ts->gc.get = ad7879_gpio_get_value;
		ts->gc.set = ad7879_gpio_set_value;
		ts->gc.can_sleep = 1;
		ts->gc.base = pdata->gpio_base;
		ts->gc.ngpio = 1;
		ts->gc.label = "AD7879-GPIO";
		ts->gc.owner = THIS_MODULE;
		ts->gc.dev = ts->dev;

		ret = gpiochip_add(&ts->gc);
		if (ret)
			dev_err(ts->dev, "failed to register gpio %d\n",
				ts->gc.base);
	}

	return ret;
}

static void ad7879_gpio_remove(struct ad7879 *ts)
{
	const struct ad7879_platform_data *pdata = dev_get_platdata(ts->dev);

	if (pdata->gpio_export)
		gpiochip_remove(&ts->gc);

}
#else
static inline int ad7879_gpio_add(struct ad7879 *ts,
				  const struct ad7879_platform_data *pdata)
{
	return 0;
}

static inline void ad7879_gpio_remove(struct ad7879 *ts)
{
}
#endif

struct ad7879 *ad7879_probe(struct device *dev, u8 devid, unsigned int irq,
			    const struct ad7879_bus_ops *bops)
{
	struct ad7879_platform_data *pdata = dev_get_platdata(dev);
	struct ad7879 *ts;
	struct input_dev *input_dev;
	int err;
	u16 revid;

	if (!irq) {
		dev_err(dev, "no IRQ?\n");
		err = -EINVAL;
		goto err_out;
	}

	if (!pdata) {
		dev_err(dev, "no platform data?\n");
		err = -EINVAL;
		goto err_out;
	}

	ts = kzalloc(sizeof(*ts), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!ts || !input_dev) {
		err = -ENOMEM;
		goto err_free_mem;
	}

	ts->bops = bops;
	ts->dev = dev;
	ts->input = input_dev;
	ts->irq = irq;
	ts->swap_xy = pdata->swap_xy;

	setup_timer(&ts->timer, ad7879_timer, (unsigned long) ts);

	ts->x_plate_ohms = pdata->x_plate_ohms ? : 400;
	ts->pressure_max = pdata->pressure_max ? : ~0;

	ts->first_conversion_delay = pdata->first_conversion_delay;
	ts->acquisition_time = pdata->acquisition_time;
	ts->averaging = pdata->averaging;
	ts->pen_down_acc_interval = pdata->pen_down_acc_interval;
	ts->median = pdata->median;

	snprintf(ts->phys, sizeof(ts->phys), "%s/input0", dev_name(dev));

	input_dev->name = "AD7879 Touchscreen";
	input_dev->phys = ts->phys;
	input_dev->dev.parent = dev;
	input_dev->id.bustype = bops->bustype;

	input_dev->open = ad7879_open;
	input_dev->close = ad7879_close;

	input_set_drvdata(input_dev, ts);

	__set_bit(EV_ABS, input_dev->evbit);
	__set_bit(ABS_X, input_dev->absbit);
	__set_bit(ABS_Y, input_dev->absbit);
	__set_bit(ABS_PRESSURE, input_dev->absbit);

	__set_bit(EV_KEY, input_dev->evbit);
	__set_bit(BTN_TOUCH, input_dev->keybit);

	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);

	err = ad7879_write(ts, AD7879_REG_CTRL2, AD7879_RESET);
	if (err < 0) {
		dev_err(dev, "Failed to write %s\n", input_dev->name);
		goto err_free_mem;
	}

	revid = ad7879_read(ts, AD7879_REG_REVID);
	input_dev->id.product = (revid & 0xff);
	input_dev->id.version = revid >> 8;
	if (input_dev->id.product != devid) {
		dev_err(dev, "Failed to probe %s (%x vs %x)\n",
			input_dev->name, devid, revid);
		err = -ENODEV;
		goto err_free_mem;
	}

	ts->cmd_crtl3 = AD7879_YPLUS_BIT |
			AD7879_XPLUS_BIT |
			AD7879_Z2_BIT |
			AD7879_Z1_BIT |
			AD7879_TEMPMASK_BIT |
			AD7879_AUXVBATMASK_BIT |
			AD7879_GPIOALERTMASK_BIT;

	ts->cmd_crtl2 = AD7879_PM(AD7879_PM_DYN) | AD7879_DFR |
			AD7879_AVG(ts->averaging) |
			AD7879_MFS(ts->median) |
			AD7879_FCD(ts->first_conversion_delay);

	ts->cmd_crtl1 = AD7879_MODE_INT | AD7879_MODE_SEQ1 |
			AD7879_ACQ(ts->acquisition_time) |
			AD7879_TMR(ts->pen_down_acc_interval);

	err = request_threaded_irq(ts->irq, NULL, ad7879_irq,
				   IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
				   dev_name(dev), ts);
	if (err) {
		dev_err(dev, "irq %d busy?\n", ts->irq);
		goto err_free_mem;
	}

	__ad7879_disable(ts);

	err = sysfs_create_group(&dev->kobj, &ad7879_attr_group);
	if (err)
		goto err_free_irq;

	err = ad7879_gpio_add(ts, pdata);
	if (err)
		goto err_remove_attr;

	err = input_register_device(input_dev);
	if (err)
		goto err_remove_gpio;

	return ts;

err_remove_gpio:
	ad7879_gpio_remove(ts);
err_remove_attr:
	sysfs_remove_group(&dev->kobj, &ad7879_attr_group);
err_free_irq:
	free_irq(ts->irq, ts);
err_free_mem:
	input_free_device(input_dev);
	kfree(ts);
err_out:
	return ERR_PTR(err);
}
EXPORT_SYMBOL(ad7879_probe);

void ad7879_remove(struct ad7879 *ts)
{
	ad7879_gpio_remove(ts);
	sysfs_remove_group(&ts->dev->kobj, &ad7879_attr_group);
	free_irq(ts->irq, ts);
	input_unregister_device(ts->input);
	kfree(ts);
}
EXPORT_SYMBOL(ad7879_remove);

MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
MODULE_DESCRIPTION("AD7879(-1) touchscreen Driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
b4be468c	1	/*
4397c98a	2	* AD7879/AD7889 based touchscreen and GPIO driver
b4be468c	3	*
4397c98a	4	* Copyright (C) 2008-2010 Michael Hennerich, Analog Devices Inc.
b4be468c	5	*
4397c98a	6	* Licensed under the GPL-2 or later.
b4be468c MH	7	*
	8	* History:
	9	* Copyright (c) 2005 David Brownell
	10	* Copyright (c) 2006 Nokia Corporation
	11	* Various changes: Imre Deak <imre.deak@nokia.com>
	12	*
	13	* Using code from:
	14	* - corgi_ts.c
	15	* Copyright (C) 2004-2005 Richard Purdie
	16	* - omap_ts.[hc], ads7846.h, ts_osk.c
	17	* Copyright (C) 2002 MontaVista Software
	18	* Copyright (C) 2004 Texas Instruments
	19	* Copyright (C) 2005 Dirk Behme
	20	* - ad7877.c
	21	* Copyright (C) 2006-2008 Analog Devices Inc.
	22	*/
	23
	24	#include <linux/device.h>
b4be468c MH	25	#include <linux/delay.h>
	26	#include <linux/input.h>
	27	#include <linux/interrupt.h>
	28	#include <linux/irq.h>
	29	#include <linux/slab.h>
b4be468c MH	30	#include <linux/spi/spi.h>
b4be468c MH	31	#include <linux/i2c.h>
ec51b7f5	32	#include <linux/gpio.h>
b4be468c MH	33
b4be468c MH	34	#include <linux/spi/ad7879.h>
d2d8442d	35	#include <linux/module.h>
4397c98a	36	#include "ad7879.h"
b4be468c MH	37
	38	#define AD7879_REG_ZEROS 0
	39	#define AD7879_REG_CTRL1 1
	40	#define AD7879_REG_CTRL2 2
	41	#define AD7879_REG_CTRL3 3
	42	#define AD7879_REG_AUX1HIGH 4
	43	#define AD7879_REG_AUX1LOW 5
	44	#define AD7879_REG_TEMP1HIGH 6
	45	#define AD7879_REG_TEMP1LOW 7
	46	#define AD7879_REG_XPLUS 8
	47	#define AD7879_REG_YPLUS 9
	48	#define AD7879_REG_Z1 10
	49	#define AD7879_REG_Z2 11
	50	#define AD7879_REG_AUXVBAT 12
	51	#define AD7879_REG_TEMP 13
	52	#define AD7879_REG_REVID 14
	53
	54	/* Control REG 1 */
	55	#define AD7879_TMR(x) ((x & 0xFF) << 0)
	56	#define AD7879_ACQ(x) ((x & 0x3) << 8)
	57	#define AD7879_MODE_NOC (0 << 10) /* Do not convert */
	58	#define AD7879_MODE_SCC (1 << 10) /* Single channel conversion */
	59	#define AD7879_MODE_SEQ0 (2 << 10) /* Sequence 0 in Slave Mode */
	60	#define AD7879_MODE_SEQ1 (3 << 10) /* Sequence 1 in Master Mode */
	61	#define AD7879_MODE_INT (1 << 15) /* PENIRQ disabled INT enabled */
	62
	63	/* Control REG 2 */
	64	#define AD7879_FCD(x) ((x & 0x3) << 0)
	65	#define AD7879_RESET (1 << 4)
	66	#define AD7879_MFS(x) ((x & 0x3) << 5)
	67	#define AD7879_AVG(x) ((x & 0x3) << 7)
	68	#define AD7879_SER (1 << 9) /* non-differential */
	69	#define AD7879_DFR (0 << 9) /* differential */
	70	#define AD7879_GPIOPOL (1 << 10)
	71	#define AD7879_GPIODIR (1 << 11)
	72	#define AD7879_GPIO_DATA (1 << 12)
	73	#define AD7879_GPIO_EN (1 << 13)
	74	#define AD7879_PM(x) ((x & 0x3) << 14)
	75	#define AD7879_PM_SHUTDOWN (0)
	76	#define AD7879_PM_DYN (1)
	77	#define AD7879_PM_FULLON (2)
	78
	79	/* Control REG 3 */
	80	#define AD7879_TEMPMASK_BIT (1<<15)
	81	#define AD7879_AUXVBATMASK_BIT (1<<14)
	82	#define AD7879_INTMODE_BIT (1<<13)
	83	#define AD7879_GPIOALERTMASK_BIT (1<<12)
	84	#define AD7879_AUXLOW_BIT (1<<11)
	85	#define AD7879_AUXHIGH_BIT (1<<10)
	86	#define AD7879_TEMPLOW_BIT (1<<9)
	87	#define AD7879_TEMPHIGH_BIT (1<<8)
	88	#define AD7879_YPLUS_BIT (1<<7)
	89	#define AD7879_XPLUS_BIT (1<<6)
	90	#define AD7879_Z1_BIT (1<<5)
	91	#define AD7879_Z2_BIT (1<<4)
	92	#define AD7879_AUX_BIT (1<<3)
	93	#define AD7879_VBAT_BIT (1<<2)
	94	#define AD7879_TEMP_BIT (1<<1)
	95
	96	enum {
	97	AD7879_SEQ_XPOS = 0,
	98	AD7879_SEQ_YPOS = 1,
	99	AD7879_SEQ_Z1 = 2,
	100	AD7879_SEQ_Z2 = 3,
101	AD7879_NR_SENSE = 4,
102	};
103
104	#define MAX_12BIT ((1<<12)-1)
105	#define TS_PEN_UP_TIMEOUT msecs_to_jiffies(50)
106
b4be468c	107	struct ad7879 {
4397c98a MF	108	const struct ad7879_bus_ops *bops;
	109
	110	struct device *dev;
b4be468c	111	struct input_dev *input;
b4be468c	112	struct timer_list timer;
ec51b7f5 MH	113	#ifdef CONFIG_GPIOLIB
ec51b7f5 MH	114	struct gpio_chip gc;
14fbbc36	115	struct mutex mutex;
ec51b7f5	116	#endif
4397c98a	117	unsigned int irq;
14fbbc36 DT	118	bool disabled; /* P: input->mutex */
14fbbc36 DT	119	bool suspended; /* P: input->mutex */
6680884a	120	bool swap_xy;
b4be468c MH	121	u16 conversion_data[AD7879_NR_SENSE];
	122	char phys[32];
	123	u8 first_conversion_delay;
	124	u8 acquisition_time;
	125	u8 averaging;
	126	u8 pen_down_acc_interval;
	127	u8 median;
	128	u16 x_plate_ohms;
	129	u16 pressure_max;
b4be468c MH	130	u16 cmd_crtl1;
	131	u16 cmd_crtl2;
	132	u16 cmd_crtl3;
b584efc9 MH	133	int x;
	134	int y;
	135	int Rt;
b4be468c MH	136	};
b4be468c MH	137
4397c98a MF	138	static int ad7879_read(struct ad7879 *ts, u8 reg)
	139	{
	140	return ts->bops->read(ts->dev, reg);
	141	}
	142
	143	static int ad7879_multi_read(struct ad7879 ts, u8 first_reg, u8 count, u16 buf)
	144	{
	145	return ts->bops->multi_read(ts->dev, first_reg, count, buf);
	146	}
	147
	148	static int ad7879_write(struct ad7879 *ts, u8 reg, u16 val)
	149	{
	150	return ts->bops->write(ts->dev, reg, val);
	151	}
b4be468c	152
963ce8ae	153	static int ad7879_report(struct ad7879 *ts)
b4be468c MH	154	{
	155	struct input_dev *input_dev = ts->input;
	156	unsigned Rt;
	157	u16 x, y, z1, z2;
	158
	159	x = ts->conversion_data[AD7879_SEQ_XPOS] & MAX_12BIT;
	160	y = ts->conversion_data[AD7879_SEQ_YPOS] & MAX_12BIT;
	161	z1 = ts->conversion_data[AD7879_SEQ_Z1] & MAX_12BIT;
	162	z2 = ts->conversion_data[AD7879_SEQ_Z2] & MAX_12BIT;
	163
6680884a MH	164	if (ts->swap_xy)
	165	swap(x, y);
	166
b4be468c MH	167	/*
b4be468c MH	168	* The samples processed here are already preprocessed by the AD7879.
4397c98a MF	169	* The preprocessing function consists of a median and an averaging
	170	* filter. The combination of these two techniques provides a robust
	171	* solution, discarding the spurious noise in the signal and keeping
	172	* only the data of interest. The size of both filters is
	173	* programmable. (dev.platform_data, see linux/spi/ad7879.h) Other
	174	* user-programmable conversion controls include variable acquisition
	175	* time, and first conversion delay. Up to 16 averages can be taken
	176	* per conversion.
b4be468c MH	177	*/
	178
	179	if (likely(x && z1)) {
	180	/* compute touch pressure resistance using equation #1 */
	181	Rt = (z2 - z1) * x * ts->x_plate_ohms;
	182	Rt /= z1;
	183	Rt = (Rt + 2047) >> 12;
	184
b584efc9 MH	185	/*
	186	* Sample found inconsistent, pressure is beyond
	187	* the maximum. Don't report it to user space.
	188	*/
	189	if (Rt > ts->pressure_max)
	190	return -EINVAL;
	191
	192	/*
	193	* Note that we delay reporting events by one sample.
	194	* This is done to avoid reporting last sample of the
	195	* touch sequence, which may be incomplete if finger
	196	* leaves the surface before last reading is taken.
	197	*/
	198	if (timer_pending(&ts->timer)) {
	199	/* Touch continues */
963ce8ae	200	input_report_key(input_dev, BTN_TOUCH, 1);
b584efc9 MH	201	input_report_abs(input_dev, ABS_X, ts->x);
	202	input_report_abs(input_dev, ABS_Y, ts->y);
	203	input_report_abs(input_dev, ABS_PRESSURE, ts->Rt);
	204	input_sync(input_dev);
	205	}
	206
	207	ts->x = x;
	208	ts->y = y;
	209	ts->Rt = Rt;
963ce8ae	210
963ce8ae	211	return 0;
b4be468c	212	}
963ce8ae MH	213
963ce8ae MH	214	return -EINVAL;
b4be468c MH	215	}
b4be468c MH	216
b4be468c MH	217	static void ad7879_ts_event_release(struct ad7879 *ts)
	218	{
	219	struct input_dev *input_dev = ts->input;
	220
	221	input_report_abs(input_dev, ABS_PRESSURE, 0);
963ce8ae	222	input_report_key(input_dev, BTN_TOUCH, 0);
b4be468c MH	223	input_sync(input_dev);
	224	}
	225
	226	static void ad7879_timer(unsigned long handle)
	227	{
	228	struct ad7879 ts = (void )handle;
	229
	230	ad7879_ts_event_release(ts);
	231	}
	232
	233	static irqreturn_t ad7879_irq(int irq, void *handle)
	234	{
	235	struct ad7879 *ts = handle;
	236
4397c98a	237	ad7879_multi_read(ts, AD7879_REG_XPLUS, AD7879_NR_SENSE, ts->conversion_data);
b4be468c	238
963ce8ae MH	239	if (!ad7879_report(ts))
963ce8ae MH	240	mod_timer(&ts->timer, jiffies + TS_PEN_UP_TIMEOUT);
b4be468c MH	241
	242	return IRQ_HANDLED;
	243	}
	244
14fbbc36	245	static void __ad7879_enable(struct ad7879 *ts)
b4be468c	246	{
4397c98a MF	247	ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
	248	ad7879_write(ts, AD7879_REG_CTRL3, ts->cmd_crtl3);
	249	ad7879_write(ts, AD7879_REG_CTRL1, ts->cmd_crtl1);
14fbbc36 DT	250
14fbbc36 DT	251	enable_irq(ts->irq);
b4be468c MH	252	}
b4be468c MH	253
14fbbc36	254	static void __ad7879_disable(struct ad7879 *ts)
b4be468c	255	{
4fecc208 MH	256	u16 reg = (ts->cmd_crtl2 & ~AD7879_PM(-1)) \|
4fecc208 MH	257	AD7879_PM(AD7879_PM_SHUTDOWN);
14fbbc36	258	disable_irq(ts->irq);
b4be468c	259
14fbbc36 DT	260	if (del_timer_sync(&ts->timer))
14fbbc36 DT	261	ad7879_ts_event_release(ts);
b4be468c	262
4fecc208	263	ad7879_write(ts, AD7879_REG_CTRL2, reg);
14fbbc36	264	}
b4be468c	265
b4be468c	266
14fbbc36 DT	267	static int ad7879_open(struct input_dev *input)
	268	{
	269	struct ad7879 *ts = input_get_drvdata(input);
b4be468c	270
14fbbc36 DT	271	/* protected by input->mutex */
	272	if (!ts->disabled && !ts->suspended)
	273	__ad7879_enable(ts);
	274
	275	return 0;
b4be468c MH	276	}
b4be468c MH	277
14fbbc36	278	static void ad7879_close(struct input_dev* input)
b4be468c	279	{
14fbbc36 DT	280	struct ad7879 *ts = input_get_drvdata(input);
	281
	282	/* protected by input->mutex */
	283	if (!ts->disabled && !ts->suspended)
	284	__ad7879_disable(ts);
	285	}
	286
8672bd93 DT	287	#ifdef CONFIG_PM_SLEEP
8672bd93 DT	288	static int ad7879_suspend(struct device *dev)
14fbbc36	289	{
8672bd93 DT	290	struct ad7879 *ts = dev_get_drvdata(dev);
8672bd93 DT	291
14fbbc36 DT	292	mutex_lock(&ts->input->mutex);
	293
	294	if (!ts->suspended && !ts->disabled && ts->input->users)
	295	__ad7879_disable(ts);
	296
	297	ts->suspended = true;
	298
	299	mutex_unlock(&ts->input->mutex);
8672bd93 DT	300
8672bd93 DT	301	return 0;
14fbbc36	302	}
14fbbc36	303
8672bd93	304	static int ad7879_resume(struct device *dev)
14fbbc36	305	{
8672bd93 DT	306	struct ad7879 *ts = dev_get_drvdata(dev);
8672bd93 DT	307
14fbbc36	308	mutex_lock(&ts->input->mutex);
b4be468c	309
14fbbc36 DT	310	if (ts->suspended && !ts->disabled && ts->input->users)
	311	__ad7879_enable(ts);
	312
	313	ts->suspended = false;
	314
	315	mutex_unlock(&ts->input->mutex);
8672bd93 DT	316
8672bd93 DT	317	return 0;
14fbbc36	318	}
8672bd93 DT	319	#endif
	320
	321	SIMPLE_DEV_PM_OPS(ad7879_pm_ops, ad7879_suspend, ad7879_resume);
	322	EXPORT_SYMBOL(ad7879_pm_ops);
14fbbc36 DT	323
	324	static void ad7879_toggle(struct ad7879 *ts, bool disable)
	325	{
	326	mutex_lock(&ts->input->mutex);
	327
	328	if (!ts->suspended && ts->input->users != 0) {
	329
	330	if (disable) {
	331	if (ts->disabled)
	332	__ad7879_enable(ts);
	333	} else {
	334	if (!ts->disabled)
	335	__ad7879_disable(ts);
	336	}
b4be468c MH	337	}
b4be468c MH	338
14fbbc36 DT	339	ts->disabled = disable;
	340
	341	mutex_unlock(&ts->input->mutex);
b4be468c MH	342	}
	343
	344	static ssize_t ad7879_disable_show(struct device *dev,
	345	struct device_attribute attr, char buf)
	346	{
	347	struct ad7879 *ts = dev_get_drvdata(dev);
	348
	349	return sprintf(buf, "%u\n", ts->disabled);
	350	}
	351
	352	static ssize_t ad7879_disable_store(struct device *dev,
	353	struct device_attribute *attr,
	354	const char *buf, size_t count)
	355	{
	356	struct ad7879 *ts = dev_get_drvdata(dev);
76496e7a	357	unsigned int val;
b4be468c MH	358	int error;
b4be468c MH	359
76496e7a	360	error = kstrtouint(buf, 10, &val);
b4be468c MH	361	if (error)
	362	return error;
	363
14fbbc36	364	ad7879_toggle(ts, val);
b4be468c MH	365
	366	return count;
	367	}
	368
	369	static DEVICE_ATTR(disable, 0664, ad7879_disable_show, ad7879_disable_store);
	370
ec51b7f5 MH	371	static struct attribute *ad7879_attributes[] = {
	372	&dev_attr_disable.attr,
	373	NULL
	374	};
	375
	376	static const struct attribute_group ad7879_attr_group = {
	377	.attrs = ad7879_attributes,
	378	};
	379
	380	#ifdef CONFIG_GPIOLIB
	381	static int ad7879_gpio_direction_input(struct gpio_chip *chip,
	382	unsigned gpio)
b4be468c	383	{
ec51b7f5 MH	384	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
ec51b7f5 MH	385	int err;
b4be468c	386
ec51b7f5 MH	387	mutex_lock(&ts->mutex);
ec51b7f5 MH	388	ts->cmd_crtl2 \|= AD7879_GPIO_EN \| AD7879_GPIODIR \| AD7879_GPIOPOL;
4397c98a	389	err = ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
ec51b7f5 MH	390	mutex_unlock(&ts->mutex);
	391
	392	return err;
b4be468c MH	393	}
b4be468c MH	394
ec51b7f5 MH	395	static int ad7879_gpio_direction_output(struct gpio_chip *chip,
ec51b7f5 MH	396	unsigned gpio, int level)
b4be468c	397	{
ec51b7f5 MH	398	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
ec51b7f5 MH	399	int err;
b4be468c	400
ec51b7f5 MH	401	mutex_lock(&ts->mutex);
	402	ts->cmd_crtl2 &= ~AD7879_GPIODIR;
	403	ts->cmd_crtl2 \|= AD7879_GPIO_EN \| AD7879_GPIOPOL;
	404	if (level)
	405	ts->cmd_crtl2 \|= AD7879_GPIO_DATA;
	406	else
	407	ts->cmd_crtl2 &= ~AD7879_GPIO_DATA;
	408
4397c98a	409	err = ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
ec51b7f5 MH	410	mutex_unlock(&ts->mutex);
	411
	412	return err;
	413	}
	414
	415	static int ad7879_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
	416	{
	417	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
	418	u16 val;
b4be468c MH	419
b4be468c MH	420	mutex_lock(&ts->mutex);
4397c98a	421	val = ad7879_read(ts, AD7879_REG_CTRL2);
b4be468c MH	422	mutex_unlock(&ts->mutex);
b4be468c MH	423
ec51b7f5	424	return !!(val & AD7879_GPIO_DATA);
b4be468c MH	425	}
b4be468c MH	426
ec51b7f5 MH	427	static void ad7879_gpio_set_value(struct gpio_chip *chip,
	428	unsigned gpio, int value)
	429	{
	430	struct ad7879 *ts = container_of(chip, struct ad7879, gc);
b4be468c	431
ec51b7f5 MH	432	mutex_lock(&ts->mutex);
	433	if (value)
	434	ts->cmd_crtl2 \|= AD7879_GPIO_DATA;
	435	else
	436	ts->cmd_crtl2 &= ~AD7879_GPIO_DATA;
b4be468c	437
4397c98a	438	ad7879_write(ts, AD7879_REG_CTRL2, ts->cmd_crtl2);
ec51b7f5 MH	439	mutex_unlock(&ts->mutex);
	440	}
	441
4397c98a MF	442	static int ad7879_gpio_add(struct ad7879 *ts,
4397c98a MF	443	const struct ad7879_platform_data *pdata)
ec51b7f5	444	{
ec51b7f5 MH	445	int ret = 0;
ec51b7f5 MH	446
14fbbc36 DT	447	mutex_init(&ts->mutex);
14fbbc36 DT	448
ec51b7f5 MH	449	if (pdata->gpio_export) {
	450	ts->gc.direction_input = ad7879_gpio_direction_input;
	451	ts->gc.direction_output = ad7879_gpio_direction_output;
	452	ts->gc.get = ad7879_gpio_get_value;
	453	ts->gc.set = ad7879_gpio_set_value;
	454	ts->gc.can_sleep = 1;
	455	ts->gc.base = pdata->gpio_base;
	456	ts->gc.ngpio = 1;
	457	ts->gc.label = "AD7879-GPIO";
	458	ts->gc.owner = THIS_MODULE;
4397c98a	459	ts->gc.dev = ts->dev;
ec51b7f5 MH	460
	461	ret = gpiochip_add(&ts->gc);
	462	if (ret)
4397c98a	463	dev_err(ts->dev, "failed to register gpio %d\n",
ec51b7f5 MH	464	ts->gc.base);
	465	}
	466
	467	return ret;
	468	}
	469
4397c98a	470	static void ad7879_gpio_remove(struct ad7879 *ts)
ec51b7f5	471	{
c838cb3d	472	const struct ad7879_platform_data *pdata = dev_get_platdata(ts->dev);
ec51b7f5	473
88d5e520	474	if (pdata->gpio_export)
	475	gpiochip_remove(&ts->gc);
	476
ec51b7f5 MH	477	}
ec51b7f5 MH	478	#else
4397c98a MF	479	static inline int ad7879_gpio_add(struct ad7879 *ts,
4397c98a MF	480	const struct ad7879_platform_data *pdata)
ec51b7f5 MH	481	{
	482	return 0;
	483	}
	484
4397c98a	485	static inline void ad7879_gpio_remove(struct ad7879 *ts)
ec51b7f5 MH	486	{
	487	}
	488	#endif
b4be468c	489
4397c98a MF	490	struct ad7879 ad7879_probe(struct device dev, u8 devid, unsigned int irq,
4397c98a MF	491	const struct ad7879_bus_ops *bops)
b4be468c	492	{
c838cb3d	493	struct ad7879_platform_data *pdata = dev_get_platdata(dev);
4397c98a	494	struct ad7879 *ts;
b4be468c	495	struct input_dev *input_dev;
b4be468c MH	496	int err;
	497	u16 revid;
	498
4397c98a MF	499	if (!irq) {
	500	dev_err(dev, "no IRQ?\n");
	501	err = -EINVAL;
	502	goto err_out;
b4be468c MH	503	}
	504
	505	if (!pdata) {
4397c98a MF	506	dev_err(dev, "no platform data?\n");
	507	err = -EINVAL;
	508	goto err_out;
b4be468c MH	509	}
b4be468c MH	510
4397c98a	511	ts = kzalloc(sizeof(*ts), GFP_KERNEL);
b4be468c	512	input_dev = input_allocate_device();
4397c98a MF	513	if (!ts \|\| !input_dev) {
	514	err = -ENOMEM;
	515	goto err_free_mem;
	516	}
b4be468c	517
4397c98a MF	518	ts->bops = bops;
4397c98a MF	519	ts->dev = dev;
b4be468c	520	ts->input = input_dev;
14fbbc36	521	ts->irq = irq;
6680884a	522	ts->swap_xy = pdata->swap_xy;
b4be468c MH	523
b4be468c MH	524	setup_timer(&ts->timer, ad7879_timer, (unsigned long) ts);
4397c98a	525
b4be468c MH	526	ts->x_plate_ohms = pdata->x_plate_ohms ? : 400;
	527	ts->pressure_max = pdata->pressure_max ? : ~0;
	528
	529	ts->first_conversion_delay = pdata->first_conversion_delay;
	530	ts->acquisition_time = pdata->acquisition_time;
	531	ts->averaging = pdata->averaging;
	532	ts->pen_down_acc_interval = pdata->pen_down_acc_interval;
	533	ts->median = pdata->median;
	534
4397c98a	535	snprintf(ts->phys, sizeof(ts->phys), "%s/input0", dev_name(dev));
b4be468c MH	536
	537	input_dev->name = "AD7879 Touchscreen";
	538	input_dev->phys = ts->phys;
4397c98a MF	539	input_dev->dev.parent = dev;
4397c98a MF	540	input_dev->id.bustype = bops->bustype;
b4be468c	541
14fbbc36 DT	542	input_dev->open = ad7879_open;
	543	input_dev->close = ad7879_close;
	544
	545	input_set_drvdata(input_dev, ts);
	546
b4be468c MH	547	__set_bit(EV_ABS, input_dev->evbit);
	548	__set_bit(ABS_X, input_dev->absbit);
	549	__set_bit(ABS_Y, input_dev->absbit);
	550	__set_bit(ABS_PRESSURE, input_dev->absbit);
	551
963ce8ae MH	552	__set_bit(EV_KEY, input_dev->evbit);
	553	__set_bit(BTN_TOUCH, input_dev->keybit);
	554
b4be468c MH	555	input_set_abs_params(input_dev, ABS_X,
	556	pdata->x_min ? : 0,
	557	pdata->x_max ? : MAX_12BIT,
	558	0, 0);
	559	input_set_abs_params(input_dev, ABS_Y,
	560	pdata->y_min ? : 0,
	561	pdata->y_max ? : MAX_12BIT,
	562	0, 0);
	563	input_set_abs_params(input_dev, ABS_PRESSURE,
	564	pdata->pressure_min, pdata->pressure_max, 0, 0);
	565
4397c98a	566	err = ad7879_write(ts, AD7879_REG_CTRL2, AD7879_RESET);
b4be468c	567	if (err < 0) {
4397c98a	568	dev_err(dev, "Failed to write %s\n", input_dev->name);
b4be468c MH	569	goto err_free_mem;
	570	}
	571
4397c98a MF	572	revid = ad7879_read(ts, AD7879_REG_REVID);
	573	input_dev->id.product = (revid & 0xff);
	574	input_dev->id.version = revid >> 8;
	575	if (input_dev->id.product != devid) {
	576	dev_err(dev, "Failed to probe %s (%x vs %x)\n",
	577	input_dev->name, devid, revid);
b4be468c MH	578	err = -ENODEV;
	579	goto err_free_mem;
	580	}
	581
ec51b7f5 MH	582	ts->cmd_crtl3 = AD7879_YPLUS_BIT \|
	583	AD7879_XPLUS_BIT \|
	584	AD7879_Z2_BIT \|
	585	AD7879_Z1_BIT \|
	586	AD7879_TEMPMASK_BIT \|
	587	AD7879_AUXVBATMASK_BIT \|
	588	AD7879_GPIOALERTMASK_BIT;
	589
	590	ts->cmd_crtl2 = AD7879_PM(AD7879_PM_DYN) \| AD7879_DFR \|
	591	AD7879_AVG(ts->averaging) \|
	592	AD7879_MFS(ts->median) \|
	593	AD7879_FCD(ts->first_conversion_delay);
	594
	595	ts->cmd_crtl1 = AD7879_MODE_INT \| AD7879_MODE_SEQ1 \|
	596	AD7879_ACQ(ts->acquisition_time) \|
	597	AD7879_TMR(ts->pen_down_acc_interval);
	598
4397c98a	599	err = request_threaded_irq(ts->irq, NULL, ad7879_irq,
9b7e31bb	600	IRQF_TRIGGER_FALLING \| IRQF_ONESHOT,
4397c98a	601	dev_name(dev), ts);
b4be468c	602	if (err) {
4397c98a	603	dev_err(dev, "irq %d busy?\n", ts->irq);
b4be468c MH	604	goto err_free_mem;
	605	}
	606
14fbbc36 DT	607	__ad7879_disable(ts);
14fbbc36 DT	608
4397c98a	609	err = sysfs_create_group(&dev->kobj, &ad7879_attr_group);
b4be468c MH	610	if (err)
	611	goto err_free_irq;
	612
4397c98a	613	err = ad7879_gpio_add(ts, pdata);
b4be468c MH	614	if (err)
	615	goto err_remove_attr;
	616
ec51b7f5 MH	617	err = input_register_device(input_dev);
	618	if (err)
	619	goto err_remove_gpio;
	620
4397c98a	621	return ts;
b4be468c	622
ec51b7f5	623	err_remove_gpio:
4397c98a	624	ad7879_gpio_remove(ts);
b4be468c	625	err_remove_attr:
4397c98a	626	sysfs_remove_group(&dev->kobj, &ad7879_attr_group);
b4be468c	627	err_free_irq:
4397c98a	628	free_irq(ts->irq, ts);
b4be468c MH	629	err_free_mem:
b4be468c MH	630	input_free_device(input_dev);
4397c98a MF	631	kfree(ts);
	632	err_out:
	633	return ERR_PTR(err);
b4be468c	634	}
4397c98a	635	EXPORT_SYMBOL(ad7879_probe);
b4be468c	636
4397c98a	637	void ad7879_remove(struct ad7879 *ts)
b4be468c	638	{
4397c98a	639	ad7879_gpio_remove(ts);
4397c98a MF	640	sysfs_remove_group(&ts->dev->kobj, &ad7879_attr_group);
4397c98a MF	641	free_irq(ts->irq, ts);
b4be468c	642	input_unregister_device(ts->input);
b4be468c	643	kfree(ts);
b4be468c	644	}
4397c98a	645	EXPORT_SYMBOL(ad7879_remove);
b4be468c MH	646
	647	MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
	648	MODULE_DESCRIPTION("AD7879(-1) touchscreen Driver");
	649	MODULE_LICENSE("GPL");