ads7846.c 33.6 KB
Newer Older
D
David Brownell 已提交
1 2 3 4
/*
 * ADS7846 based touchscreen and sensor driver
 *
 * Copyright (c) 2005 David Brownell
I
Imre Deak 已提交
5 6
 * Copyright (c) 2006 Nokia Corporation
 * Various changes: Imre Deak <imre.deak@nokia.com>
D
David Brownell 已提交
7 8 9 10 11 12 13 14 15 16 17 18 19
 *
 * 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.
 */
20
#include <linux/types.h>
21
#include <linux/hwmon.h>
D
David Brownell 已提交
22
#include <linux/init.h>
23
#include <linux/err.h>
24
#include <linux/sched.h>
D
David Brownell 已提交
25 26 27 28
#include <linux/delay.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/slab.h>
29
#include <linux/pm.h>
30
#include <linux/gpio.h>
D
David Brownell 已提交
31 32
#include <linux/spi/spi.h>
#include <linux/spi/ads7846.h>
33
#include <linux/regulator/consumer.h>
34
#include <asm/irq.h>
D
David Brownell 已提交
35 36

/*
37
 * This code has been heavily tested on a Nokia 770, and lightly
38
 * tested on other ads7846 devices (OSK/Mistral, Lubbock, Spitz).
39
 * TSC2046 is just newer ads7846 silicon.
40 41
 * Support for ads7843 tested on Atmel at91sam926x-EK.
 * Support for ads7845 has only been stubbed in.
42
 * Support for Analog Devices AD7873 and AD7843 tested.
D
David Brownell 已提交
43
 *
I
Imre Deak 已提交
44 45 46 47 48 49
 * 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.
 *
50
 * App note sbaa036 talks in more detail about accurate sampling...
D
David Brownell 已提交
51 52
 * that ought to help in situations like LCDs inducing noise (which
 * can also be helped by using synch signals) and more generally.
I
Imre Deak 已提交
53 54 55
 * This driver tries to utilize the measures described in the app
 * note. The strength of filtering can be set in the board-* specific
 * files.
D
David Brownell 已提交
56 57
 */

58 59
#define TS_POLL_DELAY	1	/* ms delay before the first sample */
#define TS_POLL_PERIOD	5	/* ms delay between samples */
D
David Brownell 已提交
60

61 62 63
/* this driver doesn't aim at the peak continuous sample rate */
#define	SAMPLE_BITS	(8 /*cmd*/ + 16 /*sample*/ + 2 /* before, after */)

D
David Brownell 已提交
64
struct ts_event {
65 66 67
	/*
	 * For portability, we can't read 12 bit values using SPI (which
	 * would make the controller deliver them as native byte order u16
68
	 * with msbs zeroed).  Instead, we read them as two 8-bit values,
69
	 * *** WHICH NEED BYTESWAPPING *** and range adjustment.
D
David Brownell 已提交
70
	 */
71 72 73
	u16	x;
	u16	y;
	u16	z1, z2;
74
	bool	ignore;
75 76
	u8	x_buf[3];
	u8	y_buf[3];
D
David Brownell 已提交
77 78
};

79 80 81 82 83 84 85 86 87
/*
 * 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;
88 89
	/* for ads7845 with mpc5121 psc spi we use 3-byte buffers */
	u8			read_x_cmd[3], read_y_cmd[3], pwrdown_cmd[3];
90 91
};

D
David Brownell 已提交
92
struct ads7846 {
93
	struct input_dev	*input;
D
David Brownell 已提交
94
	char			phys[32];
95
	char			name[32];
D
David Brownell 已提交
96 97

	struct spi_device	*spi;
98
	struct regulator	*reg;
99 100

#if defined(CONFIG_HWMON) || defined(CONFIG_HWMON_MODULE)
101
	struct attribute_group	*attr_group;
102
	struct device		*hwmon;
103 104
#endif

D
David Brownell 已提交
105
	u16			model;
106
	u16			vref_mv;
D
David Brownell 已提交
107 108
	u16			vref_delay_usecs;
	u16			x_plate_ohms;
109
	u16			pressure_max;
D
David Brownell 已提交
110

111
	bool			swap_xy;
112
	bool			use_internal;
113

114
	struct ads7846_packet	*packet;
D
David Brownell 已提交
115

116
	struct spi_transfer	xfer[18];
117
	struct spi_message	msg[5];
118 119 120 121 122
	int			msg_count;
	wait_queue_head_t	wait;

