xref: /openbmc/linux/drivers/mfd/ucb1x00-ts.c (revision d2912cb1)
1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2acb45439SRussell King /*
35437775eSPavel Machek  *  Touchscreen driver for UCB1x00-based touchscreens
4acb45439SRussell King  *
5acb45439SRussell King  *  Copyright (C) 2001 Russell King, All Rights Reserved.
65437775eSPavel Machek  *  Copyright (C) 2005 Pavel Machek
7acb45439SRussell King  *
8acb45439SRussell King  * 21-Jan-2002 <jco@ict.es> :
9acb45439SRussell King  *
10acb45439SRussell King  * Added support for synchronous A/D mode. This mode is useful to
11acb45439SRussell King  * avoid noise induced in the touchpanel by the LCD, provided that
12acb45439SRussell King  * the UCB1x00 has a valid LCD sync signal routed to its ADCSYNC pin.
13acb45439SRussell King  * It is important to note that the signal connected to the ADCSYNC
14acb45439SRussell King  * pin should provide pulses even when the LCD is blanked, otherwise
15acb45439SRussell King  * a pen touch needed to unblank the LCD will never be read.
16acb45439SRussell King  */
17acb45439SRussell King #include <linux/module.h>
18acb45439SRussell King #include <linux/moduleparam.h>
19acb45439SRussell King #include <linux/init.h>
20a3364409SRussell King #include <linux/interrupt.h>
21acb45439SRussell King #include <linux/sched.h>
22a3364409SRussell King #include <linux/spinlock.h>
23acb45439SRussell King #include <linux/completion.h>
24acb45439SRussell King #include <linux/delay.h>
25acb45439SRussell King #include <linux/string.h>
26acb45439SRussell King #include <linux/input.h>
27acb45439SRussell King #include <linux/device.h>
287dfb7103SNigel Cunningham #include <linux/freezer.h>
29acb45439SRussell King #include <linux/slab.h>
305437775eSPavel Machek #include <linux/kthread.h>
31c8602edfSThomas Kunze #include <linux/mfd/ucb1x00.h>
32acb45439SRussell King 
33a09e64fbSRussell King #include <mach/collie.h>
3417532989SPavel Machek #include <asm/mach-types.h>
35acb45439SRussell King 
36acb45439SRussell King 
37acb45439SRussell King 
38acb45439SRussell King struct ucb1x00_ts {
39bd622663SDmitry Torokhov 	struct input_dev	*idev;
40acb45439SRussell King 	struct ucb1x00		*ucb;
41acb45439SRussell King 
42a3364409SRussell King 	spinlock_t		irq_lock;
43a3364409SRussell King 	unsigned		irq_disabled;
44acb45439SRussell King 	wait_queue_head_t	irq_wait;
45acb45439SRussell King 	struct task_struct	*rtask;
46acb45439SRussell King 	u16			x_res;
47acb45439SRussell King 	u16			y_res;
48acb45439SRussell King 
496b9ea421SRussell King 	unsigned int		adcsync:1;
50acb45439SRussell King };
51acb45439SRussell King 
52acb45439SRussell King static int adcsync;
53acb45439SRussell King 
ucb1x00_ts_evt_add(struct ucb1x00_ts * ts,u16 pressure,u16 x,u16 y)54acb45439SRussell King static inline void ucb1x00_ts_evt_add(struct ucb1x00_ts *ts, u16 pressure, u16 x, u16 y)
55acb45439SRussell King {
561393c3edSNicolas Pitre 	struct input_dev *idev = ts->idev;
5708c67d2aSDmitry Torokhov 
581393c3edSNicolas Pitre 	input_report_abs(idev, ABS_X, x);
591393c3edSNicolas Pitre 	input_report_abs(idev, ABS_Y, y);
601393c3edSNicolas Pitre 	input_report_abs(idev, ABS_PRESSURE, pressure);
61de8c8b06SJochen Friedrich 	input_report_key(idev, BTN_TOUCH, 1);
621393c3edSNicolas Pitre 	input_sync(idev);
63acb45439SRussell King }
64acb45439SRussell King 
ucb1x00_ts_event_release(struct ucb1x00_ts * ts)65acb45439SRussell King static inline void ucb1x00_ts_event_release(struct ucb1x00_ts *ts)
66acb45439SRussell King {
671393c3edSNicolas Pitre 	struct input_dev *idev = ts->idev;
6808c67d2aSDmitry Torokhov 
691393c3edSNicolas Pitre 	input_report_abs(idev, ABS_PRESSURE, 0);
70de8c8b06SJochen Friedrich 	input_report_key(idev, BTN_TOUCH, 0);
711393c3edSNicolas Pitre 	input_sync(idev);
72acb45439SRussell King }
73acb45439SRussell King 
74acb45439SRussell King /*
75acb45439SRussell King  * Switch to interrupt mode.
76acb45439SRussell King  */
ucb1x00_ts_mode_int(struct ucb1x00_ts * ts)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  */
ucb1x00_ts_read_pressure(struct ucb1x00_ts * ts)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  */
ucb1x00_ts_read_xpos(struct ucb1x00_ts * ts)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  */
ucb1x00_ts_read_ypos(struct ucb1x00_ts * ts)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  */
ucb1x00_ts_read_xres(struct ucb1x00_ts * ts)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  */
ucb1x00_ts_read_yres(struct ucb1x00_ts * ts)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 
ucb1x00_ts_pen_down(struct ucb1x00_ts * ts)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  */
ucb1x00_thread(void * _ts)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);
2080af5e4c3SRussell King 	bool frozen, ignore = false;
2091124d5caSDmitry Torokhov 	int valid = 0;
210acb45439SRussell King 
21183144186SRafael J. Wysocki 	set_freezable();
212acb45439SRussell King 	add_wait_queue(&ts->irq_wait, &wait);
2130af5e4c3SRussell King 	while (!kthread_freezable_should_stop(&frozen)) {
21417532989SPavel Machek 		unsigned int x, y, p;
215acb45439SRussell King 		signed long timeout;
216acb45439SRussell King 
2170af5e4c3SRussell King 		if (frozen)
2180af5e4c3SRussell King 			ignore = true;
219acb45439SRussell King 
220acb45439SRussell King 		ucb1x00_adc_enable(ts->ucb);
221acb45439SRussell King 
222acb45439SRussell King 		x = ucb1x00_ts_read_xpos(ts);
223acb45439SRussell King 		y = ucb1x00_ts_read_ypos(ts);
224acb45439SRussell King 		p = ucb1x00_ts_read_pressure(ts);
225acb45439SRussell King 
226acb45439SRussell King 		/*
227acb45439SRussell King 		 * Switch back to interrupt mode.
228acb45439SRussell King 		 */
229acb45439SRussell King 		ucb1x00_ts_mode_int(ts);
230acb45439SRussell King 		ucb1x00_adc_disable(ts->ucb);
231acb45439SRussell King 
2325437775eSPavel Machek 		msleep(10);
233acb45439SRussell King 
234acb45439SRussell King 		ucb1x00_enable(ts->ucb);
235acb45439SRussell King 
23617532989SPavel Machek 
23717532989SPavel Machek 		if (ucb1x00_ts_pen_down(ts)) {
238f7440b0eSRobert P. J. Day 			set_current_state(TASK_INTERRUPTIBLE);
239acb45439SRussell King 
240a3364409SRussell King 			spin_lock_irq(&ts->irq_lock);
241a3364409SRussell King 			if (ts->irq_disabled) {
242a3364409SRussell King 				ts->irq_disabled = 0;
243a3364409SRussell King 				enable_irq(ts->ucb->irq_base + UCB_IRQ_TSPX);
244a3364409SRussell King 			}
245a3364409SRussell King 			spin_unlock_irq(&ts->irq_lock);
246acb45439SRussell King 			ucb1x00_disable(ts->ucb);
247acb45439SRussell King 
248acb45439SRussell King 			/*
249acb45439SRussell King 			 * If we spat out a valid sample set last time,
250acb45439SRussell King 			 * spit out a "pen off" sample here.
251acb45439SRussell King 			 */
252acb45439SRussell King 			if (valid) {
253acb45439SRussell King 				ucb1x00_ts_event_release(ts);
254acb45439SRussell King 				valid = 0;
255acb45439SRussell King 			}
256acb45439SRussell King 
257acb45439SRussell King 			timeout = MAX_SCHEDULE_TIMEOUT;
258acb45439SRussell King 		} else {
259acb45439SRussell King 			ucb1x00_disable(ts->ucb);
260acb45439SRussell King 
261acb45439SRussell King 			/*
262acb45439SRussell King 			 * Filtering is policy.  Policy belongs in user
263acb45439SRussell King 			 * space.  We therefore leave it to user space
264acb45439SRussell King 			 * to do any filtering they please.
265acb45439SRussell King 			 */
2660af5e4c3SRussell King 			if (!ignore) {
267acb45439SRussell King 				ucb1x00_ts_evt_add(ts, p, x, y);
268acb45439SRussell King 				valid = 1;
269acb45439SRussell King 			}
270acb45439SRussell King 
271f7440b0eSRobert P. J. Day 			set_current_state(TASK_INTERRUPTIBLE);
272acb45439SRussell King 			timeout = HZ / 100;
273acb45439SRussell King 		}
274acb45439SRussell King 
275acb45439SRussell King 		schedule_timeout(timeout);
276acb45439SRussell King 	}
277acb45439SRussell King 
278acb45439SRussell King 	remove_wait_queue(&ts->irq_wait, &wait);
279acb45439SRussell King 
280acb45439SRussell King 	ts->rtask = NULL;
2815437775eSPavel Machek 	return 0;
282acb45439SRussell King }
283acb45439SRussell King 
284acb45439SRussell King /*
285acb45439SRussell King  * We only detect touch screen _touches_ with this interrupt
286acb45439SRussell King  * handler, and even then we just schedule our task.
287acb45439SRussell King  */
ucb1x00_ts_irq(int irq,void * id)288a3364409SRussell King static irqreturn_t ucb1x00_ts_irq(int irq, void *id)
289acb45439SRussell King {
290acb45439SRussell King 	struct ucb1x00_ts *ts = id;
29108c67d2aSDmitry Torokhov 
292a3364409SRussell King 	spin_lock(&ts->irq_lock);
293a3364409SRussell King 	ts->irq_disabled = 1;
294a3364409SRussell King 	disable_irq_nosync(ts->ucb->irq_base + UCB_IRQ_TSPX);
295a3364409SRussell King 	spin_unlock(&ts->irq_lock);
296acb45439SRussell King 	wake_up(&ts->irq_wait);
297a3364409SRussell King 
298a3364409SRussell King 	return IRQ_HANDLED;
299acb45439SRussell King }
300acb45439SRussell King 
ucb1x00_ts_open(struct input_dev * idev)301acb45439SRussell King static int ucb1x00_ts_open(struct input_dev *idev)
302acb45439SRussell King {
30326be5a50SDmitry Torokhov 	struct ucb1x00_ts *ts = input_get_drvdata(idev);
304a3364409SRussell King 	unsigned long flags = 0;
305acb45439SRussell King 	int ret = 0;
306acb45439SRussell King 
3075437775eSPavel Machek 	BUG_ON(ts->rtask);
308acb45439SRussell King 
309a3364409SRussell King 	if (machine_is_collie())
310a3364409SRussell King 		flags = IRQF_TRIGGER_RISING;
311a3364409SRussell King 	else
312a3364409SRussell King 		flags = IRQF_TRIGGER_FALLING;
313a3364409SRussell King 
314a3364409SRussell King 	ts->irq_disabled = 0;
315a3364409SRussell King 
316acb45439SRussell King 	init_waitqueue_head(&ts->irq_wait);
317a3364409SRussell King 	ret = request_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ucb1x00_ts_irq,
318a3364409SRussell King 			  flags, "ucb1x00-ts", ts);
319acb45439SRussell King 	if (ret < 0)
320acb45439SRussell King 		goto out;
321acb45439SRussell King 
322acb45439SRussell King 	/*
323acb45439SRussell King 	 * If we do this at all, we should allow the user to
324acb45439SRussell King 	 * measure and read the X and Y resistance at any time.
325acb45439SRussell King 	 */
326acb45439SRussell King 	ucb1x00_adc_enable(ts->ucb);
327acb45439SRussell King 	ts->x_res = ucb1x00_ts_read_xres(ts);
328acb45439SRussell King 	ts->y_res = ucb1x00_ts_read_yres(ts);
329acb45439SRussell King 	ucb1x00_adc_disable(ts->ucb);
330acb45439SRussell King 
3315437775eSPavel Machek 	ts->rtask = kthread_run(ucb1x00_thread, ts, "ktsd");
3325437775eSPavel Machek 	if (!IS_ERR(ts->rtask)) {
333acb45439SRussell King 		ret = 0;
334acb45439SRussell King 	} else {
335a3364409SRussell King 		free_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ts);
3365437775eSPavel Machek 		ts->rtask = NULL;
3375437775eSPavel Machek 		ret = -EFAULT;
338acb45439SRussell King 	}
339acb45439SRussell King 
340acb45439SRussell King  out:
341acb45439SRussell King 	return ret;
342acb45439SRussell King }
343acb45439SRussell King 
344acb45439SRussell King /*
345acb45439SRussell King  * Release touchscreen resources.  Disable IRQs.
346acb45439SRussell King  */
ucb1x00_ts_close(struct input_dev * idev)347acb45439SRussell King static void ucb1x00_ts_close(struct input_dev *idev)
348acb45439SRussell King {
34926be5a50SDmitry Torokhov 	struct ucb1x00_ts *ts = input_get_drvdata(idev);
350acb45439SRussell King 
3515437775eSPavel Machek 	if (ts->rtask)
3525437775eSPavel Machek 		kthread_stop(ts->rtask);
353acb45439SRussell King 
354acb45439SRussell King 	ucb1x00_enable(ts->ucb);
355a3364409SRussell King 	free_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ts);
356acb45439SRussell King 	ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 0);
357acb45439SRussell King 	ucb1x00_disable(ts->ucb);
358acb45439SRussell King }
359acb45439SRussell King 
360acb45439SRussell King 
361acb45439SRussell King /*
362acb45439SRussell King  * Initialisation.
363acb45439SRussell King  */
ucb1x00_ts_add(struct ucb1x00_dev * dev)364acb45439SRussell King static int ucb1x00_ts_add(struct ucb1x00_dev *dev)
365acb45439SRussell King {
366acb45439SRussell King 	struct ucb1x00_ts *ts;
36708c67d2aSDmitry Torokhov 	struct input_dev *idev;
36808c67d2aSDmitry Torokhov 	int err;
369acb45439SRussell King 
370bd622663SDmitry Torokhov 	ts = kzalloc(sizeof(struct ucb1x00_ts), GFP_KERNEL);
37108c67d2aSDmitry Torokhov 	idev = input_allocate_device();
37208c67d2aSDmitry Torokhov 	if (!ts || !idev) {
37308c67d2aSDmitry Torokhov 		err = -ENOMEM;
37408c67d2aSDmitry Torokhov 		goto fail;
375bd622663SDmitry Torokhov 	}
376acb45439SRussell King 
377acb45439SRussell King 	ts->ucb = dev->ucb;
37808c67d2aSDmitry Torokhov 	ts->idev = idev;
379acb45439SRussell King 	ts->adcsync = adcsync ? UCB_SYNC : UCB_NOSYNC;
380a3364409SRussell King 	spin_lock_init(&ts->irq_lock);
381acb45439SRussell King 
38208c67d2aSDmitry Torokhov 	idev->name       = "Touchscreen panel";
38365f2e753SRussell King 	idev->id.product = ts->ucb->id;
38408c67d2aSDmitry Torokhov 	idev->open       = ucb1x00_ts_open;
38508c67d2aSDmitry Torokhov 	idev->close      = ucb1x00_ts_close;
386945f6310SRussell King 	idev->dev.parent = &ts->ucb->dev;
387acb45439SRussell King 
388de8c8b06SJochen Friedrich 	idev->evbit[0]   = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
389de8c8b06SJochen Friedrich 	idev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
390acb45439SRussell King 
39126be5a50SDmitry Torokhov 	input_set_drvdata(idev, ts);
39226be5a50SDmitry Torokhov 
3939063f1f1SJochen Friedrich 	ucb1x00_adc_enable(ts->ucb);
3949063f1f1SJochen Friedrich 	ts->x_res = ucb1x00_ts_read_xres(ts);
3959063f1f1SJochen Friedrich 	ts->y_res = ucb1x00_ts_read_yres(ts);
3969063f1f1SJochen Friedrich 	ucb1x00_adc_disable(ts->ucb);
3979063f1f1SJochen Friedrich 
3989063f1f1SJochen Friedrich 	input_set_abs_params(idev, ABS_X, 0, ts->x_res, 0, 0);
3999063f1f1SJochen Friedrich 	input_set_abs_params(idev, ABS_Y, 0, ts->y_res, 0, 0);
4009063f1f1SJochen Friedrich 	input_set_abs_params(idev, ABS_PRESSURE, 0, 0, 0, 0);
4019063f1f1SJochen Friedrich 
40208c67d2aSDmitry Torokhov 	err = input_register_device(idev);
40308c67d2aSDmitry Torokhov 	if (err)
40408c67d2aSDmitry Torokhov 		goto fail;
405acb45439SRussell King 
406acb45439SRussell King 	dev->priv = ts;
407acb45439SRussell King 
408acb45439SRussell King 	return 0;
40908c67d2aSDmitry Torokhov 
41008c67d2aSDmitry Torokhov  fail:
41108c67d2aSDmitry Torokhov 	input_free_device(idev);
41208c67d2aSDmitry Torokhov 	kfree(ts);
41308c67d2aSDmitry Torokhov 	return err;
414acb45439SRussell King }
415acb45439SRussell King 
ucb1x00_ts_remove(struct ucb1x00_dev * dev)416acb45439SRussell King static void ucb1x00_ts_remove(struct ucb1x00_dev *dev)
417acb45439SRussell King {
418acb45439SRussell King 	struct ucb1x00_ts *ts = dev->priv;
419bd622663SDmitry Torokhov 
420bd622663SDmitry Torokhov 	input_unregister_device(ts->idev);
421acb45439SRussell King 	kfree(ts);
422acb45439SRussell King }
423acb45439SRussell King 
424acb45439SRussell King static struct ucb1x00_driver ucb1x00_ts_driver = {
425acb45439SRussell King 	.add		= ucb1x00_ts_add,
426acb45439SRussell King 	.remove		= ucb1x00_ts_remove,
427acb45439SRussell King };
428acb45439SRussell King 
ucb1x00_ts_init(void)429acb45439SRussell King static int __init ucb1x00_ts_init(void)
430acb45439SRussell King {
431acb45439SRussell King 	return ucb1x00_register_driver(&ucb1x00_ts_driver);
432acb45439SRussell King }
433acb45439SRussell King 
ucb1x00_ts_exit(void)434acb45439SRussell King static void __exit ucb1x00_ts_exit(void)
435acb45439SRussell King {
436acb45439SRussell King 	ucb1x00_unregister_driver(&ucb1x00_ts_driver);
437acb45439SRussell King }
438acb45439SRussell King 
439acb45439SRussell King module_param(adcsync, int, 0444);
440acb45439SRussell King module_init(ucb1x00_ts_init);
441acb45439SRussell King module_exit(ucb1x00_ts_exit);
442acb45439SRussell King 
443acb45439SRussell King MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
444acb45439SRussell King MODULE_DESCRIPTION("UCB1x00 touchscreen driver");
445acb45439SRussell King MODULE_LICENSE("GPL");
446