12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
22bd942f9SViresh Kumar /*
32bd942f9SViresh Kumar * STMicroelectronics STMPE811 Touchscreen Driver
4f94add3bSLuotao Fu *
5f94add3bSLuotao Fu * (C) 2010 Luotao Fu <l.fu@pengutronix.de>
6f94add3bSLuotao Fu * All rights reserved.
7f94add3bSLuotao Fu */
8f94add3bSLuotao Fu
9f94add3bSLuotao Fu #include <linux/kernel.h>
10f94add3bSLuotao Fu #include <linux/module.h>
11f94add3bSLuotao Fu #include <linux/sched.h>
12f94add3bSLuotao Fu #include <linux/interrupt.h>
13f94add3bSLuotao Fu #include <linux/device.h>
14037db524SVipul Kumar Samar #include <linux/of.h>
15f94add3bSLuotao Fu #include <linux/platform_device.h>
16f94add3bSLuotao Fu #include <linux/input.h>
17888e5fadSStefan Riedmueller #include <linux/input/touchscreen.h>
18f94add3bSLuotao Fu #include <linux/slab.h>
19f94add3bSLuotao Fu #include <linux/delay.h>
20f94add3bSLuotao Fu #include <linux/i2c.h>
21f94add3bSLuotao Fu #include <linux/workqueue.h>
22f94add3bSLuotao Fu
23f94add3bSLuotao Fu #include <linux/mfd/stmpe.h>
24f94add3bSLuotao Fu
25f94add3bSLuotao Fu /* Register layouts and functionalities are identical on all stmpexxx variants
26f94add3bSLuotao Fu * with touchscreen controller
27f94add3bSLuotao Fu */
28f94add3bSLuotao Fu #define STMPE_REG_INT_STA 0x0B
29f94add3bSLuotao Fu #define STMPE_REG_TSC_CTRL 0x40
30f94add3bSLuotao Fu #define STMPE_REG_TSC_CFG 0x41
31f94add3bSLuotao Fu #define STMPE_REG_FIFO_TH 0x4A
32f94add3bSLuotao Fu #define STMPE_REG_FIFO_STA 0x4B
33f94add3bSLuotao Fu #define STMPE_REG_FIFO_SIZE 0x4C
34f94add3bSLuotao Fu #define STMPE_REG_TSC_DATA_XYZ 0x52
35f94add3bSLuotao Fu #define STMPE_REG_TSC_FRACTION_Z 0x56
36f94add3bSLuotao Fu #define STMPE_REG_TSC_I_DRIVE 0x58
37f94add3bSLuotao Fu
38f94add3bSLuotao Fu #define OP_MOD_XYZ 0
39f94add3bSLuotao Fu
40f94add3bSLuotao Fu #define STMPE_TSC_CTRL_TSC_EN (1<<0)
41f94add3bSLuotao Fu
42f94add3bSLuotao Fu #define STMPE_FIFO_STA_RESET (1<<0)
43f94add3bSLuotao Fu
44f94add3bSLuotao Fu #define STMPE_IRQ_TOUCH_DET 0
45f94add3bSLuotao Fu
46f94add3bSLuotao Fu #define STMPE_TS_NAME "stmpe-ts"
47f94add3bSLuotao Fu #define XY_MASK 0xfff
48f94add3bSLuotao Fu
49564a68deSLinus Walleij /**
50564a68deSLinus Walleij * struct stmpe_touch - stmpe811 touch screen controller state
51564a68deSLinus Walleij * @stmpe: pointer back to STMPE MFD container
52564a68deSLinus Walleij * @idev: registered input device
53564a68deSLinus Walleij * @work: a work item used to scan the device
54564a68deSLinus Walleij * @dev: a pointer back to the MFD cell struct device*
55*05b67b7aSLee Jones * @prop: Touchscreen properties
56564a68deSLinus Walleij * @ave_ctrl: Sample average control
57564a68deSLinus Walleij * (0 -> 1 sample, 1 -> 2 samples, 2 -> 4 samples, 3 -> 8 samples)
58564a68deSLinus Walleij * @touch_det_delay: Touch detect interrupt delay
59564a68deSLinus Walleij * (0 -> 10 us, 1 -> 50 us, 2 -> 100 us, 3 -> 500 us,
60564a68deSLinus Walleij * 4-> 1 ms, 5 -> 5 ms, 6 -> 10 ms, 7 -> 50 ms)
61564a68deSLinus Walleij * recommended is 3
62564a68deSLinus Walleij * @settling: Panel driver settling time
63564a68deSLinus Walleij * (0 -> 10 us, 1 -> 100 us, 2 -> 500 us, 3 -> 1 ms,
64564a68deSLinus Walleij * 4 -> 5 ms, 5 -> 10 ms, 6 for 50 ms, 7 -> 100 ms)
65564a68deSLinus Walleij * recommended is 2
66564a68deSLinus Walleij * @fraction_z: Length of the fractional part in z
67564a68deSLinus Walleij * (fraction_z ([0..7]) = Count of the fractional part)
68564a68deSLinus Walleij * recommended is 7
69564a68deSLinus Walleij * @i_drive: current limit value of the touchscreen drivers
70564a68deSLinus Walleij * (0 -> 20 mA typical 35 mA max, 1 -> 50 mA typical 80 mA max)
71564a68deSLinus Walleij */
72f94add3bSLuotao Fu struct stmpe_touch {
73f94add3bSLuotao Fu struct stmpe *stmpe;
74f94add3bSLuotao Fu struct input_dev *idev;
75f94add3bSLuotao Fu struct delayed_work work;
76f94add3bSLuotao Fu struct device *dev;
77888e5fadSStefan Riedmueller struct touchscreen_properties prop;
78f94add3bSLuotao Fu u8 ave_ctrl;
79f94add3bSLuotao Fu u8 touch_det_delay;
80f94add3bSLuotao Fu u8 settling;
81f94add3bSLuotao Fu u8 fraction_z;
82f94add3bSLuotao Fu u8 i_drive;
83f94add3bSLuotao Fu };
84f94add3bSLuotao Fu
__stmpe_reset_fifo(struct stmpe * stmpe)85f94add3bSLuotao Fu static int __stmpe_reset_fifo(struct stmpe *stmpe)
86f94add3bSLuotao Fu {
87f94add3bSLuotao Fu int ret;
88f94add3bSLuotao Fu
89f94add3bSLuotao Fu ret = stmpe_set_bits(stmpe, STMPE_REG_FIFO_STA,
90f94add3bSLuotao Fu STMPE_FIFO_STA_RESET, STMPE_FIFO_STA_RESET);
91f94add3bSLuotao Fu if (ret)
92f94add3bSLuotao Fu return ret;
93f94add3bSLuotao Fu
94f94add3bSLuotao Fu return stmpe_set_bits(stmpe, STMPE_REG_FIFO_STA,
95f94add3bSLuotao Fu STMPE_FIFO_STA_RESET, 0);
96f94add3bSLuotao Fu }
97f94add3bSLuotao Fu
stmpe_work(struct work_struct * work)98f94add3bSLuotao Fu static void stmpe_work(struct work_struct *work)
99f94add3bSLuotao Fu {
100f94add3bSLuotao Fu int int_sta;
101f94add3bSLuotao Fu u32 timeout = 40;
102f94add3bSLuotao Fu
103f94add3bSLuotao Fu struct stmpe_touch *ts =
104f94add3bSLuotao Fu container_of(work, struct stmpe_touch, work.work);
105f94add3bSLuotao Fu
106f94add3bSLuotao Fu int_sta = stmpe_reg_read(ts->stmpe, STMPE_REG_INT_STA);
107f94add3bSLuotao Fu
108f94add3bSLuotao Fu /*
109f94add3bSLuotao Fu * touch_det sometimes get desasserted or just get stuck. This appears
110f94add3bSLuotao Fu * to be a silicon bug, We still have to clearify this with the
111f94add3bSLuotao Fu * manufacture. As a workaround We release the key anyway if the
112f94add3bSLuotao Fu * touch_det keeps coming in after 4ms, while the FIFO contains no value
113f94add3bSLuotao Fu * during the whole time.
114f94add3bSLuotao Fu */
115f94add3bSLuotao Fu while ((int_sta & (1 << STMPE_IRQ_TOUCH_DET)) && (timeout > 0)) {
116f94add3bSLuotao Fu timeout--;
117f94add3bSLuotao Fu int_sta = stmpe_reg_read(ts->stmpe, STMPE_REG_INT_STA);
118f94add3bSLuotao Fu udelay(100);
119f94add3bSLuotao Fu }
120f94add3bSLuotao Fu
121f94add3bSLuotao Fu /* reset the FIFO before we report release event */
122f94add3bSLuotao Fu __stmpe_reset_fifo(ts->stmpe);
123f94add3bSLuotao Fu
124f94add3bSLuotao Fu input_report_abs(ts->idev, ABS_PRESSURE, 0);
1257488b1b9SVipul Kumar Samar input_report_key(ts->idev, BTN_TOUCH, 0);
126f94add3bSLuotao Fu input_sync(ts->idev);
127f94add3bSLuotao Fu }
128f94add3bSLuotao Fu
stmpe_ts_handler(int irq,void * data)129f94add3bSLuotao Fu static irqreturn_t stmpe_ts_handler(int irq, void *data)
130f94add3bSLuotao Fu {
131f94add3bSLuotao Fu u8 data_set[4];
132f94add3bSLuotao Fu int x, y, z;
133f94add3bSLuotao Fu struct stmpe_touch *ts = data;
134f94add3bSLuotao Fu
135f94add3bSLuotao Fu /*
136f94add3bSLuotao Fu * Cancel scheduled polling for release if we have new value
137f94add3bSLuotao Fu * available. Wait if the polling is already running.
138f94add3bSLuotao Fu */
139f94add3bSLuotao Fu cancel_delayed_work_sync(&ts->work);
140f94add3bSLuotao Fu
141f94add3bSLuotao Fu /*
142f94add3bSLuotao Fu * The FIFO sometimes just crashes and stops generating interrupts. This
143f94add3bSLuotao Fu * appears to be a silicon bug. We still have to clearify this with
144f94add3bSLuotao Fu * the manufacture. As a workaround we disable the TSC while we are
145f94add3bSLuotao Fu * collecting data and flush the FIFO after reading
146f94add3bSLuotao Fu */
147f94add3bSLuotao Fu stmpe_set_bits(ts->stmpe, STMPE_REG_TSC_CTRL,
148f94add3bSLuotao Fu STMPE_TSC_CTRL_TSC_EN, 0);
149f94add3bSLuotao Fu
150f94add3bSLuotao Fu stmpe_block_read(ts->stmpe, STMPE_REG_TSC_DATA_XYZ, 4, data_set);
151f94add3bSLuotao Fu
152f94add3bSLuotao Fu x = (data_set[0] << 4) | (data_set[1] >> 4);
153f94add3bSLuotao Fu y = ((data_set[1] & 0xf) << 8) | data_set[2];
154f94add3bSLuotao Fu z = data_set[3];
155f94add3bSLuotao Fu
156888e5fadSStefan Riedmueller touchscreen_report_pos(ts->idev, &ts->prop, x, y, false);
157f94add3bSLuotao Fu input_report_abs(ts->idev, ABS_PRESSURE, z);
1587488b1b9SVipul Kumar Samar input_report_key(ts->idev, BTN_TOUCH, 1);
159f94add3bSLuotao Fu input_sync(ts->idev);
160f94add3bSLuotao Fu
161f94add3bSLuotao Fu /* flush the FIFO after we have read out our values. */
162f94add3bSLuotao Fu __stmpe_reset_fifo(ts->stmpe);
163f94add3bSLuotao Fu
164f94add3bSLuotao Fu /* reenable the tsc */
165f94add3bSLuotao Fu stmpe_set_bits(ts->stmpe, STMPE_REG_TSC_CTRL,
166f94add3bSLuotao Fu STMPE_TSC_CTRL_TSC_EN, STMPE_TSC_CTRL_TSC_EN);
167f94add3bSLuotao Fu
168f94add3bSLuotao Fu /* start polling for touch_det to detect release */
1699ceeb59cSMarek Vasut schedule_delayed_work(&ts->work, msecs_to_jiffies(50));
170f94add3bSLuotao Fu
171f94add3bSLuotao Fu return IRQ_HANDLED;
172f94add3bSLuotao Fu }
173f94add3bSLuotao Fu
stmpe_init_hw(struct stmpe_touch * ts)1745298cc4cSBill Pemberton static int stmpe_init_hw(struct stmpe_touch *ts)
175f94add3bSLuotao Fu {
176f94add3bSLuotao Fu int ret;
17788f29d0fSPhilippe Schenker u8 tsc_cfg, tsc_cfg_mask;
178f94add3bSLuotao Fu struct stmpe *stmpe = ts->stmpe;
179f94add3bSLuotao Fu struct device *dev = ts->dev;
180f94add3bSLuotao Fu
181f94add3bSLuotao Fu ret = stmpe_enable(stmpe, STMPE_BLOCK_TOUCHSCREEN | STMPE_BLOCK_ADC);
182f94add3bSLuotao Fu if (ret) {
183f94add3bSLuotao Fu dev_err(dev, "Could not enable clock for ADC and TS\n");
184f94add3bSLuotao Fu return ret;
185f94add3bSLuotao Fu }
186f94add3bSLuotao Fu
18788f29d0fSPhilippe Schenker ret = stmpe811_adc_common_init(stmpe);
188f94add3bSLuotao Fu if (ret) {
18988f29d0fSPhilippe Schenker stmpe_disable(stmpe, STMPE_BLOCK_TOUCHSCREEN | STMPE_BLOCK_ADC);
190f94add3bSLuotao Fu return ret;
191f94add3bSLuotao Fu }
192f94add3bSLuotao Fu
193063755abSPhilippe Schenker tsc_cfg = STMPE_AVE_CTRL(ts->ave_ctrl) |
194063755abSPhilippe Schenker STMPE_DET_DELAY(ts->touch_det_delay) |
195063755abSPhilippe Schenker STMPE_SETTLING(ts->settling);
196063755abSPhilippe Schenker tsc_cfg_mask = STMPE_AVE_CTRL(0xff) | STMPE_DET_DELAY(0xff) |
197063755abSPhilippe Schenker STMPE_SETTLING(0xff);
198f94add3bSLuotao Fu
199f94add3bSLuotao Fu ret = stmpe_set_bits(stmpe, STMPE_REG_TSC_CFG, tsc_cfg_mask, tsc_cfg);
200f94add3bSLuotao Fu if (ret) {
201f94add3bSLuotao Fu dev_err(dev, "Could not config touch\n");
202f94add3bSLuotao Fu return ret;
203f94add3bSLuotao Fu }
204f94add3bSLuotao Fu
205f94add3bSLuotao Fu ret = stmpe_set_bits(stmpe, STMPE_REG_TSC_FRACTION_Z,
206063755abSPhilippe Schenker STMPE_FRACTION_Z(0xff), STMPE_FRACTION_Z(ts->fraction_z));
207f94add3bSLuotao Fu if (ret) {
208f94add3bSLuotao Fu dev_err(dev, "Could not config touch\n");
209f94add3bSLuotao Fu return ret;
210f94add3bSLuotao Fu }
211f94add3bSLuotao Fu
212f94add3bSLuotao Fu ret = stmpe_set_bits(stmpe, STMPE_REG_TSC_I_DRIVE,
213063755abSPhilippe Schenker STMPE_I_DRIVE(0xff), STMPE_I_DRIVE(ts->i_drive));
214f94add3bSLuotao Fu if (ret) {
215f94add3bSLuotao Fu dev_err(dev, "Could not config touch\n");
216f94add3bSLuotao Fu return ret;
217f94add3bSLuotao Fu }
218f94add3bSLuotao Fu
219f94add3bSLuotao Fu /* set FIFO to 1 for single point reading */
220f94add3bSLuotao Fu ret = stmpe_reg_write(stmpe, STMPE_REG_FIFO_TH, 1);
221f94add3bSLuotao Fu if (ret) {
222f94add3bSLuotao Fu dev_err(dev, "Could not set FIFO\n");
223f94add3bSLuotao Fu return ret;
224f94add3bSLuotao Fu }
225f94add3bSLuotao Fu
226f94add3bSLuotao Fu ret = stmpe_set_bits(stmpe, STMPE_REG_TSC_CTRL,
227063755abSPhilippe Schenker STMPE_OP_MODE(0xff), STMPE_OP_MODE(OP_MOD_XYZ));
228f94add3bSLuotao Fu if (ret) {
229f94add3bSLuotao Fu dev_err(dev, "Could not set mode\n");
230f94add3bSLuotao Fu return ret;
231f94add3bSLuotao Fu }
232f94add3bSLuotao Fu
233f94add3bSLuotao Fu return 0;
234f94add3bSLuotao Fu }
235f94add3bSLuotao Fu
stmpe_ts_open(struct input_dev * dev)236f94add3bSLuotao Fu static int stmpe_ts_open(struct input_dev *dev)
237f94add3bSLuotao Fu {
238f94add3bSLuotao Fu struct stmpe_touch *ts = input_get_drvdata(dev);
239f94add3bSLuotao Fu int ret = 0;
240f94add3bSLuotao Fu
241f94add3bSLuotao Fu ret = __stmpe_reset_fifo(ts->stmpe);
242f94add3bSLuotao Fu if (ret)
243f94add3bSLuotao Fu return ret;
244f94add3bSLuotao Fu
245f94add3bSLuotao Fu return stmpe_set_bits(ts->stmpe, STMPE_REG_TSC_CTRL,
246f94add3bSLuotao Fu STMPE_TSC_CTRL_TSC_EN, STMPE_TSC_CTRL_TSC_EN);
247f94add3bSLuotao Fu }
248f94add3bSLuotao Fu
stmpe_ts_close(struct input_dev * dev)249f94add3bSLuotao Fu static void stmpe_ts_close(struct input_dev *dev)
250f94add3bSLuotao Fu {
251f94add3bSLuotao Fu struct stmpe_touch *ts = input_get_drvdata(dev);
252f94add3bSLuotao Fu
253f94add3bSLuotao Fu cancel_delayed_work_sync(&ts->work);
254f94add3bSLuotao Fu
255f94add3bSLuotao Fu stmpe_set_bits(ts->stmpe, STMPE_REG_TSC_CTRL,
256f94add3bSLuotao Fu STMPE_TSC_CTRL_TSC_EN, 0);
257f94add3bSLuotao Fu }
258f94add3bSLuotao Fu
stmpe_ts_get_platform_info(struct platform_device * pdev,struct stmpe_touch * ts)259037db524SVipul Kumar Samar static void stmpe_ts_get_platform_info(struct platform_device *pdev,
260037db524SVipul Kumar Samar struct stmpe_touch *ts)
261f94add3bSLuotao Fu {
262037db524SVipul Kumar Samar struct device_node *np = pdev->dev.of_node;
263037db524SVipul Kumar Samar u32 val;
264037db524SVipul Kumar Samar
265e4b88e19SDmitry Torokhov if (np) {
266037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,sample-time", &val))
26788f29d0fSPhilippe Schenker ts->stmpe->sample_time = val;
268037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,mod-12b", &val))
26988f29d0fSPhilippe Schenker ts->stmpe->mod_12b = val;
270037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,ref-sel", &val))
27188f29d0fSPhilippe Schenker ts->stmpe->ref_sel = val;
272037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,adc-freq", &val))
27388f29d0fSPhilippe Schenker ts->stmpe->adc_freq = val;
274037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,ave-ctrl", &val))
275037db524SVipul Kumar Samar ts->ave_ctrl = val;
276037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,touch-det-delay", &val))
277037db524SVipul Kumar Samar ts->touch_det_delay = val;
278037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,settling", &val))
279037db524SVipul Kumar Samar ts->settling = val;
280037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,fraction-z", &val))
281037db524SVipul Kumar Samar ts->fraction_z = val;
282037db524SVipul Kumar Samar if (!of_property_read_u32(np, "st,i-drive", &val))
283037db524SVipul Kumar Samar ts->i_drive = val;
284037db524SVipul Kumar Samar }
285037db524SVipul Kumar Samar }
286037db524SVipul Kumar Samar
stmpe_input_probe(struct platform_device * pdev)2875298cc4cSBill Pemberton static int stmpe_input_probe(struct platform_device *pdev)
288037db524SVipul Kumar Samar {
289e4b88e19SDmitry Torokhov struct stmpe *stmpe = dev_get_drvdata(pdev->dev.parent);
290f94add3bSLuotao Fu struct stmpe_touch *ts;
291f94add3bSLuotao Fu struct input_dev *idev;
2922bd942f9SViresh Kumar int error;
2933faeb35cSKulikov Vasiliy int ts_irq;
294f94add3bSLuotao Fu
295f94add3bSLuotao Fu ts_irq = platform_get_irq_byname(pdev, "FIFO_TH");
296f94add3bSLuotao Fu if (ts_irq < 0)
297f94add3bSLuotao Fu return ts_irq;
298f94add3bSLuotao Fu
2992bd942f9SViresh Kumar ts = devm_kzalloc(&pdev->dev, sizeof(*ts), GFP_KERNEL);
3002bd942f9SViresh Kumar if (!ts)
3012bd942f9SViresh Kumar return -ENOMEM;
302f94add3bSLuotao Fu
3032bd942f9SViresh Kumar idev = devm_input_allocate_device(&pdev->dev);
3042bd942f9SViresh Kumar if (!idev)
3052bd942f9SViresh Kumar return -ENOMEM;
306f94add3bSLuotao Fu
307f94add3bSLuotao Fu platform_set_drvdata(pdev, ts);
308e4b88e19SDmitry Torokhov ts->stmpe = stmpe;
309f94add3bSLuotao Fu ts->idev = idev;
310f94add3bSLuotao Fu ts->dev = &pdev->dev;
311f94add3bSLuotao Fu
312037db524SVipul Kumar Samar stmpe_ts_get_platform_info(pdev, ts);
313f94add3bSLuotao Fu
314f94add3bSLuotao Fu INIT_DELAYED_WORK(&ts->work, stmpe_work);
315f94add3bSLuotao Fu
3162bd942f9SViresh Kumar error = devm_request_threaded_irq(&pdev->dev, ts_irq,
3172bd942f9SViresh Kumar NULL, stmpe_ts_handler,
318f94add3bSLuotao Fu IRQF_ONESHOT, STMPE_TS_NAME, ts);
3192bd942f9SViresh Kumar if (error) {
320f94add3bSLuotao Fu dev_err(&pdev->dev, "Failed to request IRQ %d\n", ts_irq);
3212bd942f9SViresh Kumar return error;
322f94add3bSLuotao Fu }
323f94add3bSLuotao Fu
3242bd942f9SViresh Kumar error = stmpe_init_hw(ts);
3252bd942f9SViresh Kumar if (error)
3262bd942f9SViresh Kumar return error;
327f94add3bSLuotao Fu
328f94add3bSLuotao Fu idev->name = STMPE_TS_NAME;
329b8d52e2bSVipul Kumar Samar idev->phys = STMPE_TS_NAME"/input0";
330f94add3bSLuotao Fu idev->id.bustype = BUS_I2C;
331f94add3bSLuotao Fu
332f94add3bSLuotao Fu idev->open = stmpe_ts_open;
333f94add3bSLuotao Fu idev->close = stmpe_ts_close;
334f94add3bSLuotao Fu
335f94add3bSLuotao Fu input_set_drvdata(idev, ts);
336f94add3bSLuotao Fu
337e4b88e19SDmitry Torokhov input_set_capability(idev, EV_KEY, BTN_TOUCH);
338f94add3bSLuotao Fu input_set_abs_params(idev, ABS_X, 0, XY_MASK, 0, 0);
339f94add3bSLuotao Fu input_set_abs_params(idev, ABS_Y, 0, XY_MASK, 0, 0);
340f94add3bSLuotao Fu input_set_abs_params(idev, ABS_PRESSURE, 0x0, 0xff, 0, 0);
341f94add3bSLuotao Fu
342888e5fadSStefan Riedmueller touchscreen_parse_properties(idev, false, &ts->prop);
343888e5fadSStefan Riedmueller
3442bd942f9SViresh Kumar error = input_register_device(idev);
3452bd942f9SViresh Kumar if (error) {
346f94add3bSLuotao Fu dev_err(&pdev->dev, "Could not register input device\n");
3472bd942f9SViresh Kumar return error;
348f94add3bSLuotao Fu }
349f94add3bSLuotao Fu
3502bd942f9SViresh Kumar return 0;
351f94add3bSLuotao Fu }
352f94add3bSLuotao Fu
stmpe_ts_remove(struct platform_device * pdev)353e2619cf7SBill Pemberton static int stmpe_ts_remove(struct platform_device *pdev)
354f94add3bSLuotao Fu {
355f94add3bSLuotao Fu struct stmpe_touch *ts = platform_get_drvdata(pdev);
356f94add3bSLuotao Fu
357f94add3bSLuotao Fu stmpe_disable(ts->stmpe, STMPE_BLOCK_TOUCHSCREEN);
358f94add3bSLuotao Fu
359f94add3bSLuotao Fu return 0;
360f94add3bSLuotao Fu }
361f94add3bSLuotao Fu
362f94add3bSLuotao Fu static struct platform_driver stmpe_ts_driver = {
363f94add3bSLuotao Fu .driver = {
364f94add3bSLuotao Fu .name = STMPE_TS_NAME,
365f94add3bSLuotao Fu },
366f94add3bSLuotao Fu .probe = stmpe_input_probe,
3671cb0aa88SBill Pemberton .remove = stmpe_ts_remove,
368f94add3bSLuotao Fu };
369cdcc96e2SJJ Ding module_platform_driver(stmpe_ts_driver);
370f91a3f08SDmitry Torokhov
371f91a3f08SDmitry Torokhov static const struct of_device_id stmpe_ts_ids[] = {
372f91a3f08SDmitry Torokhov { .compatible = "st,stmpe-ts", },
373f91a3f08SDmitry Torokhov { },
374f91a3f08SDmitry Torokhov };
375f91a3f08SDmitry Torokhov MODULE_DEVICE_TABLE(of, stmpe_ts_ids);
376f94add3bSLuotao Fu
377f94add3bSLuotao Fu MODULE_AUTHOR("Luotao Fu <l.fu@pengutronix.de>");
378f94add3bSLuotao Fu MODULE_DESCRIPTION("STMPEXXX touchscreen driver");
379f94add3bSLuotao Fu MODULE_LICENSE("GPL");
380