	bool			pendown;

123
	int			read_cnt;
124
	int			read_rep;
125 126 127 128
	int			last_read;

	u16			debounce_max;
	u16			debounce_tol;
129
	u16			debounce_rep;
D
David Brownell 已提交
130

131 132
	u16			penirq_recheck_delay_usecs;

133 134 135 136
	struct mutex		lock;
	bool			stopped;	/* P: lock */
	bool			disabled;	/* P: lock */
	bool			suspended;	/* P: lock */
137

138 139 140
	int			(*filter)(void *data, int data_idx, int *val);
	void			*filter_data;
	void			(*filter_cleanup)(void *data);
141
	int			(*get_pendown_state)(void);
142
	int			gpio_pendown;
143 144

	void			(*wait_for_sync)(void);
D
David Brownell 已提交
145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
};

/* 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 */
172
#define	ADS_PD10_PDOWN		(0 << 0)	/* low power mode + penirq */
D
David Brownell 已提交
173 174 175 176 177 178 179
#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 */
180 181 182
#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))
D
David Brownell 已提交
183

184 185 186
#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))
187

188 189
#define	READ_X(vref)	(READ_12BIT_DFR(x,  1, vref))
#define	PWRDOWN		(READ_12BIT_DFR(y,  0, 0))	/* LAST */
D
David Brownell 已提交
190 191 192 193 194 195 196

/* 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)

197 198
#define	REF_ON	(READ_12BIT_DFR(x, 1, 1))
#define	REF_OFF	(READ_12BIT_DFR(y, 0, 0))
D
David Brownell 已提交
199

200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271
/* 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)
{
	regulator_enable(ts->reg);
	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);
}

D
David Brownell 已提交
272 273 274 275
/*--------------------------------------------------------------------------*/

/*
 * Non-touchscreen sensors only use single-ended conversions.
276 277
 * The range is GND..vREF. The ads7843 and ads7835 must use external vREF;
 * ads7846 lets that pin be unconnected, to use internal vREF.
D
David Brownell 已提交
278 279 280
 */

struct ser_req {
281
	u8			ref_on;
D
David Brownell 已提交
282
	u8			command;
283
	u8			ref_off;
D
David Brownell 已提交
284 285 286
	u16			scratch;
	struct spi_message	msg;
	struct spi_transfer	xfer[6];
287 288 289 290 291
	/*
	 * DMA (thus cache coherency maintenance) requires the
	 * transfer buffers to live in their own cache lines.
	 */
	__be16 sample ____cacheline_aligned;
D
David Brownell 已提交
292 293
};

294 295 296 297
struct ads7845_ser_req {
	u8			command[3];
	struct spi_message	msg;
	struct spi_transfer	xfer[2];
298 299 300 301 302
	/*
	 * DMA (thus cache coherency maintenance) requires the
	 * transfer buffers to live in their own cache lines.
	 */
	u8 sample[3] ____cacheline_aligned;
303 304
};

D
David Brownell 已提交
305 306
static int ads7846_read12_ser(struct device *dev, unsigned command)
{
307 308 309 310
	struct spi_device *spi = to_spi_device(dev);
	struct ads7846 *ts = dev_get_drvdata(dev);
	struct ser_req *req;
	int status;
D
David Brownell 已提交
311

312
	req = kzalloc(sizeof *req, GFP_KERNEL);
D
David Brownell 已提交
313 314 315
	if (!req)
		return -ENOMEM;

316
	spi_message_init(&req->msg);
317

318
	/* maybe turn on internal vREF, and let it settle */
319
	if (ts->use_internal) {
320 321 322 323 324 325 326 327 328 329 330
		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);
331 332 333

		/* Enable reference voltage */
		command |= ADS_PD10_REF_ON;
334
	}
D
David Brownell 已提交
335

336 337 338
	/* Enable ADC in every case */
	command |= ADS_PD10_ADC_ON;

D
David Brownell 已提交
339 340 341 342
	/* take sample */
	req->command = (u8) command;
	req->xfer[2].tx_buf = &req->command;
	req->xfer[2].len = 1;
343 344
	spi_message_add_tail(&req->xfer[2], &req->msg);

D
David Brownell 已提交
345 346
	req->xfer[3].rx_buf = &req->sample;
	req->xfer[3].len = 2;
347
	spi_message_add_tail(&req->xfer[3], &req->msg);
D
David Brownell 已提交
348 349 350

	/* REVISIT:  take a few more samples, and compare ... */

