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

/*
 *  Touchscreen driver for Sharp SL-C7xx and SL-Cxx00 models
 *
 *  Copyright (c) 2004-2005 Richard Purdie
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 */


#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/irq.h>

#include <asm/arch/sharpsl.h>
#include <asm/arch/hardware.h>
#include <asm/arch/pxa-regs.h>
#include <asm/arch/pxa2xx-gpio.h>


#define PWR_MODE_ACTIVE		0
#define PWR_MODE_SUSPEND	1

#define X_AXIS_MAX		3830
#define X_AXIS_MIN		150
#define Y_AXIS_MAX		3830
#define Y_AXIS_MIN		190
#define PRESSURE_MIN		0
#define PRESSURE_MAX		15000

struct ts_event {
	short pressure;
	short x;
	short y;
};

struct corgi_ts {
	struct input_dev *input;
	struct timer_list timer;
	struct ts_event tc;
	int pendown;
	int power_mode;
	int irq_gpio;
	struct corgits_machinfo *machinfo;
};

#ifdef CONFIG_PXA25x
#define CCNT(a)		asm volatile ("mrc p14, 0, %0, C1, C0, 0" : "=r"(a))
#define PMNC_GET(x)	asm volatile ("mrc p14, 0, %0, C0, C0, 0" : "=r"(x))
#define PMNC_SET(x)	asm volatile ("mcr p14, 0, %0, C0, C0, 0" : : "r"(x))
#endif
#ifdef CONFIG_PXA27x
#define CCNT(a)		asm volatile ("mrc p14, 0, %0, C1, C1, 0" : "=r"(a))
#define PMNC_GET(x)	asm volatile ("mrc p14, 0, %0, C0, C1, 0" : "=r"(x))
#define PMNC_SET(x)	asm volatile ("mcr p14, 0, %0, C0, C1, 0" : : "r"(x))
#endif

/* ADS7846 Touch Screen Controller bit definitions */
#define ADSCTRL_PD0		(1u << 0)	/* PD0 */
#define ADSCTRL_PD1		(1u << 1)	/* PD1 */
#define ADSCTRL_DFR		(1u << 2)	/* SER/DFR */
#define ADSCTRL_MOD		(1u << 3)	/* Mode */
#define ADSCTRL_ADR_SH	4	/* Address setting */
#define ADSCTRL_STS		(1u << 7)	/* Start Bit */

/* External Functions */
extern unsigned int get_clk_frequency_khz(int info);

static unsigned long calc_waittime(struct corgi_ts *corgi_ts)
{
	unsigned long hsync_invperiod = corgi_ts->machinfo->get_hsync_invperiod();

	if (hsync_invperiod)
		return get_clk_frequency_khz(0)*1000/hsync_invperiod;
	else
		return 0;
}

static int sync_receive_data_send_cmd(struct corgi_ts *corgi_ts, int doRecive, int doSend,
		unsigned int address, unsigned long wait_time)
{
	unsigned long timer1 = 0, timer2, pmnc = 0;
	int pos = 0;

	if (wait_time && doSend) {
		PMNC_GET(pmnc);
		if (!(pmnc & 0x01))
			PMNC_SET(0x01);

		/* polling HSync */
		corgi_ts->machinfo->wait_hsync();
		/* get CCNT */
		CCNT(timer1);
	}

	if (doRecive)
		pos = corgi_ssp_ads7846_get();

	if (doSend) {
		int cmd = ADSCTRL_PD0 | ADSCTRL_PD1 | (address << ADSCTRL_ADR_SH) | ADSCTRL_STS;
		/* dummy command */
		corgi_ssp_ads7846_put(cmd);
		corgi_ssp_ads7846_get();

		if (wait_time) {
			/* Wait after HSync */
			CCNT(timer2);
			if (timer2-timer1 > wait_time) {
				/* too slow - timeout, try again */
				corgi_ts->machinfo->wait_hsync();
				/* get CCNT */
				CCNT(timer1);
				/* Wait after HSync */
				CCNT(timer2);
			}
			while (timer2 - timer1 < wait_time)
				CCNT(timer2);
		}
		corgi_ssp_ads7846_put(cmd);
		if (wait_time && !(pmnc & 0x01))
			PMNC_SET(pmnc);
	}
	return pos;
}

