xref: /openbmc/linux/drivers/mfd/ucb1x00-ts.c (revision c8602edf)
1acb45439SRussell King /*
25437775eSPavel Machek  *  Touchscreen driver for UCB1x00-based touchscreens
3acb45439SRussell King  *
4acb45439SRussell King  *  Copyright (C) 2001 Russell King, All Rights Reserved.
55437775eSPavel Machek  *  Copyright (C) 2005 Pavel Machek
6acb45439SRussell King  *
7acb45439SRussell King  * This program is free software; you can redistribute it and/or modify
8acb45439SRussell King  * it under the terms of the GNU General Public License version 2 as
9acb45439SRussell King  * published by the Free Software Foundation.
10acb45439SRussell King  *
11acb45439SRussell King  * 21-Jan-2002 <jco@ict.es> :
12acb45439SRussell King  *
13acb45439SRussell King  * Added support for synchronous A/D mode. This mode is useful to
14acb45439SRussell King  * avoid noise induced in the touchpanel by the LCD, provided that
15acb45439SRussell King  * the UCB1x00 has a valid LCD sync signal routed to its ADCSYNC pin.
16acb45439SRussell King  * It is important to note that the signal connected to the ADCSYNC
17acb45439SRussell King  * pin should provide pulses even when the LCD is blanked, otherwise
18acb45439SRussell King  * a pen touch needed to unblank the LCD will never be read.
19acb45439SRussell King  */
20acb45439SRussell King #include <linux/module.h>
21acb45439SRussell King #include <linux/moduleparam.h>
22acb45439SRussell King #include <linux/init.h>
23acb45439SRussell King #include <linux/smp.h>
24acb45439SRussell King #include <linux/sched.h>
25acb45439SRussell King #include <linux/completion.h>
26acb45439SRussell King #include <linux/delay.h>
27acb45439SRussell King #include <linux/string.h>
28acb45439SRussell King #include <linux/input.h>
29acb45439SRussell King #include <linux/device.h>
307dfb7103SNigel Cunningham #include <linux/freezer.h>
31acb45439SRussell King #include <linux/slab.h>
325437775eSPavel Machek #include <linux/kthread.h>
33c8602edfSThomas Kunze #include <linux/mfd/ucb1x00.h>
34acb45439SRussell King 
35dcea83adSRussell King #include <mach/dma.h>
36a09e64fbSRussell King #include <mach/collie.h>
3717532989SPavel Machek #include <asm/mach-types.h>
38acb45439SRussell King 
39acb45439SRussell King 
40acb45439SRussell King 
41acb45439SRussell King struct ucb1x00_ts {
42bd622663SDmitry Torokhov 	struct input_dev	*idev;
43acb45439SRussell King 	struct ucb1x00		*ucb;
44acb45439SRussell King 
45acb45439SRussell King 	wait_queue_head_t	irq_wait;
46acb45439SRussell King 	struct task_struct	*rtask;
47acb45439SRussell King 	u16			x_res;
48acb45439SRussell King 	u16			y_res;
49acb45439SRussell King 
506b9ea421SRussell King 	unsigned int		restart:1;
516b9ea421SRussell King 	unsigned int		adcsync:1;
52acb45439SRussell King };
53acb45439SRussell King 
54acb45439SRussell King static int adcsync;
55acb45439SRussell King 
56acb45439SRussell King static inline void ucb1x00_ts_evt_add(struct ucb1x00_ts *ts, u16 pressure, u16 x, u16 y)
57acb45439SRussell King {
581393c3edSNicolas Pitre 	struct input_dev *idev = ts->idev;
5908c67d2aSDmitry Torokhov 
601393c3edSNicolas Pitre 	input_report_abs(idev, ABS_X, x);
611393c3edSNicolas Pitre 	input_report_abs(idev, ABS_Y, y);
621393c3edSNicolas Pitre 	input_report_abs(idev, ABS_PRESSURE, pressure);
631393c3edSNicolas Pitre 	input_sync(idev);
64acb45439SRussell King }
65acb45439SRussell King 
66acb45439SRussell King static inline void ucb1x00_ts_event_release(struct ucb1x00_ts *ts)
67acb45439SRussell King {
681393c3edSNicolas Pitre 	struct input_dev *idev = ts->idev;
6908c67d2aSDmitry Torokhov 
701393c3edSNicolas Pitre 	input_report_abs(idev, ABS_PRESSURE, 0);
711393c3edSNicolas Pitre 	input_sync(idev);
72acb45439SRussell King }
73acb45439SRussell King 
74acb45439SRussell King /*
75acb45439SRussell King  * Switch to interrupt mode.
76acb45439SRussell King  */
77acb45439SRussell King static inline void ucb1x00_ts_mode_int(struct ucb1x00_ts *ts)
78acb45439SRussell King {
79acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
80acb45439SRussell King 			UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |
81acb45439SRussell King 			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |
82acb45439SRussell King 			UCB_TS_CR_MODE_INT);
83acb45439SRussell King }
84acb45439SRussell King 
85acb45439SRussell King /*
86acb45439SRussell King  * Switch to pressure mode, and read pressure.  We don't need to wait
87acb45439SRussell King  * here, since both plates are being driven.
88acb45439SRussell King  */
89acb45439SRussell King static inline unsigned int ucb1x00_ts_read_pressure(struct ucb1x00_ts *ts)
90acb45439SRussell King {
9117532989SPavel Machek 	if (machine_is_collie()) {
9217532989SPavel Machek 		ucb1x00_io_write(ts->ucb, COLLIE_TC35143_GPIO_TBL_CHK, 0);
9317532989SPavel Machek 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
9417532989SPavel Machek 				  UCB_TS_CR_TSPX_POW | UCB_TS_CR_TSMX_POW |
9517532989SPavel Machek 				  UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
9617532989SPavel Machek 
9717532989SPavel Machek 		udelay(55);
9817532989SPavel Machek 
9917532989SPavel Machek 		return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_AD2, ts->adcsync);
10017532989SPavel Machek 	} else {
101acb45439SRussell King 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
102acb45439SRussell King 				  UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |
103acb45439SRussell King 				  UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |
104acb45439SRussell King 				  UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
105acb45439SRussell King 
106acb45439SRussell King 		return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync);
107acb45439SRussell King 	}
10817532989SPavel Machek }
109acb45439SRussell King 
110acb45439SRussell King /*
111acb45439SRussell King  * Switch to X position mode and measure Y plate.  We switch the plate
112acb45439SRussell King  * configuration in pressure mode, then switch to position mode.  This
113acb45439SRussell King  * gives a faster response time.  Even so, we need to wait about 55us
114acb45439SRussell King  * for things to stabilise.
115acb45439SRussell King  */
116acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xpos(struct ucb1x00_ts *ts)
117acb45439SRussell King {
11817532989SPavel Machek 	if (machine_is_collie())
11917532989SPavel Machek 		ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK);
12017532989SPavel Machek 	else {
121acb45439SRussell King 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
122acb45439SRussell King 				  UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
123acb45439SRussell King 				  UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
124acb45439SRussell King 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
125acb45439SRussell King 				  UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
126acb45439SRussell King 				  UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
12717532989SPavel Machek 	}
128acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
129acb45439SRussell King 			UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
130acb45439SRussell King 			UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
131acb45439SRussell King 
132acb45439SRussell King 	udelay(55);
133acb45439SRussell King 
134acb45439SRussell King 	return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync);
135acb45439SRussell King }
136acb45439SRussell King 
137acb45439SRussell King /*
138acb45439SRussell King  * Switch to Y position mode and measure X plate.  We switch the plate
139acb45439SRussell King  * configuration in pressure mode, then switch to position mode.  This
140acb45439SRussell King  * gives a faster response time.  Even so, we need to wait about 55us
141acb45439SRussell King  * for things to stabilise.
142acb45439SRussell King  */
143acb45439SRussell King static inline unsigned int ucb1x00_ts_read_ypos(struct ucb1x00_ts *ts)
144acb45439SRussell King {
14517532989SPavel Machek 	if (machine_is_collie())
14617532989SPavel Machek 		ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK);
14717532989SPavel Machek 	else {
148acb45439SRussell King 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
149acb45439SRussell King 				  UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
150acb45439SRussell King 				  UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
151acb45439SRussell King 		ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
152acb45439SRussell King 				  UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
153acb45439SRussell King 				  UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
15417532989SPavel Machek 	}
15517532989SPavel Machek 
156acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
157acb45439SRussell King 			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
158acb45439SRussell King 			UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
159acb45439SRussell King 
160acb45439SRussell King 	udelay(55);
161acb45439SRussell King 
162acb45439SRussell King 	return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPX, ts->adcsync);
163acb45439SRussell King }
164acb45439SRussell King 
165acb45439SRussell King /*
166acb45439SRussell King  * Switch to X plate resistance mode.  Set MX to ground, PX to
167acb45439SRussell King  * supply.  Measure current.
168acb45439SRussell King  */
169acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xres(struct ucb1x00_ts *ts)
170acb45439SRussell King {
171acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
172acb45439SRussell King 			UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
173acb45439SRussell King 			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
174acb45439SRussell King 	return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync);
175acb45439SRussell King }
176acb45439SRussell King 
177acb45439SRussell King /*
178acb45439SRussell King  * Switch to Y plate resistance mode.  Set MY to ground, PY to
179acb45439SRussell King  * supply.  Measure current.
180acb45439SRussell King  */
181acb45439SRussell King static inline unsigned int ucb1x00_ts_read_yres(struct ucb1x00_ts *ts)
182acb45439SRussell King {
183acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
184acb45439SRussell King 			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
185acb45439SRussell King 			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
186acb45439SRussell King 	return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync);
187acb45439SRussell King }
188acb45439SRussell King 
18917532989SPavel Machek static inline int ucb1x00_ts_pen_down(struct ucb1x00_ts *ts)
19017532989SPavel Machek {
19117532989SPavel Machek 	unsigned int val = ucb1x00_reg_read(ts->ucb, UCB_TS_CR);
19208c67d2aSDmitry Torokhov 
19317532989SPavel Machek 	if (machine_is_collie())
19417532989SPavel Machek 		return (!(val & (UCB_TS_CR_TSPX_LOW)));
19517532989SPavel Machek 	else
19617532989SPavel Machek 		return (val & (UCB_TS_CR_TSPX_LOW | UCB_TS_CR_TSMX_LOW));
19717532989SPavel Machek }
19817532989SPavel Machek 
199acb45439SRussell King /*
200acb45439SRussell King  * This is a RT kernel thread that handles the ADC accesses
201acb45439SRussell King  * (mainly so we can use semaphores in the UCB1200 core code
202acb45439SRussell King  * to serialise accesses to the ADC).
203acb45439SRussell King  */
204acb45439SRussell King static int ucb1x00_thread(void *_ts)
205acb45439SRussell King {
206acb45439SRussell King 	struct ucb1x00_ts *ts = _ts;
207f7440b0eSRobert P. J. Day 	DECLARE_WAITQUEUE(wait, current);
2081124d5caSDmitry Torokhov 	int valid = 0;
209acb45439SRussell King 
21083144186SRafael J. Wysocki 	set_freezable();
211acb45439SRussell King 	add_wait_queue(&ts->irq_wait, &wait);
2125437775eSPavel Machek 	while (!kthread_should_stop()) {
21317532989SPavel Machek 		unsigned int x, y, p;
214acb45439SRussell King 		signed long timeout;
215acb45439SRussell King 
216acb45439SRussell King 		ts->restart = 0;
217acb45439SRussell King 
218acb45439SRussell King 		ucb1x00_adc_enable(ts->ucb);
219acb45439SRussell King 
220acb45439SRussell King 		x = ucb1x00_ts_read_xpos(ts);
221acb45439SRussell King 		y = ucb1x00_ts_read_ypos(ts);
222acb45439SRussell King 		p = ucb1x00_ts_read_pressure(ts);
223acb45439SRussell King 
224acb45439SRussell King 		/*
225acb45439SRussell King 		 * Switch back to interrupt mode.
226acb45439SRussell King 		 */
227acb45439SRussell King 		ucb1x00_ts_mode_int(ts);
228acb45439SRussell King 		ucb1x00_adc_disable(ts->ucb);
229acb45439SRussell King 
2305437775eSPavel Machek 		msleep(10);
231acb45439SRussell King 
232acb45439SRussell King 		ucb1x00_enable(ts->ucb);
233acb45439SRussell King 
23417532989SPavel Machek 
23517532989SPavel Machek 		if (ucb1x00_ts_pen_down(ts)) {
236f7440b0eSRobert P. J. Day 			set_current_state(TASK_INTERRUPTIBLE);
237acb45439SRussell King 
23817532989SPavel Machek 			ucb1x00_enable_irq(ts->ucb, UCB_IRQ_TSPX, machine_is_collie() ? UCB_RISING : UCB_FALLING);
239acb45439SRussell King 			ucb1x00_disable(ts->ucb);
240acb45439SRussell King 
241acb45439SRussell King 			/*
242acb45439SRussell King 			 * If we spat out a valid sample set last time,
243acb45439SRussell King 			 * spit out a "pen off" sample here.
244acb45439SRussell King 			 */
245acb45439SRussell King 			if (valid) {
246acb45439SRussell King 				ucb1x00_ts_event_release(ts);
247acb45439SRussell King 				valid = 0;
248acb45439SRussell King 			}
249acb45439SRussell King 
250acb45439SRussell King 			timeout = MAX_SCHEDULE_TIMEOUT;
251acb45439SRussell King 		} else {
252acb45439SRussell King 			ucb1x00_disable(ts->ucb);
253acb45439SRussell King 
254acb45439SRussell King 			/*
255acb45439SRussell King 			 * Filtering is policy.  Policy belongs in user
256acb45439SRussell King 			 * space.  We therefore leave it to user space
257acb45439SRussell King 			 * to do any filtering they please.
258acb45439SRussell King 			 */
259acb45439SRussell King 			if (!ts->restart) {
260acb45439SRussell King 				ucb1x00_ts_evt_add(ts, p, x, y);
261acb45439SRussell King 				valid = 1;
262acb45439SRussell King 			}
263acb45439SRussell King 
264f7440b0eSRobert P. J. Day 			set_current_state(TASK_INTERRUPTIBLE);
265acb45439SRussell King 			timeout = HZ / 100;
266acb45439SRussell King 		}
267acb45439SRussell King 
268acb45439SRussell King 		try_to_freeze();
269acb45439SRussell King 
270acb45439SRussell King 		schedule_timeout(timeout);
271acb45439SRussell King 	}
272acb45439SRussell King 
273acb45439SRussell King 	remove_wait_queue(&ts->irq_wait, &wait);
274acb45439SRussell King 
275acb45439SRussell King 	ts->rtask = NULL;
2765437775eSPavel Machek 	return 0;
277acb45439SRussell King }
278acb45439SRussell King 
279acb45439SRussell King /*
280acb45439SRussell King  * We only detect touch screen _touches_ with this interrupt
281acb45439SRussell King  * handler, and even then we just schedule our task.
282acb45439SRussell King  */
283acb45439SRussell King static void ucb1x00_ts_irq(int idx, void *id)
284acb45439SRussell King {
285acb45439SRussell King 	struct ucb1x00_ts *ts = id;
28608c67d2aSDmitry Torokhov 
287acb45439SRussell King 	ucb1x00_disable_irq(ts->ucb, UCB_IRQ_TSPX, UCB_FALLING);
288acb45439SRussell King 	wake_up(&ts->irq_wait);
289acb45439SRussell King }
290acb45439SRussell King 
291acb45439SRussell King static int ucb1x00_ts_open(struct input_dev *idev)
292acb45439SRussell King {
29326be5a50SDmitry Torokhov 	struct ucb1x00_ts *ts = input_get_drvdata(idev);
294acb45439SRussell King 	int ret = 0;
295acb45439SRussell King 
2965437775eSPavel Machek 	BUG_ON(ts->rtask);
297acb45439SRussell King 
298acb45439SRussell King 	init_waitqueue_head(&ts->irq_wait);
299acb45439SRussell King 	ret = ucb1x00_hook_irq(ts->ucb, UCB_IRQ_TSPX, ucb1x00_ts_irq, ts);
300acb45439SRussell King 	if (ret < 0)
301acb45439SRussell King 		goto out;
302acb45439SRussell King 
303acb45439SRussell King 	/*
304acb45439SRussell King 	 * If we do this at all, we should allow the user to
305acb45439SRussell King 	 * measure and read the X and Y resistance at any time.
306acb45439SRussell King 	 */
307acb45439SRussell King 	ucb1x00_adc_enable(ts->ucb);
308acb45439SRussell King 	ts->x_res = ucb1x00_ts_read_xres(ts);
309acb45439SRussell King 	ts->y_res = ucb1x00_ts_read_yres(ts);
310acb45439SRussell King 	ucb1x00_adc_disable(ts->ucb);
311acb45439SRussell King 
3125437775eSPavel Machek 	ts->rtask = kthread_run(ucb1x00_thread, ts, "ktsd");
3135437775eSPavel Machek 	if (!IS_ERR(ts->rtask)) {
314acb45439SRussell King 		ret = 0;
315acb45439SRussell King 	} else {
316acb45439SRussell King 		ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts);
3175437775eSPavel Machek 		ts->rtask = NULL;
3185437775eSPavel Machek 		ret = -EFAULT;
319acb45439SRussell King 	}
320acb45439SRussell King 
321acb45439SRussell King  out:
322acb45439SRussell King 	return ret;
323acb45439SRussell King }
324acb45439SRussell King 
325acb45439SRussell King /*
326acb45439SRussell King  * Release touchscreen resources.  Disable IRQs.
327acb45439SRussell King  */
328acb45439SRussell King static void ucb1x00_ts_close(struct input_dev *idev)
329acb45439SRussell King {
33026be5a50SDmitry Torokhov 	struct ucb1x00_ts *ts = input_get_drvdata(idev);
331acb45439SRussell King 
3325437775eSPavel Machek 	if (ts->rtask)
3335437775eSPavel Machek 		kthread_stop(ts->rtask);
334acb45439SRussell King 
335acb45439SRussell King 	ucb1x00_enable(ts->ucb);
336acb45439SRussell King 	ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts);
337acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 0);
338acb45439SRussell King 	ucb1x00_disable(ts->ucb);
339acb45439SRussell King }
340acb45439SRussell King 
341acb45439SRussell King #ifdef CONFIG_PM
342acb45439SRussell King static int ucb1x00_ts_resume(struct ucb1x00_dev *dev)
343acb45439SRussell King {
344acb45439SRussell King 	struct ucb1x00_ts *ts = dev->priv;
345acb45439SRussell King 
346acb45439SRussell King 	if (ts->rtask != NULL) {
347acb45439SRussell King 		/*
348acb45439SRussell King 		 * Restart the TS thread to ensure the
349acb45439SRussell King 		 * TS interrupt mode is set up again
350acb45439SRussell King 		 * after sleep.
351acb45439SRussell King 		 */
352acb45439SRussell King 		ts->restart = 1;
353acb45439SRussell King 		wake_up(&ts->irq_wait);
354acb45439SRussell King 	}
355acb45439SRussell King 	return 0;
356acb45439SRussell King }
357acb45439SRussell King #else
358acb45439SRussell King #define ucb1x00_ts_resume NULL
359acb45439SRussell King #endif
360acb45439SRussell King 
361acb45439SRussell King 
362acb45439SRussell King /*
363acb45439SRussell King  * Initialisation.
364acb45439SRussell King  */
365acb45439SRussell King static int ucb1x00_ts_add(struct ucb1x00_dev *dev)
366acb45439SRussell King {
367acb45439SRussell King 	struct ucb1x00_ts *ts;
36808c67d2aSDmitry Torokhov 	struct input_dev *idev;
36908c67d2aSDmitry Torokhov 	int err;
370acb45439SRussell King 
371bd622663SDmitry Torokhov 	ts = kzalloc(sizeof(struct ucb1x00_ts), GFP_KERNEL);
37208c67d2aSDmitry Torokhov 	idev = input_allocate_device();
37308c67d2aSDmitry Torokhov 	if (!ts || !idev) {
37408c67d2aSDmitry Torokhov 		err = -ENOMEM;
37508c67d2aSDmitry Torokhov 		goto fail;
376bd622663SDmitry Torokhov 	}
377acb45439SRussell King 
378acb45439SRussell King 	ts->ucb = dev->ucb;
37908c67d2aSDmitry Torokhov 	ts->idev = idev;
380acb45439SRussell King 	ts->adcsync = adcsync ? UCB_SYNC : UCB_NOSYNC;
381acb45439SRussell King 
38208c67d2aSDmitry Torokhov 	idev->name       = "Touchscreen panel";
38308c67d2aSDmitry Torokhov 	idev->id.product = ts->ucb->id;
38408c67d2aSDmitry Torokhov 	idev->open       = ucb1x00_ts_open;
38508c67d2aSDmitry Torokhov 	idev->close      = ucb1x00_ts_close;
386acb45439SRussell King 
38708c67d2aSDmitry Torokhov 	__set_bit(EV_ABS, idev->evbit);
38808c67d2aSDmitry Torokhov 	__set_bit(ABS_X, idev->absbit);
38908c67d2aSDmitry Torokhov 	__set_bit(ABS_Y, idev->absbit);
39008c67d2aSDmitry Torokhov 	__set_bit(ABS_PRESSURE, idev->absbit);
391acb45439SRussell King 
39226be5a50SDmitry Torokhov 	input_set_drvdata(idev, ts);
39326be5a50SDmitry Torokhov 
39408c67d2aSDmitry Torokhov 	err = input_register_device(idev);
39508c67d2aSDmitry Torokhov 	if (err)
39608c67d2aSDmitry Torokhov 		goto fail;
397acb45439SRussell King 
398acb45439SRussell King 	dev->priv = ts;
399acb45439SRussell King 
400acb45439SRussell King 	return 0;
40108c67d2aSDmitry Torokhov 
40208c67d2aSDmitry Torokhov  fail:
40308c67d2aSDmitry Torokhov 	input_free_device(idev);
40408c67d2aSDmitry Torokhov 	kfree(ts);
40508c67d2aSDmitry Torokhov 	return err;
406acb45439SRussell King }
407acb45439SRussell King 
408acb45439SRussell King static void ucb1x00_ts_remove(struct ucb1x00_dev *dev)
409acb45439SRussell King {
410acb45439SRussell King 	struct ucb1x00_ts *ts = dev->priv;
411bd622663SDmitry Torokhov 
412bd622663SDmitry Torokhov 	input_unregister_device(ts->idev);
413acb45439SRussell King 	kfree(ts);
414acb45439SRussell King }
415acb45439SRussell King 
416acb45439SRussell King static struct ucb1x00_driver ucb1x00_ts_driver = {
417acb45439SRussell King 	.add		= ucb1x00_ts_add,
418acb45439SRussell King 	.remove		= ucb1x00_ts_remove,
419acb45439SRussell King 	.resume		= ucb1x00_ts_resume,
420acb45439SRussell King };
421acb45439SRussell King 
422acb45439SRussell King static int __init ucb1x00_ts_init(void)
423acb45439SRussell King {
424acb45439SRussell King 	return ucb1x00_register_driver(&ucb1x00_ts_driver);
425acb45439SRussell King }
426acb45439SRussell King 
427acb45439SRussell King static void __exit ucb1x00_ts_exit(void)
428acb45439SRussell King {
429acb45439SRussell King 	ucb1x00_unregister_driver(&ucb1x00_ts_driver);
430acb45439SRussell King }
431acb45439SRussell King 
432acb45439SRussell King module_param(adcsync, int, 0444);
433acb45439SRussell King module_init(ucb1x00_ts_init);
434acb45439SRussell King module_exit(ucb1x00_ts_exit);
435acb45439SRussell King 
436acb45439SRussell King MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
437acb45439SRussell King MODULE_DESCRIPTION("UCB1x00 touchscreen driver");
438acb45439SRussell King MODULE_LICENSE("GPL");
439