351 352 353 354 355 356 357 358 359 360
	/* 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);
D
David Brownell 已提交
361

362 363
	mutex_lock(&ts->lock);
	ads7846_stop(ts);
D
David Brownell 已提交
364
	status = spi_sync(spi, &req->msg);
365 366
	ads7846_restart(ts);
	mutex_unlock(&ts->lock);
D
David Brownell 已提交
367

368 369
	if (status == 0) {
		/* on-wire is a must-ignore bit, a BE12 value, then padding */
370 371 372
		status = be16_to_cpu(req->sample);
		status = status >> 3;
		status &= 0x0fff;
373
	}
D
David Brownell 已提交
374

375
	kfree(req);
376
	return status;
D
David Brownell 已提交
377 378
}

379 380
static int ads7845_read12_ser(struct device *dev, unsigned command)
{
381 382 383 384
	struct spi_device *spi = to_spi_device(dev);
	struct ads7846 *ts = dev_get_drvdata(dev);
	struct ads7845_ser_req *req;
	int status;
385

386
	req = kzalloc(sizeof *req, GFP_KERNEL);
387 388 389 390 391 392 393 394 395 396 397
	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);

398 399
	mutex_lock(&ts->lock);
	ads7846_stop(ts);
400
	status = spi_sync(spi, &req->msg);
401 402
	ads7846_restart(ts);
	mutex_unlock(&ts->lock);
403 404 405 406 407 408 409 410 411 412 413 414

	if (status == 0) {
		/* BE12 value, then padding */
		status = be16_to_cpu(*((u16 *)&req->sample[1]));
		status = status >> 3;
		status &= 0x0fff;
	}

	kfree(req);
	return status;
}

415 416 417
#if defined(CONFIG_HWMON) || defined(CONFIG_HWMON_MODULE)

#define SHOW(name, var, adjust) static ssize_t \
D
David Brownell 已提交
418 419
name ## _show(struct device *dev, struct device_attribute *attr, char *buf) \
{ \
420
	struct ads7846 *ts = dev_get_drvdata(dev); \
D
David Brownell 已提交
421
	ssize_t v = ads7846_read12_ser(dev, \
422
			READ_12BIT_SER(var)); \
D
David Brownell 已提交
423 424
	if (v < 0) \
		return v; \
425
	return sprintf(buf, "%u\n", adjust(ts, v)); \
D
David Brownell 已提交
426 427 428
} \
static DEVICE_ATTR(name, S_IRUGO, name ## _show, NULL);

429

430
/* Sysfs conventions report temperatures in millidegrees Celsius.
431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452
 * 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 */
453
	retval *= ts->vref_mv;
454
	retval = retval >> 12;
455

456 457 458 459 460 461 462 463 464 465
	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;
466

467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505
	return retval;
}

SHOW(in0_input, vaux, vaux_adjust)
SHOW(in1_input, vbatt, vbatt_adjust)

static struct attribute *ads7846_attributes[] = {
	&dev_attr_temp0.attr,
	&dev_attr_temp1.attr,
	&dev_attr_in0_input.attr,
	&dev_attr_in1_input.attr,
	NULL,
};

static struct attribute_group ads7846_attr_group = {
	.attrs = ads7846_attributes,
};

static struct attribute *ads7843_attributes[] = {
	&dev_attr_in0_input.attr,
	&dev_attr_in1_input.attr,
	NULL,
};

static struct attribute_group ads7843_attr_group = {
	.attrs = ads7843_attributes,
};

static struct attribute *ads7845_attributes[] = {
	&dev_attr_in0_input.attr,
	NULL,
};

static struct attribute_group ads7845_attr_group = {
	.attrs = ads7845_attributes,
};

static int ads784x_hwmon_register(struct spi_device *spi, struct ads7846 *ts)
{
506
	struct device *hwmon;
507 508 509 510 511
	int err;

	/* hwmon sensors need a reference voltage */
	switch (ts->model) {
	case 7846:
512
		if (!ts->vref_mv) {
513
			dev_dbg(&spi->dev, "assuming 2.5V internal vREF\n");
514
			ts->vref_mv = 2500;
515
			ts->use_internal = true;
516 517 518 519
		}
		break;
	case 7845:
	case 7843:
520
		if (!ts->vref_mv) {
521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
			dev_warn(&spi->dev,
				"external vREF for ADS%d not specified\n",
				ts->model);
			return 0;
		}
		break;
	}

	/* different chips have different sensor groups */
	switch (ts->model) {
	case 7846:
		ts->attr_group = &ads7846_attr_group;
		break;
	case 7845:
		ts->attr_group = &ads7845_attr_group;
		break;
	case 7843:
		ts->attr_group = &ads7843_attr_group;
		break;
	default:
		dev_dbg(&spi->dev, "ADS%d not recognized\n", ts->model);
		return 0;
	}

	err = sysfs_create_group(&spi->dev.kobj, ts->attr_group);
	if (err)
		return err;

	hwmon = hwmon_device_register(&spi->dev);
	if (IS_ERR(hwmon)) {
		sysfs_remove_group(&spi->dev.kobj, ts->attr_group);
		return PTR_ERR(hwmon);
	}

	ts->hwmon = hwmon;
	return 0;
}