static int read_xydata(struct corgi_ts *corgi_ts)
{
	unsigned int x, y, z1, z2;
	unsigned long flags, wait_time;

	/* critical section */
	local_irq_save(flags);
	corgi_ssp_ads7846_lock();
	wait_time = calc_waittime(corgi_ts);

	/* Y-axis */
	sync_receive_data_send_cmd(corgi_ts, 0, 1, 1u, wait_time);

	/* Y-axis */
	sync_receive_data_send_cmd(corgi_ts, 1, 1, 1u, wait_time);

	/* X-axis */
	y = sync_receive_data_send_cmd(corgi_ts, 1, 1, 5u, wait_time);

	/* Z1 */
	x = sync_receive_data_send_cmd(corgi_ts, 1, 1, 3u, wait_time);

	/* Z2 */
	z1 = sync_receive_data_send_cmd(corgi_ts, 1, 1, 4u, wait_time);
	z2 = sync_receive_data_send_cmd(corgi_ts, 1, 0, 4u, wait_time);

	/* Power-Down Enable */
	corgi_ssp_ads7846_put((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	corgi_ssp_ads7846_get();

	corgi_ssp_ads7846_unlock();
	local_irq_restore(flags);

	if (x== 0 || y == 0 || z1 == 0 || (x * (z2 - z1) / z1) >= 15000) {
		corgi_ts->tc.pressure = 0;
		return 0;
	}

	corgi_ts->tc.x = x;
	corgi_ts->tc.y = y;
	corgi_ts->tc.pressure = (x * (z2 - z1)) / z1;
	return 1;
}

static void new_data(struct corgi_ts *corgi_ts)
{
	struct input_dev *dev = corgi_ts->input;

	if (corgi_ts->power_mode != PWR_MODE_ACTIVE)
		return;

	if (!corgi_ts->tc.pressure && corgi_ts->pendown == 0)
		return;

	input_report_abs(dev, ABS_X, corgi_ts->tc.x);
	input_report_abs(dev, ABS_Y, corgi_ts->tc.y);
	input_report_abs(dev, ABS_PRESSURE, corgi_ts->tc.pressure);
	input_report_key(dev, BTN_TOUCH, corgi_ts->pendown);
	input_sync(dev);
}

static void ts_interrupt_main(struct corgi_ts *corgi_ts, int isTimer)
{
	if ((GPLR(IRQ_TO_GPIO(corgi_ts->irq_gpio)) & GPIO_bit(IRQ_TO_GPIO(corgi_ts->irq_gpio))) == 0) {
		/* Disable Interrupt */
		set_irq_type(corgi_ts->irq_gpio, IRQT_NOEDGE);
		if (read_xydata(corgi_ts)) {
			corgi_ts->pendown = 1;
			new_data(corgi_ts);
		}
		mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
	} else {
		if (corgi_ts->pendown == 1 || corgi_ts->pendown == 2) {
			mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
			corgi_ts->pendown++;
			return;
		}

		if (corgi_ts->pendown) {
			corgi_ts->tc.pressure = 0;
			new_data(corgi_ts);
		}

		/* Enable Falling Edge */
		set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);
		corgi_ts->pendown = 0;
	}
}

static void corgi_ts_timer(unsigned long data)
{
	struct corgi_ts *corgits_data = (struct corgi_ts *) data;

	ts_interrupt_main(corgits_data, 1);
}

static irqreturn_t ts_interrupt(int irq, void *dev_id)
{
	struct corgi_ts *corgits_data = dev_id;

	ts_interrupt_main(corgits_data, 0);
	return IRQ_HANDLED;
}

#ifdef CONFIG_PM
static int corgits_suspend(struct platform_device *dev, pm_message_t state)
{
	struct corgi_ts *corgi_ts = platform_get_drvdata(dev);

	if (corgi_ts->pendown) {
		del_timer_sync(&corgi_ts->timer);
		corgi_ts->tc.pressure = 0;
		new_data(corgi_ts);
		corgi_ts->pendown = 0;
	}
	corgi_ts->power_mode = PWR_MODE_SUSPEND;

	corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);

	return 0;
}

static int corgits_resume(struct platform_device *dev)
{
	struct corgi_ts *corgi_ts = platform_get_drvdata(dev);

	corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	/* Enable Falling Edge */
	set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);
	corgi_ts->power_mode = PWR_MODE_ACTIVE;

	return 0;
}
#else
#define corgits_suspend		NULL
#define corgits_resume		NULL
#endif

