xref: /OK3568_Linux_fs/kernel/drivers/input/touchscreen/wm831x-ts.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Touchscreen driver for WM831x PMICs
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2011 Wolfson Microelectronics plc.
6*4882a593Smuzhiyun  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/moduleparam.h>
11*4882a593Smuzhiyun #include <linux/kernel.h>
12*4882a593Smuzhiyun #include <linux/string.h>
13*4882a593Smuzhiyun #include <linux/pm.h>
14*4882a593Smuzhiyun #include <linux/input.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/io.h>
17*4882a593Smuzhiyun #include <linux/mfd/wm831x/core.h>
18*4882a593Smuzhiyun #include <linux/mfd/wm831x/irq.h>
19*4882a593Smuzhiyun #include <linux/mfd/wm831x/pdata.h>
20*4882a593Smuzhiyun #include <linux/platform_device.h>
21*4882a593Smuzhiyun #include <linux/slab.h>
22*4882a593Smuzhiyun #include <linux/types.h>
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun /*
25*4882a593Smuzhiyun  * R16424 (0x4028) - Touch Control 1
26*4882a593Smuzhiyun  */
27*4882a593Smuzhiyun #define WM831X_TCH_ENA                          0x8000  /* TCH_ENA */
28*4882a593Smuzhiyun #define WM831X_TCH_CVT_ENA                      0x4000  /* TCH_CVT_ENA */
29*4882a593Smuzhiyun #define WM831X_TCH_SLPENA                       0x1000  /* TCH_SLPENA */
30*4882a593Smuzhiyun #define WM831X_TCH_Z_ENA                        0x0400  /* TCH_Z_ENA */
31*4882a593Smuzhiyun #define WM831X_TCH_Y_ENA                        0x0200  /* TCH_Y_ENA */
32*4882a593Smuzhiyun #define WM831X_TCH_X_ENA                        0x0100  /* TCH_X_ENA */
33*4882a593Smuzhiyun #define WM831X_TCH_DELAY_MASK                   0x00E0  /* TCH_DELAY - [7:5] */
34*4882a593Smuzhiyun #define WM831X_TCH_DELAY_SHIFT                       5  /* TCH_DELAY - [7:5] */
35*4882a593Smuzhiyun #define WM831X_TCH_DELAY_WIDTH                       3  /* TCH_DELAY - [7:5] */
36*4882a593Smuzhiyun #define WM831X_TCH_RATE_MASK                    0x001F  /* TCH_RATE - [4:0] */
37*4882a593Smuzhiyun #define WM831X_TCH_RATE_SHIFT                        0  /* TCH_RATE - [4:0] */
38*4882a593Smuzhiyun #define WM831X_TCH_RATE_WIDTH                        5  /* TCH_RATE - [4:0] */
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun /*
41*4882a593Smuzhiyun  * R16425 (0x4029) - Touch Control 2
42*4882a593Smuzhiyun  */
43*4882a593Smuzhiyun #define WM831X_TCH_PD_WK                        0x2000  /* TCH_PD_WK */
44*4882a593Smuzhiyun #define WM831X_TCH_5WIRE                        0x1000  /* TCH_5WIRE */
45*4882a593Smuzhiyun #define WM831X_TCH_PDONLY                       0x0800  /* TCH_PDONLY */
46*4882a593Smuzhiyun #define WM831X_TCH_ISEL                         0x0100  /* TCH_ISEL */
47*4882a593Smuzhiyun #define WM831X_TCH_RPU_MASK                     0x000F  /* TCH_RPU - [3:0] */
48*4882a593Smuzhiyun #define WM831X_TCH_RPU_SHIFT                         0  /* TCH_RPU - [3:0] */
49*4882a593Smuzhiyun #define WM831X_TCH_RPU_WIDTH                         4  /* TCH_RPU - [3:0] */
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun /*
52*4882a593Smuzhiyun  * R16426-8 (0x402A-C) - Touch Data X/Y/X
53*4882a593Smuzhiyun  */
54*4882a593Smuzhiyun #define WM831X_TCH_PD                           0x8000  /* TCH_PD1 */
55*4882a593Smuzhiyun #define WM831X_TCH_DATA_MASK                    0x0FFF  /* TCH_DATA - [11:0] */
56*4882a593Smuzhiyun #define WM831X_TCH_DATA_SHIFT                        0  /* TCH_DATA - [11:0] */
57*4882a593Smuzhiyun #define WM831X_TCH_DATA_WIDTH                       12  /* TCH_DATA - [11:0] */
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun struct wm831x_ts {
60*4882a593Smuzhiyun 	struct input_dev *input_dev;
61*4882a593Smuzhiyun 	struct wm831x *wm831x;
62*4882a593Smuzhiyun 	unsigned int data_irq;
63*4882a593Smuzhiyun 	unsigned int pd_irq;
64*4882a593Smuzhiyun 	bool pressure;
65*4882a593Smuzhiyun 	bool pen_down;
66*4882a593Smuzhiyun 	struct work_struct pd_data_work;
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun 
wm831x_pd_data_work(struct work_struct * work)69*4882a593Smuzhiyun static void wm831x_pd_data_work(struct work_struct *work)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts =
72*4882a593Smuzhiyun 		container_of(work, struct wm831x_ts, pd_data_work);
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	if (wm831x_ts->pen_down) {
75*4882a593Smuzhiyun 		enable_irq(wm831x_ts->data_irq);
76*4882a593Smuzhiyun 		dev_dbg(wm831x_ts->wm831x->dev, "IRQ PD->DATA done\n");
77*4882a593Smuzhiyun 	} else {
78*4882a593Smuzhiyun 		enable_irq(wm831x_ts->pd_irq);
79*4882a593Smuzhiyun 		dev_dbg(wm831x_ts->wm831x->dev, "IRQ DATA->PD done\n");
80*4882a593Smuzhiyun 	}
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun 
wm831x_ts_data_irq(int irq,void * irq_data)83*4882a593Smuzhiyun static irqreturn_t wm831x_ts_data_irq(int irq, void *irq_data)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts = irq_data;
86*4882a593Smuzhiyun 	struct wm831x *wm831x = wm831x_ts->wm831x;
87*4882a593Smuzhiyun 	static int data_types[] = { ABS_X, ABS_Y, ABS_PRESSURE };
88*4882a593Smuzhiyun 	u16 data[3];
89*4882a593Smuzhiyun 	int count;
90*4882a593Smuzhiyun 	int i, ret;
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	if (wm831x_ts->pressure)
93*4882a593Smuzhiyun 		count = 3;
94*4882a593Smuzhiyun 	else
95*4882a593Smuzhiyun 		count = 2;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
98*4882a593Smuzhiyun 			WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	ret = wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count,
101*4882a593Smuzhiyun 			       data);
102*4882a593Smuzhiyun 	if (ret != 0) {
103*4882a593Smuzhiyun 		dev_err(wm831x->dev, "Failed to read touch data: %d\n",
104*4882a593Smuzhiyun 			ret);
105*4882a593Smuzhiyun 		return IRQ_NONE;
106*4882a593Smuzhiyun 	}
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun 	/*
109*4882a593Smuzhiyun 	 * We get a pen down reading on every reading, report pen up if any
110*4882a593Smuzhiyun 	 * individual reading does so.
111*4882a593Smuzhiyun 	 */
112*4882a593Smuzhiyun 	wm831x_ts->pen_down = true;
113*4882a593Smuzhiyun 	for (i = 0; i < count; i++) {
114*4882a593Smuzhiyun 		if (!(data[i] & WM831X_TCH_PD)) {
115*4882a593Smuzhiyun 			wm831x_ts->pen_down = false;
116*4882a593Smuzhiyun 			continue;
117*4882a593Smuzhiyun 		}
118*4882a593Smuzhiyun 		input_report_abs(wm831x_ts->input_dev, data_types[i],
119*4882a593Smuzhiyun 				 data[i] & WM831X_TCH_DATA_MASK);
120*4882a593Smuzhiyun 	}
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 	if (!wm831x_ts->pen_down) {
123*4882a593Smuzhiyun 		/* Switch from data to pen down */
124*4882a593Smuzhiyun 		dev_dbg(wm831x->dev, "IRQ DATA->PD\n");
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun 		disable_irq_nosync(wm831x_ts->data_irq);
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 		/* Don't need data any more */
129*4882a593Smuzhiyun 		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
130*4882a593Smuzhiyun 				WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA |
131*4882a593Smuzhiyun 				WM831X_TCH_Z_ENA, 0);
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun 		/* Flush any final samples that arrived while reading */
134*4882a593Smuzhiyun 		wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
135*4882a593Smuzhiyun 				WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 		wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count, data);
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 		if (wm831x_ts->pressure)
140*4882a593Smuzhiyun 			input_report_abs(wm831x_ts->input_dev,
141*4882a593Smuzhiyun 					 ABS_PRESSURE, 0);
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 		input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 0);
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 		schedule_work(&wm831x_ts->pd_data_work);
146*4882a593Smuzhiyun 	} else {
147*4882a593Smuzhiyun 		input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 1);
148*4882a593Smuzhiyun 	}
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	input_sync(wm831x_ts->input_dev);
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun 	return IRQ_HANDLED;
153*4882a593Smuzhiyun }
154*4882a593Smuzhiyun 
wm831x_ts_pen_down_irq(int irq,void * irq_data)155*4882a593Smuzhiyun static irqreturn_t wm831x_ts_pen_down_irq(int irq, void *irq_data)
156*4882a593Smuzhiyun {
157*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts = irq_data;
158*4882a593Smuzhiyun 	struct wm831x *wm831x = wm831x_ts->wm831x;
159*4882a593Smuzhiyun 	int ena = 0;
160*4882a593Smuzhiyun 
161*4882a593Smuzhiyun 	if (wm831x_ts->pen_down)
162*4882a593Smuzhiyun 		return IRQ_HANDLED;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	disable_irq_nosync(wm831x_ts->pd_irq);
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	/* Start collecting data */
167*4882a593Smuzhiyun 	if (wm831x_ts->pressure)
168*4882a593Smuzhiyun 		ena |= WM831X_TCH_Z_ENA;
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
171*4882a593Smuzhiyun 			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA | WM831X_TCH_Z_ENA,
172*4882a593Smuzhiyun 			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA | ena);
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
175*4882a593Smuzhiyun 			WM831X_TCHPD_EINT, WM831X_TCHPD_EINT);
176*4882a593Smuzhiyun 
177*4882a593Smuzhiyun 	wm831x_ts->pen_down = true;
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	/* Switch from pen down to data */
180*4882a593Smuzhiyun 	dev_dbg(wm831x->dev, "IRQ PD->DATA\n");
181*4882a593Smuzhiyun 	schedule_work(&wm831x_ts->pd_data_work);
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	return IRQ_HANDLED;
184*4882a593Smuzhiyun }
185*4882a593Smuzhiyun 
wm831x_ts_input_open(struct input_dev * idev)186*4882a593Smuzhiyun static int wm831x_ts_input_open(struct input_dev *idev)
187*4882a593Smuzhiyun {
188*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
189*4882a593Smuzhiyun 	struct wm831x *wm831x = wm831x_ts->wm831x;
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
192*4882a593Smuzhiyun 			WM831X_TCH_ENA | WM831X_TCH_CVT_ENA |
193*4882a593Smuzhiyun 			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA |
194*4882a593Smuzhiyun 			WM831X_TCH_Z_ENA, WM831X_TCH_ENA);
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
197*4882a593Smuzhiyun 			WM831X_TCH_CVT_ENA, WM831X_TCH_CVT_ENA);
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	return 0;
200*4882a593Smuzhiyun }
201*4882a593Smuzhiyun 
wm831x_ts_input_close(struct input_dev * idev)202*4882a593Smuzhiyun static void wm831x_ts_input_close(struct input_dev *idev)
203*4882a593Smuzhiyun {
204*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
205*4882a593Smuzhiyun 	struct wm831x *wm831x = wm831x_ts->wm831x;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	/* Shut the controller down, disabling all other functionality too */
208*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
209*4882a593Smuzhiyun 			WM831X_TCH_ENA | WM831X_TCH_X_ENA |
210*4882a593Smuzhiyun 			WM831X_TCH_Y_ENA | WM831X_TCH_Z_ENA, 0);
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	/* Make sure any pending IRQs are done, the above will prevent
213*4882a593Smuzhiyun 	 * new ones firing.
214*4882a593Smuzhiyun 	 */
215*4882a593Smuzhiyun 	synchronize_irq(wm831x_ts->data_irq);
216*4882a593Smuzhiyun 	synchronize_irq(wm831x_ts->pd_irq);
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun 	/* Make sure the IRQ completion work is quiesced */
219*4882a593Smuzhiyun 	flush_work(&wm831x_ts->pd_data_work);
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	/* If we ended up with the pen down then make sure we revert back
222*4882a593Smuzhiyun 	 * to pen detection state for the next time we start up.
223*4882a593Smuzhiyun 	 */
224*4882a593Smuzhiyun 	if (wm831x_ts->pen_down) {
225*4882a593Smuzhiyun 		disable_irq(wm831x_ts->data_irq);
226*4882a593Smuzhiyun 		enable_irq(wm831x_ts->pd_irq);
227*4882a593Smuzhiyun 		wm831x_ts->pen_down = false;
228*4882a593Smuzhiyun 	}
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun 
wm831x_ts_probe(struct platform_device * pdev)231*4882a593Smuzhiyun static int wm831x_ts_probe(struct platform_device *pdev)
232*4882a593Smuzhiyun {
233*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts;
234*4882a593Smuzhiyun 	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
235*4882a593Smuzhiyun 	struct wm831x_pdata *core_pdata = dev_get_platdata(pdev->dev.parent);
236*4882a593Smuzhiyun 	struct wm831x_touch_pdata *pdata = NULL;
237*4882a593Smuzhiyun 	struct input_dev *input_dev;
238*4882a593Smuzhiyun 	int error, irqf;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	if (core_pdata)
241*4882a593Smuzhiyun 		pdata = core_pdata->touch;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	wm831x_ts = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ts),
244*4882a593Smuzhiyun 				 GFP_KERNEL);
245*4882a593Smuzhiyun 	input_dev = devm_input_allocate_device(&pdev->dev);
246*4882a593Smuzhiyun 	if (!wm831x_ts || !input_dev) {
247*4882a593Smuzhiyun 		error = -ENOMEM;
248*4882a593Smuzhiyun 		goto err_alloc;
249*4882a593Smuzhiyun 	}
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	wm831x_ts->wm831x = wm831x;
252*4882a593Smuzhiyun 	wm831x_ts->input_dev = input_dev;
253*4882a593Smuzhiyun 	INIT_WORK(&wm831x_ts->pd_data_work, wm831x_pd_data_work);
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	/*
256*4882a593Smuzhiyun 	 * If we have a direct IRQ use it, otherwise use the interrupt
257*4882a593Smuzhiyun 	 * from the WM831x IRQ controller.
258*4882a593Smuzhiyun 	 */
259*4882a593Smuzhiyun 	wm831x_ts->data_irq = wm831x_irq(wm831x,
260*4882a593Smuzhiyun 					 platform_get_irq_byname(pdev,
261*4882a593Smuzhiyun 								 "TCHDATA"));
262*4882a593Smuzhiyun 	if (pdata && pdata->data_irq)
263*4882a593Smuzhiyun 		wm831x_ts->data_irq = pdata->data_irq;
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	wm831x_ts->pd_irq = wm831x_irq(wm831x,
266*4882a593Smuzhiyun 				       platform_get_irq_byname(pdev, "TCHPD"));
267*4882a593Smuzhiyun 	if (pdata && pdata->pd_irq)
268*4882a593Smuzhiyun 		wm831x_ts->pd_irq = pdata->pd_irq;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	if (pdata)
271*4882a593Smuzhiyun 		wm831x_ts->pressure = pdata->pressure;
272*4882a593Smuzhiyun 	else
273*4882a593Smuzhiyun 		wm831x_ts->pressure = true;
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 	/* Five wire touchscreens can't report pressure */
276*4882a593Smuzhiyun 	if (pdata && pdata->fivewire) {
277*4882a593Smuzhiyun 		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
278*4882a593Smuzhiyun 				WM831X_TCH_5WIRE, WM831X_TCH_5WIRE);
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 		/* Pressure measurements are not possible for five wire mode */
281*4882a593Smuzhiyun 		WARN_ON(pdata->pressure && pdata->fivewire);
282*4882a593Smuzhiyun 		wm831x_ts->pressure = false;
283*4882a593Smuzhiyun 	} else {
284*4882a593Smuzhiyun 		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
285*4882a593Smuzhiyun 				WM831X_TCH_5WIRE, 0);
286*4882a593Smuzhiyun 	}
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	if (pdata) {
289*4882a593Smuzhiyun 		switch (pdata->isel) {
290*4882a593Smuzhiyun 		default:
291*4882a593Smuzhiyun 			dev_err(&pdev->dev, "Unsupported ISEL setting: %d\n",
292*4882a593Smuzhiyun 				pdata->isel);
293*4882a593Smuzhiyun 			fallthrough;
294*4882a593Smuzhiyun 		case 200:
295*4882a593Smuzhiyun 		case 0:
296*4882a593Smuzhiyun 			wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
297*4882a593Smuzhiyun 					WM831X_TCH_ISEL, 0);
298*4882a593Smuzhiyun 			break;
299*4882a593Smuzhiyun 		case 400:
300*4882a593Smuzhiyun 			wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
301*4882a593Smuzhiyun 					WM831X_TCH_ISEL, WM831X_TCH_ISEL);
302*4882a593Smuzhiyun 			break;
303*4882a593Smuzhiyun 		}
304*4882a593Smuzhiyun 	}
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
307*4882a593Smuzhiyun 			WM831X_TCH_PDONLY, 0);
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	/* Default to 96 samples/sec */
310*4882a593Smuzhiyun 	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
311*4882a593Smuzhiyun 			WM831X_TCH_RATE_MASK, 6);
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	if (pdata && pdata->data_irqf)
314*4882a593Smuzhiyun 		irqf = pdata->data_irqf;
315*4882a593Smuzhiyun 	else
316*4882a593Smuzhiyun 		irqf = IRQF_TRIGGER_HIGH;
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	error = request_threaded_irq(wm831x_ts->data_irq,
319*4882a593Smuzhiyun 				     NULL, wm831x_ts_data_irq,
320*4882a593Smuzhiyun 				     irqf | IRQF_ONESHOT,
321*4882a593Smuzhiyun 				     "Touchscreen data", wm831x_ts);
322*4882a593Smuzhiyun 	if (error) {
323*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Failed to request data IRQ %d: %d\n",
324*4882a593Smuzhiyun 			wm831x_ts->data_irq, error);
325*4882a593Smuzhiyun 		goto err_alloc;
326*4882a593Smuzhiyun 	}
327*4882a593Smuzhiyun 	disable_irq(wm831x_ts->data_irq);
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 	if (pdata && pdata->pd_irqf)
330*4882a593Smuzhiyun 		irqf = pdata->pd_irqf;
331*4882a593Smuzhiyun 	else
332*4882a593Smuzhiyun 		irqf = IRQF_TRIGGER_HIGH;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	error = request_threaded_irq(wm831x_ts->pd_irq,
335*4882a593Smuzhiyun 				     NULL, wm831x_ts_pen_down_irq,
336*4882a593Smuzhiyun 				     irqf | IRQF_ONESHOT,
337*4882a593Smuzhiyun 				     "Touchscreen pen down", wm831x_ts);
338*4882a593Smuzhiyun 	if (error) {
339*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Failed to request pen down IRQ %d: %d\n",
340*4882a593Smuzhiyun 			wm831x_ts->pd_irq, error);
341*4882a593Smuzhiyun 		goto err_data_irq;
342*4882a593Smuzhiyun 	}
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	/* set up touch configuration */
345*4882a593Smuzhiyun 	input_dev->name = "WM831x touchscreen";
346*4882a593Smuzhiyun 	input_dev->phys = "wm831x";
347*4882a593Smuzhiyun 	input_dev->open = wm831x_ts_input_open;
348*4882a593Smuzhiyun 	input_dev->close = wm831x_ts_input_close;
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	__set_bit(EV_ABS, input_dev->evbit);
351*4882a593Smuzhiyun 	__set_bit(EV_KEY, input_dev->evbit);
352*4882a593Smuzhiyun 	__set_bit(BTN_TOUCH, input_dev->keybit);
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	input_set_abs_params(input_dev, ABS_X, 0, 4095, 5, 0);
355*4882a593Smuzhiyun 	input_set_abs_params(input_dev, ABS_Y, 0, 4095, 5, 0);
356*4882a593Smuzhiyun 	if (wm831x_ts->pressure)
357*4882a593Smuzhiyun 		input_set_abs_params(input_dev, ABS_PRESSURE, 0, 4095, 5, 0);
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	input_set_drvdata(input_dev, wm831x_ts);
360*4882a593Smuzhiyun 	input_dev->dev.parent = &pdev->dev;
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	error = input_register_device(input_dev);
363*4882a593Smuzhiyun 	if (error)
364*4882a593Smuzhiyun 		goto err_pd_irq;
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	platform_set_drvdata(pdev, wm831x_ts);
367*4882a593Smuzhiyun 	return 0;
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun err_pd_irq:
370*4882a593Smuzhiyun 	free_irq(wm831x_ts->pd_irq, wm831x_ts);
371*4882a593Smuzhiyun err_data_irq:
372*4882a593Smuzhiyun 	free_irq(wm831x_ts->data_irq, wm831x_ts);
373*4882a593Smuzhiyun err_alloc:
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	return error;
376*4882a593Smuzhiyun }
377*4882a593Smuzhiyun 
wm831x_ts_remove(struct platform_device * pdev)378*4882a593Smuzhiyun static int wm831x_ts_remove(struct platform_device *pdev)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun 	struct wm831x_ts *wm831x_ts = platform_get_drvdata(pdev);
381*4882a593Smuzhiyun 
382*4882a593Smuzhiyun 	free_irq(wm831x_ts->pd_irq, wm831x_ts);
383*4882a593Smuzhiyun 	free_irq(wm831x_ts->data_irq, wm831x_ts);
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	return 0;
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun static struct platform_driver wm831x_ts_driver = {
389*4882a593Smuzhiyun 	.driver = {
390*4882a593Smuzhiyun 		.name = "wm831x-touch",
391*4882a593Smuzhiyun 	},
392*4882a593Smuzhiyun 	.probe = wm831x_ts_probe,
393*4882a593Smuzhiyun 	.remove = wm831x_ts_remove,
394*4882a593Smuzhiyun };
395*4882a593Smuzhiyun module_platform_driver(wm831x_ts_driver);
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun /* Module information */
398*4882a593Smuzhiyun MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
399*4882a593Smuzhiyun MODULE_DESCRIPTION("WM831x PMIC touchscreen driver");
400*4882a593Smuzhiyun MODULE_LICENSE("GPL");
401*4882a593Smuzhiyun MODULE_ALIAS("platform:wm831x-touch");
402