static void ads784x_hwmon_unregister(struct spi_device *spi,
				     struct ads7846 *ts)
{
	if (ts->hwmon) {
		sysfs_remove_group(&spi->dev.kobj, ts->attr_group);
		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
D
David Brownell 已提交
580

581 582 583
static ssize_t ads7846_pen_down_show(struct device *dev,
				     struct device_attribute *attr, char *buf)
{
584 585 586
	struct ads7846 *ts = dev_get_drvdata(dev);

	return sprintf(buf, "%u\n", ts->pendown);
587 588 589 590
}

static DEVICE_ATTR(pen_down, S_IRUGO, ads7846_pen_down_show, NULL);

I
Imre Deak 已提交
591 592 593
static ssize_t ads7846_disable_show(struct device *dev,
				     struct device_attribute *attr, char *buf)
{
594
	struct ads7846 *ts = dev_get_drvdata(dev);
I
Imre Deak 已提交
595 596 597 598 599 600 601 602 603

	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);
604
	unsigned long i;
605 606 607

	if (strict_strtoul(buf, 10, &i))
		return -EINVAL;
I
Imre Deak 已提交
608 609 610 611 612 613 614 615 616 617 618

	if (i)
		ads7846_disable(ts);
	else
		ads7846_enable(ts);

	return count;
}

static DEVICE_ATTR(disable, 0664, ads7846_disable_show, ads7846_disable_store);

619
static struct attribute *ads784x_attributes[] = {
620 621 622 623 624
	&dev_attr_pen_down.attr,
	&dev_attr_disable.attr,
	NULL,
};

625 626
static struct attribute_group ads784x_attr_group = {
	.attrs = ads784x_attributes,
627 628
};

D
David Brownell 已提交
629 630
/*--------------------------------------------------------------------------*/

631 632 633 634 635 636 637 638
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);
}

639 640 641 642
static void null_wait_for_sync(void)
{
}

643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
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) {
D
David Brownell 已提交
740

741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768
			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)
D
David Brownell 已提交
769
{
770 771 772
	struct ads7846_packet *packet = ts->packet;
	unsigned int Rt;
	u16 x, y, z1, z2;
D
David Brownell 已提交
773

774 775 776 777
	/*
	 * ads7846_get_value() does in-place conversion (including byte swap)
	 * from on-the-wire format as part of debouncing to get stable
	 * readings.
D
David Brownell 已提交
778
	 */
779 780 781 782 783 784 785 786 787 788 789
	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;
	}
D
David Brownell 已提交
790 791 792 793 794

	/* range filtering */
	if (x == MAX_12BIT)
		x = 0;

795 796
	if (ts->model == 7843) {
		Rt = ts->pressure_max / 2;
797 798 799 800 801 802
	} 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);
803
	} else if (likely(x && z1)) {
D
David Brownell 已提交
804 805 806 807 808 809 810
		/* compute touch pressure resistance using equation #2 */
		Rt = z2;
		Rt -= z1;
		Rt *= x;
		Rt *= ts->x_plate_ohms;
		Rt /= z1;
		Rt = (Rt + 2047) >> 12;
811
	} else {
D
David Brownell 已提交
812
		Rt = 0;
813
	}
814

815 816
	/*
	 * Sample found inconsistent by debouncing or pressure is beyond
817 818 819
	 * the maximum. Don't report it to user space, repeat at least
	 * once more the measurement
	 */
820
	if (packet->tc.ignore || Rt > ts->pressure_max) {
821 822
		dev_vdbg(&ts->spi->dev, "ignored %d pressure %d\n",
			 packet->tc.ignore, Rt);
823 824 825
		return;
	}