static int __init corgits_probe(struct platform_device *pdev)
{
	struct corgi_ts *corgi_ts;
	struct input_dev *input_dev;
	int err = -ENOMEM;

	corgi_ts = kzalloc(sizeof(struct corgi_ts), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!corgi_ts || !input_dev)
		goto fail1;

	platform_set_drvdata(pdev, corgi_ts);

	corgi_ts->machinfo = pdev->dev.platform_data;
	corgi_ts->irq_gpio = platform_get_irq(pdev, 0);

	if (corgi_ts->irq_gpio < 0) {
		err = -ENODEV;
		goto fail1;
	}

	corgi_ts->input = input_dev;

	init_timer(&corgi_ts->timer);
	corgi_ts->timer.data = (unsigned long) corgi_ts;
	corgi_ts->timer.function = corgi_ts_timer;

	input_dev->name = "Corgi Touchscreen";
	input_dev->phys = "corgits/input0";
	input_dev->id.bustype = BUS_HOST;
	input_dev->id.vendor = 0x0001;
	input_dev->id.product = 0x0002;
	input_dev->id.version = 0x0100;
	input_dev->dev.parent = &pdev->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, X_AXIS_MIN, X_AXIS_MAX, 0, 0);
	input_set_abs_params(input_dev, ABS_Y, Y_AXIS_MIN, Y_AXIS_MAX, 0, 0);
	input_set_abs_params(input_dev, ABS_PRESSURE, PRESSURE_MIN, PRESSURE_MAX, 0, 0);

	pxa_gpio_mode(IRQ_TO_GPIO(corgi_ts->irq_gpio) | GPIO_IN);

	/* Initiaize ADS7846 Difference Reference mode */
	corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	mdelay(5);
	corgi_ssp_ads7846_putget((3u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	mdelay(5);
	corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	mdelay(5);
	corgi_ssp_ads7846_putget((5u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
	mdelay(5);

	if (request_irq(corgi_ts->irq_gpio, ts_interrupt, IRQF_DISABLED, "ts", corgi_ts)) {
		err = -EBUSY;
		goto fail1;
	}

	err = input_register_device(corgi_ts->input);
	if (err)
		goto fail2;

	corgi_ts->power_mode = PWR_MODE_ACTIVE;

	/* Enable Falling Edge */
	set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);

	return 0;

 fail2:	free_irq(corgi_ts->irq_gpio, corgi_ts);
 fail1:	input_free_device(input_dev);
	kfree(corgi_ts);
	return err;
}

static int corgits_remove(struct platform_device *pdev)
{
	struct corgi_ts *corgi_ts = platform_get_drvdata(pdev);

	free_irq(corgi_ts->irq_gpio, corgi_ts);
	del_timer_sync(&corgi_ts->timer);
	corgi_ts->machinfo->put_hsync();
	input_unregister_device(corgi_ts->input);
	kfree(corgi_ts);
	return 0;
}

static struct platform_driver corgits_driver = {
	.probe		= corgits_probe,
	.remove		= corgits_remove,
	.suspend	= corgits_suspend,
	.resume		= corgits_resume,
	.driver		= {
		.name	= "corgi-ts",
	},
};

static int __devinit corgits_init(void)
{
	return platform_driver_register(&corgits_driver);
}

static void __exit corgits_exit(void)
{
	platform_driver_unregister(&corgits_driver);
}

module_init(corgits_init);
module_exit(corgits_exit);

MODULE_AUTHOR("Richard Purdie <rpurdie@rpsys.net>");
MODULE_DESCRIPTION("Corgi TouchScreen Driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4	1	/*
513b6e1a	2	* Touchscreen driver for Sharp SL-C7xx and SL-Cxx00 models
1da177e4 LT	3	*
	4	* Copyright (c) 2004-2005 Richard Purdie
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*
	10	*/
	11
	12
	13	#include <linux/delay.h>
d052d1be	14	#include <linux/platform_device.h>
1da177e4 LT	15	#include <linux/init.h>
	16	#include <linux/input.h>
	17	#include <linux/interrupt.h>
	18	#include <linux/module.h>
	19	#include <linux/slab.h>
e6e3c3be	20	#include <linux/irq.h>
1da177e4	21
513b6e1a	22	#include <asm/arch/sharpsl.h>
1da177e4 LT	23	#include <asm/arch/hardware.h>
1da177e4 LT	24	#include <asm/arch/pxa-regs.h>
a683b14d	25	#include <asm/arch/pxa2xx-gpio.h>
1da177e4 LT	26
	27
	28	#define PWR_MODE_ACTIVE 0
	29	#define PWR_MODE_SUSPEND 1
	30
	31	#define X_AXIS_MAX 3830
	32	#define X_AXIS_MIN 150
	33	#define Y_AXIS_MAX 3830
	34	#define Y_AXIS_MIN 190
	35	#define PRESSURE_MIN 0
	36	#define PRESSURE_MAX 15000
	37
	38	struct ts_event {
	39	short pressure;
	40	short x;
	41	short y;
	42	};
	43
	44	struct corgi_ts {
eca1ed19	45	struct input_dev *input;
1da177e4 LT	46	struct timer_list timer;
	47	struct ts_event tc;
	48	int pendown;
	49	int power_mode;
513b6e1a RP	50	int irq_gpio;
513b6e1a RP	51	struct corgits_machinfo *machinfo;
1da177e4 LT	52	};
1da177e4 LT	53
513b6e1a	54	#ifdef CONFIG_PXA25x
1da177e4	55	#define CCNT(a) asm volatile ("mrc p14, 0, %0, C1, C0, 0" : "=r"(a))
347e4843 RP	56	#define PMNC_GET(x) asm volatile ("mrc p14, 0, %0, C0, C0, 0" : "=r"(x))
347e4843 RP	57	#define PMNC_SET(x) asm volatile ("mcr p14, 0, %0, C0, C0, 0" : : "r"(x))
513b6e1a RP	58	#endif
	59	#ifdef CONFIG_PXA27x
	60	#define CCNT(a) asm volatile ("mrc p14, 0, %0, C1, C1, 0" : "=r"(a))
	61	#define PMNC_GET(x) asm volatile ("mrc p14, 0, %0, C0, C1, 0" : "=r"(x))
	62	#define PMNC_SET(x) asm volatile ("mcr p14, 0, %0, C0, C1, 0" : : "r"(x))
	63	#endif
1da177e4 LT	64
	65	/* ADS7846 Touch Screen Controller bit definitions */
	66	#define ADSCTRL_PD0 (1u << 0) /* PD0 */
	67	#define ADSCTRL_PD1 (1u << 1) /* PD1 */
	68	#define ADSCTRL_DFR (1u << 2) /* SER/DFR */
	69	#define ADSCTRL_MOD (1u << 3) /* Mode */
	70	#define ADSCTRL_ADR_SH 4 /* Address setting */
	71	#define ADSCTRL_STS (1u << 7) /* Start Bit */
	72
	73	/* External Functions */
1da177e4 LT	74	extern unsigned int get_clk_frequency_khz(int info);
1da177e4 LT	75
513b6e1a	76	static unsigned long calc_waittime(struct corgi_ts *corgi_ts)
1da177e4	77	{
ca4d6cfc	78	unsigned long hsync_invperiod = corgi_ts->machinfo->get_hsync_invperiod();
1da177e4	79
ca4d6cfc RP	80	if (hsync_invperiod)
ca4d6cfc RP	81	return get_clk_frequency_khz(0)*1000/hsync_invperiod;
41b1bce8	82	else
74b74890	83	return 0;
1da177e4 LT	84	}
1da177e4 LT	85
513b6e1a RP	86	static int sync_receive_data_send_cmd(struct corgi_ts *corgi_ts, int doRecive, int doSend,
513b6e1a RP	87	unsigned int address, unsigned long wait_time)
1da177e4	88	{
347e4843	89	unsigned long timer1 = 0, timer2, pmnc = 0;
1da177e4	90	int pos = 0;
1da177e4	91
74b74890	92	if (wait_time && doSend) {
347e4843 RP	93	PMNC_GET(pmnc);
347e4843 RP	94	if (!(pmnc & 0x01))
8cc3c7af	95	PMNC_SET(0x01);
347e4843	96
1da177e4	97	/* polling HSync */
513b6e1a	98	corgi_ts->machinfo->wait_hsync();
1da177e4 LT	99	/* get CCNT */
	100	CCNT(timer1);
	101	}
	102
	103	if (doRecive)
	104	pos = corgi_ssp_ads7846_get();
	105
	106	if (doSend) {
	107	int cmd = ADSCTRL_PD0 \| ADSCTRL_PD1 \| (address << ADSCTRL_ADR_SH) \| ADSCTRL_STS;
	108	/* dummy command */
	109	corgi_ssp_ads7846_put(cmd);
	110	corgi_ssp_ads7846_get();
	111
74b74890	112	if (wait_time) {
1da177e4 LT	113	/* Wait after HSync */
	114	CCNT(timer2);
	115	if (timer2-timer1 > wait_time) {
74b74890	116	/* too slow - timeout, try again */
513b6e1a	117	corgi_ts->machinfo->wait_hsync();
ca4d6cfc	118	/* get CCNT */
1da177e4 LT	119	CCNT(timer1);
	120	/* Wait after HSync */
	121	CCNT(timer2);
	122	}
	123	while (timer2 - timer1 < wait_time)
	124	CCNT(timer2);
	125	}
	126	corgi_ssp_ads7846_put(cmd);
74b74890	127	if (wait_time && !(pmnc & 0x01))
347e4843	128	PMNC_SET(pmnc);
1da177e4 LT	129	}
	130	return pos;
	131	}
	132
	133	static int read_xydata(struct corgi_ts *corgi_ts)
	134	{
	135	unsigned int x, y, z1, z2;
	136	unsigned long flags, wait_time;
	137
	138	/* critical section */
	139	local_irq_save(flags);
	140	corgi_ssp_ads7846_lock();
513b6e1a	141	wait_time = calc_waittime(corgi_ts);
1da177e4 LT	142
1da177e4 LT	143	/* Y-axis */
513b6e1a	144	sync_receive_data_send_cmd(corgi_ts, 0, 1, 1u, wait_time);
1da177e4 LT	145
1da177e4 LT	146	/* Y-axis */
513b6e1a	147	sync_receive_data_send_cmd(corgi_ts, 1, 1, 1u, wait_time);
1da177e4 LT	148
1da177e4 LT	149	/* X-axis */
513b6e1a	150	y = sync_receive_data_send_cmd(corgi_ts, 1, 1, 5u, wait_time);
1da177e4 LT	151
1da177e4 LT	152	/* Z1 */
513b6e1a	153	x = sync_receive_data_send_cmd(corgi_ts, 1, 1, 3u, wait_time);
1da177e4 LT	154
1da177e4 LT	155	/* Z2 */
513b6e1a RP	156	z1 = sync_receive_data_send_cmd(corgi_ts, 1, 1, 4u, wait_time);
513b6e1a RP	157	z2 = sync_receive_data_send_cmd(corgi_ts, 1, 0, 4u, wait_time);
1da177e4 LT	158
	159	/* Power-Down Enable */
	160	corgi_ssp_ads7846_put((1u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	161	corgi_ssp_ads7846_get();
	162
	163	corgi_ssp_ads7846_unlock();
	164	local_irq_restore(flags);
	165
	166	if (x== 0 \|\| y == 0 \|\| z1 == 0 \|\| (x * (z2 - z1) / z1) >= 15000) {
	167	corgi_ts->tc.pressure = 0;
	168	return 0;
	169	}
	170
	171	corgi_ts->tc.x = x;
	172	corgi_ts->tc.y = y;
	173	corgi_ts->tc.pressure = (x * (z2 - z1)) / z1;
	174	return 1;
	175	}
	176
7d12e780	177	static void new_data(struct corgi_ts *corgi_ts)
1da177e4	178	{
52c1f570 DT	179	struct input_dev *dev = corgi_ts->input;
52c1f570 DT	180
1da177e4 LT	181	if (corgi_ts->power_mode != PWR_MODE_ACTIVE)
	182	return;
	183
	184	if (!corgi_ts->tc.pressure && corgi_ts->pendown == 0)
	185	return;
	186
52c1f570 DT	187	input_report_abs(dev, ABS_X, corgi_ts->tc.x);
	188	input_report_abs(dev, ABS_Y, corgi_ts->tc.y);
	189	input_report_abs(dev, ABS_PRESSURE, corgi_ts->tc.pressure);
	190	input_report_key(dev, BTN_TOUCH, corgi_ts->pendown);
	191	input_sync(dev);
1da177e4 LT	192	}
1da177e4 LT	193
7d12e780	194	static void ts_interrupt_main(struct corgi_ts *corgi_ts, int isTimer)
1da177e4	195	{
513b6e1a	196	if ((GPLR(IRQ_TO_GPIO(corgi_ts->irq_gpio)) & GPIO_bit(IRQ_TO_GPIO(corgi_ts->irq_gpio))) == 0) {
1da177e4	197	/* Disable Interrupt */
513b6e1a	198	set_irq_type(corgi_ts->irq_gpio, IRQT_NOEDGE);
1da177e4 LT	199	if (read_xydata(corgi_ts)) {
1da177e4 LT	200	corgi_ts->pendown = 1;
7d12e780	201	new_data(corgi_ts);
1da177e4 LT	202	}
	203	mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
	204	} else {
	205	if (corgi_ts->pendown == 1 \|\| corgi_ts->pendown == 2) {
	206	mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
	207	corgi_ts->pendown++;
	208	return;
	209	}
	210
	211	if (corgi_ts->pendown) {
	212	corgi_ts->tc.pressure = 0;
7d12e780	213	new_data(corgi_ts);
1da177e4 LT	214	}
	215
	216	/* Enable Falling Edge */
513b6e1a	217	set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);
1da177e4 LT	218	corgi_ts->pendown = 0;
	219	}
	220	}
	221
	222	static void corgi_ts_timer(unsigned long data)
	223	{
	224	struct corgi_ts corgits_data = (struct corgi_ts ) data;
52c1f570	225
36bd262b	226	ts_interrupt_main(corgits_data, 1);
1da177e4 LT	227	}
1da177e4 LT	228
7d12e780	229	static irqreturn_t ts_interrupt(int irq, void *dev_id)
1da177e4 LT	230	{
1da177e4 LT	231	struct corgi_ts *corgits_data = dev_id;
52c1f570	232
7d12e780	233	ts_interrupt_main(corgits_data, 0);
1da177e4 LT	234	return IRQ_HANDLED;
	235	}
	236
	237	#ifdef CONFIG_PM
3ae5eaec	238	static int corgits_suspend(struct platform_device *dev, pm_message_t state)
1da177e4	239	{
3ae5eaec	240	struct corgi_ts *corgi_ts = platform_get_drvdata(dev);
1da177e4	241
9480e307 RK	242	if (corgi_ts->pendown) {
	243	del_timer_sync(&corgi_ts->timer);
	244	corgi_ts->tc.pressure = 0;
36bd262b	245	new_data(corgi_ts);
9480e307	246	corgi_ts->pendown = 0;
1da177e4	247	}
9480e307 RK	248	corgi_ts->power_mode = PWR_MODE_SUSPEND;
	249
	250	corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	251
1da177e4 LT	252	return 0;
	253	}
	254
3ae5eaec	255	static int corgits_resume(struct platform_device *dev)
1da177e4	256	{
3ae5eaec	257	struct corgi_ts *corgi_ts = platform_get_drvdata(dev);
9480e307 RK	258
	259	corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	260	/* Enable Falling Edge */
	261	set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);
	262	corgi_ts->power_mode = PWR_MODE_ACTIVE;
1da177e4	263
1da177e4 LT	264	return 0;
	265	}
	266	#else
	267	#define corgits_suspend NULL
	268	#define corgits_resume NULL
	269	#endif
	270
3ae5eaec	271	static int __init corgits_probe(struct platform_device *pdev)
1da177e4 LT	272	{
1da177e4 LT	273	struct corgi_ts *corgi_ts;
eca1ed19 DT	274	struct input_dev *input_dev;
eca1ed19 DT	275	int err = -ENOMEM;
1da177e4	276
eca1ed19 DT	277	corgi_ts = kzalloc(sizeof(struct corgi_ts), GFP_KERNEL);
	278	input_dev = input_allocate_device();
	279	if (!corgi_ts \|\| !input_dev)
52c1f570	280	goto fail1;
1da177e4	281
3ae5eaec	282	platform_set_drvdata(pdev, corgi_ts);
1da177e4	283
3ae5eaec	284	corgi_ts->machinfo = pdev->dev.platform_data;
513b6e1a RP	285	corgi_ts->irq_gpio = platform_get_irq(pdev, 0);
	286
	287	if (corgi_ts->irq_gpio < 0) {
eca1ed19	288	err = -ENODEV;
52c1f570	289	goto fail1;
513b6e1a RP	290	}
513b6e1a RP	291
eca1ed19	292	corgi_ts->input = input_dev;
1da177e4	293
eca1ed19 DT	294	init_timer(&corgi_ts->timer);
	295	corgi_ts->timer.data = (unsigned long) corgi_ts;
	296	corgi_ts->timer.function = corgi_ts_timer;
1da177e4	297
eca1ed19 DT	298	input_dev->name = "Corgi Touchscreen";
	299	input_dev->phys = "corgits/input0";
	300	input_dev->id.bustype = BUS_HOST;
	301	input_dev->id.vendor = 0x0001;
	302	input_dev->id.product = 0x0002;
	303	input_dev->id.version = 0x0100;
a5394fb0	304	input_dev->dev.parent = &pdev->dev;
eca1ed19	305
7b19ada2 JS	306	input_dev->evbit[0] = BIT_MASK(EV_KEY) \| BIT_MASK(EV_ABS);
7b19ada2 JS	307	input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
eca1ed19 DT	308	input_set_abs_params(input_dev, ABS_X, X_AXIS_MIN, X_AXIS_MAX, 0, 0);
	309	input_set_abs_params(input_dev, ABS_Y, Y_AXIS_MIN, Y_AXIS_MAX, 0, 0);
	310	input_set_abs_params(input_dev, ABS_PRESSURE, PRESSURE_MIN, PRESSURE_MAX, 0, 0);
1da177e4	311
513b6e1a	312	pxa_gpio_mode(IRQ_TO_GPIO(corgi_ts->irq_gpio) \| GPIO_IN);
1da177e4 LT	313
	314	/* Initiaize ADS7846 Difference Reference mode */
	315	corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	316	mdelay(5);
	317	corgi_ssp_ads7846_putget((3u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	318	mdelay(5);
	319	corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	320	mdelay(5);
	321	corgi_ssp_ads7846_putget((5u << ADSCTRL_ADR_SH) \| ADSCTRL_STS);
	322	mdelay(5);
	323
dace1453	324	if (request_irq(corgi_ts->irq_gpio, ts_interrupt, IRQF_DISABLED, "ts", corgi_ts)) {
eca1ed19	325	err = -EBUSY;
52c1f570	326	goto fail1;
1da177e4 LT	327	}
1da177e4 LT	328
52c1f570 DT	329	err = input_register_device(corgi_ts->input);
	330	if (err)
	331	goto fail2;
eca1ed19 DT	332
	333	corgi_ts->power_mode = PWR_MODE_ACTIVE;
	334
1da177e4	335	/* Enable Falling Edge */
513b6e1a	336	set_irq_type(corgi_ts->irq_gpio, IRQT_FALLING);
1da177e4	337
1da177e4	338	return 0;
eca1ed19	339
52c1f570 DT	340	fail2: free_irq(corgi_ts->irq_gpio, corgi_ts);
52c1f570 DT	341	fail1: input_free_device(input_dev);
eca1ed19 DT	342	kfree(corgi_ts);
eca1ed19 DT	343	return err;
1da177e4 LT	344	}
1da177e4 LT	345
3ae5eaec	346	static int corgits_remove(struct platform_device *pdev)
1da177e4	347	{
3ae5eaec	348	struct corgi_ts *corgi_ts = platform_get_drvdata(pdev);
1da177e4	349
52c1f570	350	free_irq(corgi_ts->irq_gpio, corgi_ts);
1da177e4	351	del_timer_sync(&corgi_ts->timer);
513b6e1a	352	corgi_ts->machinfo->put_hsync();
eca1ed19	353	input_unregister_device(corgi_ts->input);
1da177e4 LT	354	kfree(corgi_ts);
	355	return 0;
	356	}
	357
3ae5eaec	358	static struct platform_driver corgits_driver = {
1da177e4 LT	359	.probe = corgits_probe,
	360	.remove = corgits_remove,
	361	.suspend = corgits_suspend,
	362	.resume = corgits_resume,
3ae5eaec RK	363	.driver = {
	364	.name = "corgi-ts",
	365	},
1da177e4 LT	366	};
	367
	368	static int __devinit corgits_init(void)
	369	{
3ae5eaec	370	return platform_driver_register(&corgits_driver);
1da177e4 LT	371	}
	372
	373	static void __exit corgits_exit(void)
	374	{
3ae5eaec	375	platform_driver_unregister(&corgits_driver);
1da177e4 LT	376	}
	377
	378	module_init(corgits_init);
	379	module_exit(corgits_exit);
	380
	381	MODULE_AUTHOR("Richard Purdie <rpurdie@rpsys.net>");
	382	MODULE_DESCRIPTION("Corgi TouchScreen Driver");
	383	MODULE_LICENSE("GPL");