|  | /* | 
|  | * TSC2005 touchscreen driver | 
|  | * | 
|  | * Copyright (C) 2006-2010 Nokia Corporation | 
|  | * | 
|  | * Author: Lauri Leukkunen <lauri.leukkunen@nokia.com> | 
|  | * based on TSC2301 driver by Klaus K. Pedersen <klaus.k.pedersen@nokia.com> | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License as published by | 
|  | * the Free Software Foundation; either version 2 of the License, or | 
|  | * (at your option) any later version. | 
|  | * | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | 
|  | * GNU General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/input.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/pm.h> | 
|  | #include <linux/spi/spi.h> | 
|  | #include <linux/spi/tsc2005.h> | 
|  |  | 
|  | /* | 
|  | * The touchscreen interface operates as follows: | 
|  | * | 
|  | * 1) Pen is pressed against the touchscreen. | 
|  | * 2) TSC2005 performs AD conversion. | 
|  | * 3) After the conversion is done TSC2005 drives DAV line down. | 
|  | * 4) GPIO IRQ is received and tsc2005_irq_thread() is scheduled. | 
|  | * 5) tsc2005_irq_thread() queues up an spi transfer to fetch the x, y, z1, z2 | 
|  | *    values. | 
|  | * 6) tsc2005_irq_thread() reports coordinates to input layer and sets up | 
|  | *    tsc2005_penup_timer() to be called after TSC2005_PENUP_TIME_MS (40ms). | 
|  | * 7) When the penup timer expires, there have not been touch or DAV interrupts | 
|  | *    during the last 40ms which means the pen has been lifted. | 
|  | * | 
|  | * ESD recovery via a hardware reset is done if the TSC2005 doesn't respond | 
|  | * after a configurable period (in ms) of activity. If esd_timeout is 0, the | 
|  | * watchdog is disabled. | 
|  | */ | 
|  |  | 
|  | /* control byte 1 */ | 
|  | #define TSC2005_CMD			0x80 | 
|  | #define TSC2005_CMD_NORMAL		0x00 | 
|  | #define TSC2005_CMD_STOP		0x01 | 
|  | #define TSC2005_CMD_12BIT		0x04 | 
|  |  | 
|  | /* control byte 0 */ | 
|  | #define TSC2005_REG_READ		0x0001 | 
|  | #define TSC2005_REG_PND0		0x0002 | 
|  | #define TSC2005_REG_X			0x0000 | 
|  | #define TSC2005_REG_Y			0x0008 | 
|  | #define TSC2005_REG_Z1			0x0010 | 
|  | #define TSC2005_REG_Z2			0x0018 | 
|  | #define TSC2005_REG_TEMP_HIGH		0x0050 | 
|  | #define TSC2005_REG_CFR0		0x0060 | 
|  | #define TSC2005_REG_CFR1		0x0068 | 
|  | #define TSC2005_REG_CFR2		0x0070 | 
|  |  | 
|  | /* configuration register 0 */ | 
|  | #define TSC2005_CFR0_PRECHARGE_276US	0x0040 | 
|  | #define TSC2005_CFR0_STABTIME_1MS	0x0300 | 
|  | #define TSC2005_CFR0_CLOCK_1MHZ		0x1000 | 
|  | #define TSC2005_CFR0_RESOLUTION12	0x2000 | 
|  | #define TSC2005_CFR0_PENMODE		0x8000 | 
|  | #define TSC2005_CFR0_INITVALUE		(TSC2005_CFR0_STABTIME_1MS    | \ | 
|  | TSC2005_CFR0_CLOCK_1MHZ      | \ | 
|  | TSC2005_CFR0_RESOLUTION12    | \ | 
|  | TSC2005_CFR0_PRECHARGE_276US | \ | 
|  | TSC2005_CFR0_PENMODE) | 
|  |  | 
|  | /* bits common to both read and write of configuration register 0 */ | 
|  | #define	TSC2005_CFR0_RW_MASK		0x3fff | 
|  |  | 
|  | /* configuration register 1 */ | 
|  | #define TSC2005_CFR1_BATCHDELAY_4MS	0x0003 | 
|  | #define TSC2005_CFR1_INITVALUE		TSC2005_CFR1_BATCHDELAY_4MS | 
|  |  | 
|  | /* configuration register 2 */ | 
|  | #define TSC2005_CFR2_MAVE_Z		0x0004 | 
|  | #define TSC2005_CFR2_MAVE_Y		0x0008 | 
|  | #define TSC2005_CFR2_MAVE_X		0x0010 | 
|  | #define TSC2005_CFR2_AVG_7		0x0800 | 
|  | #define TSC2005_CFR2_MEDIUM_15		0x3000 | 
|  | #define TSC2005_CFR2_INITVALUE		(TSC2005_CFR2_MAVE_X	| \ | 
|  | TSC2005_CFR2_MAVE_Y	| \ | 
|  | TSC2005_CFR2_MAVE_Z	| \ | 
|  | TSC2005_CFR2_MEDIUM_15	| \ | 
|  | TSC2005_CFR2_AVG_7) | 
|  |  | 
|  | #define MAX_12BIT			0xfff | 
|  | #define TSC2005_SPI_MAX_SPEED_HZ	10000000 | 
|  | #define TSC2005_PENUP_TIME_MS		40 | 
|  |  | 
|  | struct tsc2005_spi_rd { | 
|  | struct spi_transfer	spi_xfer; | 
|  | u32			spi_tx; | 
|  | u32			spi_rx; | 
|  | }; | 
|  |  | 
|  | struct tsc2005 { | 
|  | struct spi_device	*spi; | 
|  |  | 
|  | struct spi_message      spi_read_msg; | 
|  | struct tsc2005_spi_rd	spi_x; | 
|  | struct tsc2005_spi_rd	spi_y; | 
|  | struct tsc2005_spi_rd	spi_z1; | 
|  | struct tsc2005_spi_rd	spi_z2; | 
|  |  | 
|  | struct input_dev	*idev; | 
|  | char			phys[32]; | 
|  |  | 
|  | struct mutex		mutex; | 
|  |  | 
|  | /* raw copy of previous x,y,z */ | 
|  | int			in_x; | 
|  | int			in_y; | 
|  | int                     in_z1; | 
|  | int			in_z2; | 
|  |  | 
|  | spinlock_t		lock; | 
|  | struct timer_list	penup_timer; | 
|  |  | 
|  | unsigned int		esd_timeout; | 
|  | struct delayed_work	esd_work; | 
|  | unsigned long		last_valid_interrupt; | 
|  |  | 
|  | unsigned int		x_plate_ohm; | 
|  |  | 
|  | bool			opened; | 
|  | bool			suspended; | 
|  |  | 
|  | bool			pen_down; | 
|  |  | 
|  | void			(*set_reset)(bool enable); | 
|  | }; | 
|  |  | 
|  | static int tsc2005_cmd(struct tsc2005 *ts, u8 cmd) | 
|  | { | 
|  | u8 tx = TSC2005_CMD | TSC2005_CMD_12BIT | cmd; | 
|  | struct spi_transfer xfer = { | 
|  | .tx_buf		= &tx, | 
|  | .len		= 1, | 
|  | .bits_per_word	= 8, | 
|  | }; | 
|  | struct spi_message msg; | 
|  | int error; | 
|  |  | 
|  | spi_message_init(&msg); | 
|  | spi_message_add_tail(&xfer, &msg); | 
|  |  | 
|  | error = spi_sync(ts->spi, &msg); | 
|  | if (error) { | 
|  | dev_err(&ts->spi->dev, "%s: failed, command: %x, error: %d\n", | 
|  | __func__, cmd, error); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tsc2005_write(struct tsc2005 *ts, u8 reg, u16 value) | 
|  | { | 
|  | u32 tx = ((reg | TSC2005_REG_PND0) << 16) | value; | 
|  | struct spi_transfer xfer = { | 
|  | .tx_buf		= &tx, | 
|  | .len		= 4, | 
|  | .bits_per_word	= 24, | 
|  | }; | 
|  | struct spi_message msg; | 
|  | int error; | 
|  |  | 
|  | spi_message_init(&msg); | 
|  | spi_message_add_tail(&xfer, &msg); | 
|  |  | 
|  | error = spi_sync(ts->spi, &msg); | 
|  | if (error) { | 
|  | dev_err(&ts->spi->dev, | 
|  | "%s: failed, register: %x, value: %x, error: %d\n", | 
|  | __func__, reg, value, error); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void tsc2005_setup_read(struct tsc2005_spi_rd *rd, u8 reg, bool last) | 
|  | { | 
|  | memset(rd, 0, sizeof(*rd)); | 
|  |  | 
|  | rd->spi_tx		   = (reg | TSC2005_REG_READ) << 16; | 
|  | rd->spi_xfer.tx_buf	   = &rd->spi_tx; | 
|  | rd->spi_xfer.rx_buf	   = &rd->spi_rx; | 
|  | rd->spi_xfer.len	   = 4; | 
|  | rd->spi_xfer.bits_per_word = 24; | 
|  | rd->spi_xfer.cs_change	   = !last; | 
|  | } | 
|  |  | 
|  | static int tsc2005_read(struct tsc2005 *ts, u8 reg, u16 *value) | 
|  | { | 
|  | struct tsc2005_spi_rd spi_rd; | 
|  | struct spi_message msg; | 
|  | int error; | 
|  |  | 
|  | tsc2005_setup_read(&spi_rd, reg, true); | 
|  |  | 
|  | spi_message_init(&msg); | 
|  | spi_message_add_tail(&spi_rd.spi_xfer, &msg); | 
|  |  | 
|  | error = spi_sync(ts->spi, &msg); | 
|  | if (error) | 
|  | return error; | 
|  |  | 
|  | *value = spi_rd.spi_rx; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void tsc2005_update_pen_state(struct tsc2005 *ts, | 
|  | int x, int y, int pressure) | 
|  | { | 
|  | if (pressure) { | 
|  | input_report_abs(ts->idev, ABS_X, x); | 
|  | input_report_abs(ts->idev, ABS_Y, y); | 
|  | input_report_abs(ts->idev, ABS_PRESSURE, pressure); | 
|  | if (!ts->pen_down) { | 
|  | input_report_key(ts->idev, BTN_TOUCH, !!pressure); | 
|  | ts->pen_down = true; | 
|  | } | 
|  | } else { | 
|  | input_report_abs(ts->idev, ABS_PRESSURE, 0); | 
|  | if (ts->pen_down) { | 
|  | input_report_key(ts->idev, BTN_TOUCH, 0); | 
|  | ts->pen_down = false; | 
|  | } | 
|  | } | 
|  | input_sync(ts->idev); | 
|  | dev_dbg(&ts->spi->dev, "point(%4d,%4d), pressure (%4d)\n", x, y, | 
|  | pressure); | 
|  | } | 
|  |  | 
|  | static irqreturn_t tsc2005_irq_thread(int irq, void *_ts) | 
|  | { | 
|  | struct tsc2005 *ts = _ts; | 
|  | unsigned long flags; | 
|  | unsigned int pressure; | 
|  | u32 x, y; | 
|  | u32 z1, z2; | 
|  | int error; | 
|  |  | 
|  | /* read the coordinates */ | 
|  | error = spi_sync(ts->spi, &ts->spi_read_msg); | 
|  | if (unlikely(error)) | 
|  | goto out; | 
|  |  | 
|  | x = ts->spi_x.spi_rx; | 
|  | y = ts->spi_y.spi_rx; | 
|  | z1 = ts->spi_z1.spi_rx; | 
|  | z2 = ts->spi_z2.spi_rx; | 
|  |  | 
|  | /* validate position */ | 
|  | if (unlikely(x > MAX_12BIT || y > MAX_12BIT)) | 
|  | goto out; | 
|  |  | 
|  | /* Skip reading if the pressure components are out of range */ | 
|  | if (unlikely(z1 == 0 || z2 > MAX_12BIT || z1 >= z2)) | 
|  | goto out; | 
|  |  | 
|  | /* | 
|  | * Skip point if this is a pen down with the exact same values as | 
|  | * the value before pen-up - that implies SPI fed us stale data | 
|  | */ | 
|  | if (!ts->pen_down && | 
|  | ts->in_x == x && ts->in_y == y && | 
|  | ts->in_z1 == z1 && ts->in_z2 == z2) { | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * At this point we are happy we have a valid and useful reading. | 
|  | * Remember it for later comparisons. We may now begin downsampling. | 
|  | */ | 
|  | ts->in_x = x; | 
|  | ts->in_y = y; | 
|  | ts->in_z1 = z1; | 
|  | ts->in_z2 = z2; | 
|  |  | 
|  | /* Compute touch pressure resistance using equation #1 */ | 
|  | pressure = x * (z2 - z1) / z1; | 
|  | pressure = pressure * ts->x_plate_ohm / 4096; | 
|  | if (unlikely(pressure > MAX_12BIT)) | 
|  | goto out; | 
|  |  | 
|  | spin_lock_irqsave(&ts->lock, flags); | 
|  |  | 
|  | tsc2005_update_pen_state(ts, x, y, pressure); | 
|  | mod_timer(&ts->penup_timer, | 
|  | jiffies + msecs_to_jiffies(TSC2005_PENUP_TIME_MS)); | 
|  |  | 
|  | spin_unlock_irqrestore(&ts->lock, flags); | 
|  |  | 
|  | ts->last_valid_interrupt = jiffies; | 
|  | out: | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static void tsc2005_penup_timer(unsigned long data) | 
|  | { | 
|  | struct tsc2005 *ts = (struct tsc2005 *)data; | 
|  | unsigned long flags; | 
|  |  | 
|  | spin_lock_irqsave(&ts->lock, flags); | 
|  | tsc2005_update_pen_state(ts, 0, 0, 0); | 
|  | spin_unlock_irqrestore(&ts->lock, flags); | 
|  | } | 
|  |  | 
|  | static void tsc2005_start_scan(struct tsc2005 *ts) | 
|  | { | 
|  | tsc2005_write(ts, TSC2005_REG_CFR0, TSC2005_CFR0_INITVALUE); | 
|  | tsc2005_write(ts, TSC2005_REG_CFR1, TSC2005_CFR1_INITVALUE); | 
|  | tsc2005_write(ts, TSC2005_REG_CFR2, TSC2005_CFR2_INITVALUE); | 
|  | tsc2005_cmd(ts, TSC2005_CMD_NORMAL); | 
|  | } | 
|  |  | 
|  | static void tsc2005_stop_scan(struct tsc2005 *ts) | 
|  | { | 
|  | tsc2005_cmd(ts, TSC2005_CMD_STOP); | 
|  | } | 
|  |  | 
|  | /* must be called with ts->mutex held */ | 
|  | static void __tsc2005_disable(struct tsc2005 *ts) | 
|  | { | 
|  | tsc2005_stop_scan(ts); | 
|  |  | 
|  | disable_irq(ts->spi->irq); | 
|  | del_timer_sync(&ts->penup_timer); | 
|  |  | 
|  | cancel_delayed_work_sync(&ts->esd_work); | 
|  |  | 
|  | enable_irq(ts->spi->irq); | 
|  | } | 
|  |  | 
|  | /* must be called with ts->mutex held */ | 
|  | static void __tsc2005_enable(struct tsc2005 *ts) | 
|  | { | 
|  | tsc2005_start_scan(ts); | 
|  |  | 
|  | if (ts->esd_timeout && ts->set_reset) { | 
|  | ts->last_valid_interrupt = jiffies; | 
|  | schedule_delayed_work(&ts->esd_work, | 
|  | round_jiffies_relative( | 
|  | msecs_to_jiffies(ts->esd_timeout))); | 
|  | } | 
|  |  | 
|  | } | 
|  |  | 
|  | static ssize_t tsc2005_selftest_show(struct device *dev, | 
|  | struct device_attribute *attr, | 
|  | char *buf) | 
|  | { | 
|  | struct spi_device *spi = to_spi_device(dev); | 
|  | struct tsc2005 *ts = spi_get_drvdata(spi); | 
|  | u16 temp_high; | 
|  | u16 temp_high_orig; | 
|  | u16 temp_high_test; | 
|  | bool success = true; | 
|  | int error; | 
|  |  | 
|  | mutex_lock(&ts->mutex); | 
|  |  | 
|  | /* | 
|  | * Test TSC2005 communications via temp high register. | 
|  | */ | 
|  | __tsc2005_disable(ts); | 
|  |  | 
|  | error = tsc2005_read(ts, TSC2005_REG_TEMP_HIGH, &temp_high_orig); | 
|  | if (error) { | 
|  | dev_warn(dev, "selftest failed: read error %d\n", error); | 
|  | success = false; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | temp_high_test = (temp_high_orig - 1) & MAX_12BIT; | 
|  |  | 
|  | error = tsc2005_write(ts, TSC2005_REG_TEMP_HIGH, temp_high_test); | 
|  | if (error) { | 
|  | dev_warn(dev, "selftest failed: write error %d\n", error); | 
|  | success = false; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | error = tsc2005_read(ts, TSC2005_REG_TEMP_HIGH, &temp_high); | 
|  | if (error) { | 
|  | dev_warn(dev, "selftest failed: read error %d after write\n", | 
|  | error); | 
|  | success = false; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (temp_high != temp_high_test) { | 
|  | dev_warn(dev, "selftest failed: %d != %d\n", | 
|  | temp_high, temp_high_test); | 
|  | success = false; | 
|  | } | 
|  |  | 
|  | /* hardware reset */ | 
|  | ts->set_reset(false); | 
|  | usleep_range(100, 500); /* only 10us required */ | 
|  | ts->set_reset(true); | 
|  |  | 
|  | if (!success) | 
|  | goto out; | 
|  |  | 
|  | /* test that the reset really happened */ | 
|  | error = tsc2005_read(ts, TSC2005_REG_TEMP_HIGH, &temp_high); | 
|  | if (error) { | 
|  | dev_warn(dev, "selftest failed: read error %d after reset\n", | 
|  | error); | 
|  | success = false; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (temp_high != temp_high_orig) { | 
|  | dev_warn(dev, "selftest failed after reset: %d != %d\n", | 
|  | temp_high, temp_high_orig); | 
|  | success = false; | 
|  | } | 
|  |  | 
|  | out: | 
|  | __tsc2005_enable(ts); | 
|  | mutex_unlock(&ts->mutex); | 
|  |  | 
|  | return sprintf(buf, "%d\n", success); | 
|  | } | 
|  |  | 
|  | static DEVICE_ATTR(selftest, S_IRUGO, tsc2005_selftest_show, NULL); | 
|  |  | 
|  | static struct attribute *tsc2005_attrs[] = { | 
|  | &dev_attr_selftest.attr, | 
|  | NULL | 
|  | }; | 
|  |  | 
|  | static umode_t tsc2005_attr_is_visible(struct kobject *kobj, | 
|  | struct attribute *attr, int n) | 
|  | { | 
|  | struct device *dev = container_of(kobj, struct device, kobj); | 
|  | struct spi_device *spi = to_spi_device(dev); | 
|  | struct tsc2005 *ts = spi_get_drvdata(spi); | 
|  | umode_t mode = attr->mode; | 
|  |  | 
|  | if (attr == &dev_attr_selftest.attr) { | 
|  | if (!ts->set_reset) | 
|  | mode = 0; | 
|  | } | 
|  |  | 
|  | return mode; | 
|  | } | 
|  |  | 
|  | static const struct attribute_group tsc2005_attr_group = { | 
|  | .is_visible	= tsc2005_attr_is_visible, | 
|  | .attrs		= tsc2005_attrs, | 
|  | }; | 
|  |  | 
|  | static void tsc2005_esd_work(struct work_struct *work) | 
|  | { | 
|  | struct tsc2005 *ts = container_of(work, struct tsc2005, esd_work.work); | 
|  | int error; | 
|  | u16 r; | 
|  |  | 
|  | if (!mutex_trylock(&ts->mutex)) { | 
|  | /* | 
|  | * If the mutex is taken, it means that disable or enable is in | 
|  | * progress. In that case just reschedule the work. If the work | 
|  | * is not needed, it will be canceled by disable. | 
|  | */ | 
|  | goto reschedule; | 
|  | } | 
|  |  | 
|  | if (time_is_after_jiffies(ts->last_valid_interrupt + | 
|  | msecs_to_jiffies(ts->esd_timeout))) | 
|  | goto out; | 
|  |  | 
|  | /* We should be able to read register without disabling interrupts. */ | 
|  | error = tsc2005_read(ts, TSC2005_REG_CFR0, &r); | 
|  | if (!error && | 
|  | !((r ^ TSC2005_CFR0_INITVALUE) & TSC2005_CFR0_RW_MASK)) { | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * If we could not read our known value from configuration register 0 | 
|  | * then we should reset the controller as if from power-up and start | 
|  | * scanning again. | 
|  | */ | 
|  | dev_info(&ts->spi->dev, "TSC2005 not responding - resetting\n"); | 
|  |  | 
|  | disable_irq(ts->spi->irq); | 
|  | del_timer_sync(&ts->penup_timer); | 
|  |  | 
|  | tsc2005_update_pen_state(ts, 0, 0, 0); | 
|  |  | 
|  | ts->set_reset(false); | 
|  | usleep_range(100, 500); /* only 10us required */ | 
|  | ts->set_reset(true); | 
|  |  | 
|  | enable_irq(ts->spi->irq); | 
|  | tsc2005_start_scan(ts); | 
|  |  | 
|  | out: | 
|  | mutex_unlock(&ts->mutex); | 
|  | reschedule: | 
|  | /* re-arm the watchdog */ | 
|  | schedule_delayed_work(&ts->esd_work, | 
|  | round_jiffies_relative( | 
|  | msecs_to_jiffies(ts->esd_timeout))); | 
|  | } | 
|  |  | 
|  | static int tsc2005_open(struct input_dev *input) | 
|  | { | 
|  | struct tsc2005 *ts = input_get_drvdata(input); | 
|  |  | 
|  | mutex_lock(&ts->mutex); | 
|  |  | 
|  | if (!ts->suspended) | 
|  | __tsc2005_enable(ts); | 
|  |  | 
|  | ts->opened = true; | 
|  |  | 
|  | mutex_unlock(&ts->mutex); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void tsc2005_close(struct input_dev *input) | 
|  | { | 
|  | struct tsc2005 *ts = input_get_drvdata(input); | 
|  |  | 
|  | mutex_lock(&ts->mutex); | 
|  |  | 
|  | if (!ts->suspended) | 
|  | __tsc2005_disable(ts); | 
|  |  | 
|  | ts->opened = false; | 
|  |  | 
|  | mutex_unlock(&ts->mutex); | 
|  | } | 
|  |  | 
|  | static void __devinit tsc2005_setup_spi_xfer(struct tsc2005 *ts) | 
|  | { | 
|  | tsc2005_setup_read(&ts->spi_x, TSC2005_REG_X, false); | 
|  | tsc2005_setup_read(&ts->spi_y, TSC2005_REG_Y, false); | 
|  | tsc2005_setup_read(&ts->spi_z1, TSC2005_REG_Z1, false); | 
|  | tsc2005_setup_read(&ts->spi_z2, TSC2005_REG_Z2, true); | 
|  |  | 
|  | spi_message_init(&ts->spi_read_msg); | 
|  | spi_message_add_tail(&ts->spi_x.spi_xfer, &ts->spi_read_msg); | 
|  | spi_message_add_tail(&ts->spi_y.spi_xfer, &ts->spi_read_msg); | 
|  | spi_message_add_tail(&ts->spi_z1.spi_xfer, &ts->spi_read_msg); | 
|  | spi_message_add_tail(&ts->spi_z2.spi_xfer, &ts->spi_read_msg); | 
|  | } | 
|  |  | 
|  | static int __devinit tsc2005_probe(struct spi_device *spi) | 
|  | { | 
|  | const struct tsc2005_platform_data *pdata = spi->dev.platform_data; | 
|  | struct tsc2005 *ts; | 
|  | struct input_dev *input_dev; | 
|  | unsigned int max_x, max_y, max_p; | 
|  | unsigned int fudge_x, fudge_y, fudge_p; | 
|  | int error; | 
|  |  | 
|  | if (!pdata) { | 
|  | dev_dbg(&spi->dev, "no platform data\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | fudge_x	= pdata->ts_x_fudge	   ? : 4; | 
|  | fudge_y	= pdata->ts_y_fudge	   ? : 8; | 
|  | fudge_p	= pdata->ts_pressure_fudge ? : 2; | 
|  | max_x	= pdata->ts_x_max	   ? : MAX_12BIT; | 
|  | max_y	= pdata->ts_y_max	   ? : MAX_12BIT; | 
|  | max_p	= pdata->ts_pressure_max   ? : MAX_12BIT; | 
|  |  | 
|  | if (spi->irq <= 0) { | 
|  | dev_dbg(&spi->dev, "no irq\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | spi->mode = SPI_MODE_0; | 
|  | spi->bits_per_word = 8; | 
|  | if (!spi->max_speed_hz) | 
|  | spi->max_speed_hz = TSC2005_SPI_MAX_SPEED_HZ; | 
|  |  | 
|  | error = spi_setup(spi); | 
|  | if (error) | 
|  | return error; | 
|  |  | 
|  | ts = kzalloc(sizeof(*ts), GFP_KERNEL); | 
|  | input_dev = input_allocate_device(); | 
|  | if (!ts || !input_dev) { | 
|  | error = -ENOMEM; | 
|  | goto err_free_mem; | 
|  | } | 
|  |  | 
|  | ts->spi = spi; | 
|  | ts->idev = input_dev; | 
|  |  | 
|  | ts->x_plate_ohm	= pdata->ts_x_plate_ohm	? : 280; | 
|  | ts->esd_timeout	= pdata->esd_timeout_ms; | 
|  | ts->set_reset	= pdata->set_reset; | 
|  |  | 
|  | mutex_init(&ts->mutex); | 
|  |  | 
|  | spin_lock_init(&ts->lock); | 
|  | setup_timer(&ts->penup_timer, tsc2005_penup_timer, (unsigned long)ts); | 
|  |  | 
|  | INIT_DELAYED_WORK(&ts->esd_work, tsc2005_esd_work); | 
|  |  | 
|  | tsc2005_setup_spi_xfer(ts); | 
|  |  | 
|  | snprintf(ts->phys, sizeof(ts->phys), | 
|  | "%s/input-ts", dev_name(&spi->dev)); | 
|  |  | 
|  | input_dev->name = "TSC2005 touchscreen"; | 
|  | input_dev->phys = ts->phys; | 
|  | input_dev->id.bustype = BUS_SPI; | 
|  | input_dev->dev.parent = &spi->dev; | 
|  | input_dev->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY); | 
|  | input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); | 
|  |  | 
|  | input_set_abs_params(input_dev, ABS_X, 0, max_x, fudge_x, 0); | 
|  | input_set_abs_params(input_dev, ABS_Y, 0, max_y, fudge_y, 0); | 
|  | input_set_abs_params(input_dev, ABS_PRESSURE, 0, max_p, fudge_p, 0); | 
|  |  | 
|  | input_dev->open = tsc2005_open; | 
|  | input_dev->close = tsc2005_close; | 
|  |  | 
|  | input_set_drvdata(input_dev, ts); | 
|  |  | 
|  | /* Ensure the touchscreen is off */ | 
|  | tsc2005_stop_scan(ts); | 
|  |  | 
|  | error = request_threaded_irq(spi->irq, NULL, tsc2005_irq_thread, | 
|  | IRQF_TRIGGER_RISING, "tsc2005", ts); | 
|  | if (error) { | 
|  | dev_err(&spi->dev, "Failed to request irq, err: %d\n", error); | 
|  | goto err_free_mem; | 
|  | } | 
|  |  | 
|  | spi_set_drvdata(spi, ts); | 
|  | error = sysfs_create_group(&spi->dev.kobj, &tsc2005_attr_group); | 
|  | if (error) { | 
|  | dev_err(&spi->dev, | 
|  | "Failed to create sysfs attributes, err: %d\n", error); | 
|  | goto err_clear_drvdata; | 
|  | } | 
|  |  | 
|  | error = input_register_device(ts->idev); | 
|  | if (error) { | 
|  | dev_err(&spi->dev, | 
|  | "Failed to register input device, err: %d\n", error); | 
|  | goto err_remove_sysfs; | 
|  | } | 
|  |  | 
|  | irq_set_irq_wake(spi->irq, 1); | 
|  | return 0; | 
|  |  | 
|  | err_remove_sysfs: | 
|  | sysfs_remove_group(&spi->dev.kobj, &tsc2005_attr_group); | 
|  | err_clear_drvdata: | 
|  | spi_set_drvdata(spi, NULL); | 
|  | free_irq(spi->irq, ts); | 
|  | err_free_mem: | 
|  | input_free_device(input_dev); | 
|  | kfree(ts); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | static int __devexit tsc2005_remove(struct spi_device *spi) | 
|  | { | 
|  | struct tsc2005 *ts = spi_get_drvdata(spi); | 
|  |  | 
|  | sysfs_remove_group(&ts->spi->dev.kobj, &tsc2005_attr_group); | 
|  |  | 
|  | free_irq(ts->spi->irq, ts); | 
|  | input_unregister_device(ts->idev); | 
|  | kfree(ts); | 
|  |  | 
|  | spi_set_drvdata(spi, NULL); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_PM_SLEEP | 
|  | static int tsc2005_suspend(struct device *dev) | 
|  | { | 
|  | struct spi_device *spi = to_spi_device(dev); | 
|  | struct tsc2005 *ts = spi_get_drvdata(spi); | 
|  |  | 
|  | mutex_lock(&ts->mutex); | 
|  |  | 
|  | if (!ts->suspended && ts->opened) | 
|  | __tsc2005_disable(ts); | 
|  |  | 
|  | ts->suspended = true; | 
|  |  | 
|  | mutex_unlock(&ts->mutex); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tsc2005_resume(struct device *dev) | 
|  | { | 
|  | struct spi_device *spi = to_spi_device(dev); | 
|  | struct tsc2005 *ts = spi_get_drvdata(spi); | 
|  |  | 
|  | mutex_lock(&ts->mutex); | 
|  |  | 
|  | if (ts->suspended && ts->opened) | 
|  | __tsc2005_enable(ts); | 
|  |  | 
|  | ts->suspended = false; | 
|  |  | 
|  | mutex_unlock(&ts->mutex); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static SIMPLE_DEV_PM_OPS(tsc2005_pm_ops, tsc2005_suspend, tsc2005_resume); | 
|  |  | 
|  | static struct spi_driver tsc2005_driver = { | 
|  | .driver	= { | 
|  | .name	= "tsc2005", | 
|  | .owner	= THIS_MODULE, | 
|  | .pm	= &tsc2005_pm_ops, | 
|  | }, | 
|  | .probe	= tsc2005_probe, | 
|  | .remove	= __devexit_p(tsc2005_remove), | 
|  | }; | 
|  |  | 
|  | module_spi_driver(tsc2005_driver); | 
|  |  | 
|  | MODULE_AUTHOR("Lauri Leukkunen <lauri.leukkunen@nokia.com>"); | 
|  | MODULE_DESCRIPTION("TSC2005 Touchscreen Driver"); | 
|  | MODULE_LICENSE("GPL"); |