826 827
	/*
	 * Maybe check the pendown state before reporting. This discards
828 829 830 831
	 * false readings when the pen is lifted.
	 */
	if (ts->penirq_recheck_delay_usecs) {
		udelay(ts->penirq_recheck_delay_usecs);
832
		if (!get_pendown_state(ts))
833 834 835
			Rt = 0;
	}

836 837 838
	/*
	 * NOTE: We can't rely on the pressure to determine the pen down
	 * state, even this controller has a pressure sensor. The pressure
839 840
	 * value can fluctuate for quite a while after lifting the pen and
	 * in some cases may not even settle at the expected value.
D
David Brownell 已提交
841
	 *
842 843
	 * 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).
D
David Brownell 已提交
844 845
	 */
	if (Rt) {
846
		struct input_dev *input = ts->input;
847

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

851 852
		if (!ts->pendown) {
			input_report_key(input, BTN_TOUCH, 1);
853
			ts->pendown = true;
854
			dev_vdbg(&ts->spi->dev, "DOWN\n");
855
		}
856

857 858
		input_report_abs(input, ABS_X, x);
		input_report_abs(input, ABS_Y, y);
859
		input_report_abs(input, ABS_PRESSURE, ts->pressure_max - Rt);
D
David Brownell 已提交
860

861
		input_sync(input);
862
		dev_vdbg(&ts->spi->dev, "%4d/%4d/%4d\n", x, y, Rt);
863
	}
864 865
}

866
static irqreturn_t ads7846_hard_irq(int irq, void *handle)
867
{
868
	struct ads7846 *ts = handle;
869

870
	return get_pendown_state(ts) ? IRQ_WAKE_THREAD : IRQ_HANDLED;
871 872 873
}


874
static irqreturn_t ads7846_irq(int irq, void *handle)
875 876
{
	struct ads7846 *ts = handle;
I
Imre Deak 已提交
877

878 879
	/* Start with a small delay before checking pendown state */
	msleep(TS_POLL_DELAY);
D
David Brownell 已提交
880

881
	while (!ts->stopped && get_pendown_state(ts)) {
D
David Brownell 已提交
882

883 884
		/* pen is down, continue with the measurement */
		ads7846_read_state(ts);
D
David Brownell 已提交
885

886 887
		if (!ts->stopped)
			ads7846_report_state(ts);
888

889 890
		wait_event_timeout(ts->wait, ts->stopped,
				   msecs_to_jiffies(TS_POLL_PERIOD));
D
David Brownell 已提交
891 892
	}

893 894
	if (ts->pendown) {
		struct input_dev *input = ts->input;
I
Imre Deak 已提交
895

896 897 898
		input_report_key(input, BTN_TOUCH, 0);
		input_report_abs(input, ABS_PRESSURE, 0);
		input_sync(input);
I
Imre Deak 已提交
899

900 901 902
		ts->pendown = false;
		dev_vdbg(&ts->spi->dev, "UP\n");
	}
903

904
	return IRQ_HANDLED;
I
Imre Deak 已提交
905 906
}

907 908
#ifdef CONFIG_PM_SLEEP
static int ads7846_suspend(struct device *dev)
I
Imre Deak 已提交
909
{
910
	struct ads7846 *ts = dev_get_drvdata(dev);
I
Imre Deak 已提交
911

912
	mutex_lock(&ts->lock);
I
Imre Deak 已提交
913

914
	if (!ts->suspended) {
I
Imre Deak 已提交
915

916 917
		if (!ts->disabled)
			__ads7846_disable(ts);
I
Imre Deak 已提交
918

919 920
		if (device_may_wakeup(&ts->spi->dev))
			enable_irq_wake(ts->spi->irq);
921

922 923 924 925
		ts->suspended = true;
	}

	mutex_unlock(&ts->lock);
I
Imre Deak 已提交
926

927
	return 0;
D
David Brownell 已提交
928 929
}

930
static int ads7846_resume(struct device *dev)
D
David Brownell 已提交
931
{
932
	struct ads7846 *ts = dev_get_drvdata(dev);
D
David Brownell 已提交
933

934 935 936
	mutex_lock(&ts->lock);

	if (ts->suspended) {
937

938
		ts->suspended = false;
I
Imre Deak 已提交
939

940 941
		if (device_may_wakeup(&ts->spi->dev))
			disable_irq_wake(ts->spi->irq);
I
Imre Deak 已提交
942

943 944 945 946 947
		if (!ts->disabled)
			__ads7846_enable(ts);
	}

	mutex_unlock(&ts->lock);
I
Imre Deak 已提交
948

D
David Brownell 已提交
949 950
	return 0;
}
951 952 953
#endif

static SIMPLE_DEV_PM_OPS(ads7846_pm, ads7846_suspend, ads7846_resume);
D
David Brownell 已提交
954

955
static int __devinit ads7846_setup_pendown(struct spi_device *spi, struct ads7846 *ts)
956 957 958 959
{
	struct ads7846_platform_data *pdata = spi->dev.platform_data;
	int err;

960 961
	/*
	 * REVISIT when the irq can be triggered active-low, or if for some
962 963 964 965 966 967
	 * 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;
968
	} else if (gpio_is_valid(pdata->gpio_pendown)) {
969

970 971
		err = gpio_request_one(pdata->gpio_pendown, GPIOF_IN,
				       "ads7846_pendown");
972
		if (err) {
973 974 975
			dev_err(&spi->dev,
				"failed to request/setup pendown GPIO%d: %d\n",
				pdata->gpio_pendown, err);
976 977
			return err;
		}
978

979 980 981 982 983 984
		ts->gpio_pendown = pdata->gpio_pendown;

	} else {
		dev_err(&spi->dev, "no get_pendown_state nor gpio_pendown?\n");
		return -EINVAL;
	}
985

986 987 988
	return 0;
}

989 990 991 992 993 994
/*
 * Set up the transfers to read touchscreen state; this assumes we
 * use formula #2 for pressure, not #3.
 */
static void __devinit ads7846_setup_spi_msg(struct ads7846 *ts,
				const struct ads7846_platform_data *pdata)
D
David Brownell 已提交
995
{
996 997 998 999
	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;
1000

1001
	if (ts->model == 7873) {
1002 1003
		/*
		 * The AD7873 is almost identical to the ADS7846
1004
		 * keep VREF off during differential/ratiometric
1005
		 * conversion modes.
1006 1007 1008 1009 1010
		 */
		ts->model = 7846;
		vref = 0;
	}

1011
	ts->msg_count = 1;
1012
	spi_message_init(m);
1013
	m->context = ts;
1014

1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
	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);
1029

1030 1031 1032 1033 1034
		x++;
		x->rx_buf = &packet->tc.y;
		x->len = 2;
		spi_message_add_tail(x, m);
	}
1035

1036 1037
	/*
	 * The first sample after switching drivers can be low quality;
1038 1039 1040 1041 1042 1043 1044
	 * 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++;
1045
		x->tx_buf = &packet->read_y;
1046 1047 1048 1049
		x->len = 1;
		spi_message_add_tail(x, m);

		x++;
1050
		x->rx_buf = &packet->tc.y;
1051 1052 1053 1054
		x->len = 2;
		spi_message_add_tail(x, m);
	}

1055
	ts->msg_count++;
1056 1057
	m++;
	spi_message_init(m);
1058
	m->context = ts;
1059

1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
	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);
1076

1077 1078 1079 1080 1081
		x++;
		x->rx_buf = &packet->tc.x;
		x->len = 2;
		spi_message_add_tail(x, m);
	}
1082

1083 1084 1085 1086 1087
	/* ... maybe discard first sample ... */
	if (pdata->settle_delay_usecs) {
		x->delay_usecs = pdata->settle_delay_usecs;

		x++;
1088
		x->tx_buf = &packet->read_x;
1089 1090 1091 1092
		x->len = 1;
		spi_message_add_tail(x, m);

		x++;
1093
		x->rx_buf = &packet->tc.x;
1094 1095 1096 1097
		x->len = 2;
		spi_message_add_tail(x, m);
	}

D
David Brownell 已提交
1098 1099
	/* turn y+ off, x- on; we'll use formula #2 */
	if (ts->model == 7846) {
1100
		ts->msg_count++;
1101 1102
		m++;
		spi_message_init(m);
1103
		m->context = ts;
1104

1105
		x++;
1106 1107
		packet->read_z1 = READ_Z1(vref);
		x->tx_buf = &packet->read_z1;
D
David Brownell 已提交
1108
		x->len = 1;
1109
		spi_message_add_tail(x, m);
1110

D
David Brownell 已提交
1111
		x++;
1112
		x->rx_buf = &packet->tc.z1;
D
David Brownell 已提交
1113
		x->len = 2;
1114 1115
		spi_message_add_tail(x, m);

1116 1117 1118 1119 1120
		/* ... maybe discard first sample ... */
		if (pdata->settle_delay_usecs) {
			x->delay_usecs = pdata->settle_delay_usecs;

			x++;
1121
			x->tx_buf = &packet->read_z1;
1122 1123 1124 1125
			x->len = 1;
			spi_message_add_tail(x, m);

			x++;
1126
			x->rx_buf = &packet->tc.z1;
1127 1128 1129 1130
			x->len = 2;
			spi_message_add_tail(x, m);
		}

1131
		ts->msg_count++;
1132 1133
		m++;
		spi_message_init(m);
1134
		m->context = ts;
D
David Brownell 已提交
1135

1136
		x++;
1137 1138
		packet->read_z2 = READ_Z2(vref);
		x->tx_buf = &packet->read_z2;
D
David Brownell 已提交
1139
		x->len = 1;
1140
		spi_message_add_tail(x, m);
1141

D
David Brownell 已提交
1142
		x++;
1143
		x->rx_buf = &packet->tc.z2;
D
David Brownell 已提交
1144
		x->len = 2;
1145
		spi_message_add_tail(x, m);
D
David Brownell 已提交
1146

1147 1148 1149 1150 1151
		/* ... maybe discard first sample ... */
		if (pdata->settle_delay_usecs) {
			x->delay_usecs = pdata->settle_delay_usecs;

			x++;
1152
			x->tx_buf = &packet->read_z2;
1153 1154 1155 1156
			x->len = 1;
			spi_message_add_tail(x, m);

			x++;
1157
			x->rx_buf = &packet->tc.z2;
1158 1159 1160
			x->len = 2;
			spi_message_add_tail(x, m);
		}
1161
	}
1162 1163

	/* power down */
1164
	ts->msg_count++;
1165 1166
	m++;
	spi_message_init(m);
1167
	m->context = ts;
1168

1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186
	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;
	}
1187

1188
	CS_CHANGE(*x);
1189
	spi_message_add_tail(x, m);
1190
}
D
David Brownell 已提交
1191

1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
static int __devinit ads7846_probe(struct spi_device *spi)
{
	struct ads7846 *ts;
	struct ads7846_packet *packet;
	struct input_dev *input_dev;
	struct ads7846_platform_data *pdata = spi->dev.platform_data;
	unsigned long irq_flags;
	int err;

	if (!spi->irq) {
		dev_dbg(&spi->dev, "no IRQ?\n");
		return -ENODEV;
	}

	if (!pdata) {
		dev_dbg(&spi->dev, "no platform data?\n");
		return -ENODEV;
	}

	/* don't exceed max specified sample rate */
	if (spi->max_speed_hz > (125000 * SAMPLE_BITS)) {
		dev_dbg(&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;
D
David Brownell 已提交
1227

1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302
	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;
	}

	dev_set_drvdata(&spi->dev, ts);

	ts->packet = packet;
	ts->spi = spi;
	ts->input = input_dev;
	ts->vref_mv = pdata->vref_mv;
	ts->swap_xy = pdata->swap_xy;

	mutex_init(&ts->lock);
	init_waitqueue_head(&ts->wait);

	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;

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

1304 1305
	ts->reg = regulator_get(&spi->dev, "vcc");
	if (IS_ERR(ts->reg)) {
1306
		err = PTR_ERR(ts->reg);
1307
		dev_err(&spi->dev, "unable to get regulator: %d\n", err);
1308 1309 1310 1311 1312 1313 1314 1315 1316
		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;
	}

1317
	irq_flags = pdata->irq_flags ? : IRQF_TRIGGER_FALLING;
1318
	irq_flags |= IRQF_ONESHOT;
1319

1320 1321
	err = request_threaded_irq(spi->irq, ads7846_hard_irq, ads7846_irq,
				   irq_flags, spi->dev.driver->name, ts);
1322
	if (err && !pdata->irq_flags) {
1323 1324
		dev_info(&spi->dev,
			"trying pin change workaround on irq %d\n", spi->irq);
1325 1326 1327 1328
		irq_flags |= IRQF_TRIGGER_RISING;
		err = request_threaded_irq(spi->irq,
				  ads7846_hard_irq, ads7846_irq,
				  irq_flags, spi->dev.driver->name, ts);
1329 1330 1331 1332 1333
	}

	if (err) {
		dev_dbg(&spi->dev, "irq %d busy?\n", spi->irq);
		goto err_disable_regulator;
D
David Brownell 已提交
1334 1335
	}

1336 1337 1338 1339
	err = ads784x_hwmon_register(spi, ts);
	if (err)
		goto err_free_irq;

1340
	dev_info(&spi->dev, "touchscreen, irq %d\n", spi->irq);
D
David Brownell 已提交
1341

1342 1343
	/*
	 * Take a first sample, leaving nPENIRQ active and vREF off; avoid
D
David Brownell 已提交
1344 1345
	 * the touchscreen, in case it's not connected.
	 */
1346 1347 1348
	if (ts->model == 7845)
		ads7845_read12_ser(&spi->dev, PWRDOWN);
	else
1349
		(void) ads7846_read12_ser(&spi->dev, READ_12BIT_SER(vaux));
D
David Brownell 已提交
1350

1351
	err = sysfs_create_group(&spi->dev.kobj, &ads784x_attr_group);
1352
	if (err)
1353
		goto err_remove_hwmon;
I
Imre Deak 已提交
1354

1355 1356
	err = input_register_device(input_dev);
	if (err)
1357
		goto err_remove_attr_group;
1358

1359 1360
	device_init_wakeup(&spi->dev, pdata->wakeup);

D
David Brownell 已提交
1361
	return 0;
1362

1363
 err_remove_attr_group:
1364 1365 1366
	sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group);
 err_remove_hwmon:
	ads784x_hwmon_unregister(spi, ts);
1367
 err_free_irq:
1368
	free_irq(spi->irq, ts);
1369 1370 1371 1372
 err_disable_regulator:
	regulator_disable(ts->reg);
 err_put_regulator:
	regulator_put(ts->reg);
1373
 err_free_gpio:
1374
	if (!ts->get_pendown_state)
1375
		gpio_free(ts->gpio_pendown);
1376 1377 1378
 err_cleanup_filter:
	if (ts->filter_cleanup)
		ts->filter_cleanup(ts->filter_data);
1379 1380
 err_free_mem:
	input_free_device(input_dev);
1381
	kfree(packet);
1382 1383
	kfree(ts);
	return err;
D
David Brownell 已提交
1384 1385
}

1386
static int __devexit ads7846_remove(struct spi_device *spi)
D
David Brownell 已提交
1387
{
1388
	struct ads7846 *ts = dev_get_drvdata(&spi->dev);
D
David Brownell 已提交
1389

1390 1391
	device_init_wakeup(&spi->dev, false);

1392
	sysfs_remove_group(&spi->dev.kobj, &ads784x_attr_group);
D
David Brownell 已提交
1393

1394
	ads7846_disable(ts);
I
Imre Deak 已提交
1395
	free_irq(ts->spi->irq, ts);
1396 1397 1398 1399

	input_unregister_device(ts->input);

	ads784x_hwmon_unregister(spi, ts);
I
Imre Deak 已提交
1400

1401 1402 1403
	regulator_disable(ts->reg);
	regulator_put(ts->reg);

1404 1405 1406 1407 1408
	if (!ts->get_pendown_state) {
		/*
		 * If we are not using specialized pendown method we must
		 * have been relying on gpio we set up ourselves.
		 */
1409
		gpio_free(ts->gpio_pendown);
1410
	}
1411

1412 1413 1414
	if (ts->filter_cleanup)
		ts->filter_cleanup(ts->filter_data);

1415
	kfree(ts->packet);
D
David Brownell 已提交
1416 1417
	kfree(ts);

1418
	dev_dbg(&spi->dev, "unregistered touchscreen\n");
1419

D
David Brownell 已提交
1420 1421 1422
	return 0;
}

1423 1424 1425 1426 1427
static struct spi_driver ads7846_driver = {
	.driver = {
		.name	= "ads7846",
		.bus	= &spi_bus_type,
		.owner	= THIS_MODULE,
1428
		.pm	= &ads7846_pm,
1429
	},
D
David Brownell 已提交
1430
	.probe		= ads7846_probe,
1431
	.remove		= __devexit_p(ads7846_remove),
D
David Brownell 已提交
1432 1433 1434 1435
};

static int __init ads7846_init(void)
{
1436
	return spi_register_driver(&ads7846_driver);
D
David Brownell 已提交
1437 1438 1439 1440 1441
}
module_init(ads7846_init);

static void __exit ads7846_exit(void)
{
1442
	spi_unregister_driver(&ads7846_driver);
D
David Brownell 已提交
1443 1444 1445 1446 1447
}
module_exit(ads7846_exit);

MODULE_DESCRIPTION("ADS7846 TouchScreen Driver");
MODULE_LICENSE("GPL");
1448
MODULE_ALIAS("spi:ads7846");