1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Samsung S3C24XX touchscreen driver
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright 2004 Arnaud Patard <arnaud.patard@rtp-net.org>
6*4882a593Smuzhiyun * Copyright 2008 Ben Dooks <ben-linux@fluff.org>
7*4882a593Smuzhiyun * Copyright 2009 Simtec Electronics <linux@simtec.co.uk>
8*4882a593Smuzhiyun *
9*4882a593Smuzhiyun * Additional work by Herbert Pötzl <herbert@13thfloor.at> and
10*4882a593Smuzhiyun * Harald Welte <laforge@openmoko.org>
11*4882a593Smuzhiyun */
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include <linux/errno.h>
14*4882a593Smuzhiyun #include <linux/kernel.h>
15*4882a593Smuzhiyun #include <linux/module.h>
16*4882a593Smuzhiyun #include <linux/input.h>
17*4882a593Smuzhiyun #include <linux/delay.h>
18*4882a593Smuzhiyun #include <linux/interrupt.h>
19*4882a593Smuzhiyun #include <linux/platform_device.h>
20*4882a593Smuzhiyun #include <linux/clk.h>
21*4882a593Smuzhiyun #include <linux/io.h>
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #include <linux/soc/samsung/s3c-adc.h>
24*4882a593Smuzhiyun #include <linux/platform_data/touchscreen-s3c2410.h>
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun #define S3C2410_ADCCON (0x00)
27*4882a593Smuzhiyun #define S3C2410_ADCTSC (0x04)
28*4882a593Smuzhiyun #define S3C2410_ADCDLY (0x08)
29*4882a593Smuzhiyun #define S3C2410_ADCDAT0 (0x0C)
30*4882a593Smuzhiyun #define S3C2410_ADCDAT1 (0x10)
31*4882a593Smuzhiyun #define S3C64XX_ADCUPDN (0x14)
32*4882a593Smuzhiyun #define S3C2443_ADCMUX (0x18)
33*4882a593Smuzhiyun #define S3C64XX_ADCCLRINT (0x18)
34*4882a593Smuzhiyun #define S5P_ADCMUX (0x1C)
35*4882a593Smuzhiyun #define S3C64XX_ADCCLRINTPNDNUP (0x20)
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun /* ADCTSC Register Bits */
38*4882a593Smuzhiyun #define S3C2443_ADCTSC_UD_SEN (1 << 8)
39*4882a593Smuzhiyun #define S3C2410_ADCTSC_YM_SEN (1<<7)
40*4882a593Smuzhiyun #define S3C2410_ADCTSC_YP_SEN (1<<6)
41*4882a593Smuzhiyun #define S3C2410_ADCTSC_XM_SEN (1<<5)
42*4882a593Smuzhiyun #define S3C2410_ADCTSC_XP_SEN (1<<4)
43*4882a593Smuzhiyun #define S3C2410_ADCTSC_PULL_UP_DISABLE (1<<3)
44*4882a593Smuzhiyun #define S3C2410_ADCTSC_AUTO_PST (1<<2)
45*4882a593Smuzhiyun #define S3C2410_ADCTSC_XY_PST(x) (((x)&0x3)<<0)
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun /* ADCDAT0 Bits */
48*4882a593Smuzhiyun #define S3C2410_ADCDAT0_UPDOWN (1<<15)
49*4882a593Smuzhiyun #define S3C2410_ADCDAT0_AUTO_PST (1<<14)
50*4882a593Smuzhiyun #define S3C2410_ADCDAT0_XY_PST (0x3<<12)
51*4882a593Smuzhiyun #define S3C2410_ADCDAT0_XPDATA_MASK (0x03FF)
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun /* ADCDAT1 Bits */
54*4882a593Smuzhiyun #define S3C2410_ADCDAT1_UPDOWN (1<<15)
55*4882a593Smuzhiyun #define S3C2410_ADCDAT1_AUTO_PST (1<<14)
56*4882a593Smuzhiyun #define S3C2410_ADCDAT1_XY_PST (0x3<<12)
57*4882a593Smuzhiyun #define S3C2410_ADCDAT1_YPDATA_MASK (0x03FF)
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun #define TSC_SLEEP (S3C2410_ADCTSC_PULL_UP_DISABLE | S3C2410_ADCTSC_XY_PST(0))
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun #define INT_DOWN (0)
63*4882a593Smuzhiyun #define INT_UP (1 << 8)
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun #define WAIT4INT (S3C2410_ADCTSC_YM_SEN | \
66*4882a593Smuzhiyun S3C2410_ADCTSC_YP_SEN | \
67*4882a593Smuzhiyun S3C2410_ADCTSC_XP_SEN | \
68*4882a593Smuzhiyun S3C2410_ADCTSC_XY_PST(3))
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun #define AUTOPST (S3C2410_ADCTSC_YM_SEN | \
71*4882a593Smuzhiyun S3C2410_ADCTSC_YP_SEN | \
72*4882a593Smuzhiyun S3C2410_ADCTSC_XP_SEN | \
73*4882a593Smuzhiyun S3C2410_ADCTSC_AUTO_PST | \
74*4882a593Smuzhiyun S3C2410_ADCTSC_XY_PST(0))
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun #define FEAT_PEN_IRQ (1 << 0) /* HAS ADCCLRINTPNDNUP */
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun /* Per-touchscreen data. */
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun /**
81*4882a593Smuzhiyun * struct s3c2410ts - driver touchscreen state.
82*4882a593Smuzhiyun * @client: The ADC client we registered with the core driver.
83*4882a593Smuzhiyun * @dev: The device we are bound to.
84*4882a593Smuzhiyun * @input: The input device we registered with the input subsystem.
85*4882a593Smuzhiyun * @clock: The clock for the adc.
86*4882a593Smuzhiyun * @io: Pointer to the IO base.
87*4882a593Smuzhiyun * @xp: The accumulated X position data.
88*4882a593Smuzhiyun * @yp: The accumulated Y position data.
89*4882a593Smuzhiyun * @irq_tc: The interrupt number for pen up/down interrupt
90*4882a593Smuzhiyun * @count: The number of samples collected.
91*4882a593Smuzhiyun * @shift: The log2 of the maximum count to read in one go.
92*4882a593Smuzhiyun * @features: The features supported by the TSADC MOdule.
93*4882a593Smuzhiyun */
94*4882a593Smuzhiyun struct s3c2410ts {
95*4882a593Smuzhiyun struct s3c_adc_client *client;
96*4882a593Smuzhiyun struct device *dev;
97*4882a593Smuzhiyun struct input_dev *input;
98*4882a593Smuzhiyun struct clk *clock;
99*4882a593Smuzhiyun void __iomem *io;
100*4882a593Smuzhiyun unsigned long xp;
101*4882a593Smuzhiyun unsigned long yp;
102*4882a593Smuzhiyun int irq_tc;
103*4882a593Smuzhiyun int count;
104*4882a593Smuzhiyun int shift;
105*4882a593Smuzhiyun int features;
106*4882a593Smuzhiyun };
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun static struct s3c2410ts ts;
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun /**
111*4882a593Smuzhiyun * get_down - return the down state of the pen
112*4882a593Smuzhiyun * @data0: The data read from ADCDAT0 register.
113*4882a593Smuzhiyun * @data1: The data read from ADCDAT1 register.
114*4882a593Smuzhiyun *
115*4882a593Smuzhiyun * Return non-zero if both readings show that the pen is down.
116*4882a593Smuzhiyun */
get_down(unsigned long data0,unsigned long data1)117*4882a593Smuzhiyun static inline bool get_down(unsigned long data0, unsigned long data1)
118*4882a593Smuzhiyun {
119*4882a593Smuzhiyun /* returns true if both data values show stylus down */
120*4882a593Smuzhiyun return (!(data0 & S3C2410_ADCDAT0_UPDOWN) &&
121*4882a593Smuzhiyun !(data1 & S3C2410_ADCDAT0_UPDOWN));
122*4882a593Smuzhiyun }
123*4882a593Smuzhiyun
touch_timer_fire(struct timer_list * unused)124*4882a593Smuzhiyun static void touch_timer_fire(struct timer_list *unused)
125*4882a593Smuzhiyun {
126*4882a593Smuzhiyun unsigned long data0;
127*4882a593Smuzhiyun unsigned long data1;
128*4882a593Smuzhiyun bool down;
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun data0 = readl(ts.io + S3C2410_ADCDAT0);
131*4882a593Smuzhiyun data1 = readl(ts.io + S3C2410_ADCDAT1);
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun down = get_down(data0, data1);
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun if (down) {
136*4882a593Smuzhiyun if (ts.count == (1 << ts.shift)) {
137*4882a593Smuzhiyun ts.xp >>= ts.shift;
138*4882a593Smuzhiyun ts.yp >>= ts.shift;
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun dev_dbg(ts.dev, "%s: X=%lu, Y=%lu, count=%d\n",
141*4882a593Smuzhiyun __func__, ts.xp, ts.yp, ts.count);
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun input_report_abs(ts.input, ABS_X, ts.xp);
144*4882a593Smuzhiyun input_report_abs(ts.input, ABS_Y, ts.yp);
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun input_report_key(ts.input, BTN_TOUCH, 1);
147*4882a593Smuzhiyun input_sync(ts.input);
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun ts.xp = 0;
150*4882a593Smuzhiyun ts.yp = 0;
151*4882a593Smuzhiyun ts.count = 0;
152*4882a593Smuzhiyun }
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun s3c_adc_start(ts.client, 0, 1 << ts.shift);
155*4882a593Smuzhiyun } else {
156*4882a593Smuzhiyun ts.xp = 0;
157*4882a593Smuzhiyun ts.yp = 0;
158*4882a593Smuzhiyun ts.count = 0;
159*4882a593Smuzhiyun
160*4882a593Smuzhiyun input_report_key(ts.input, BTN_TOUCH, 0);
161*4882a593Smuzhiyun input_sync(ts.input);
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun writel(WAIT4INT | INT_DOWN, ts.io + S3C2410_ADCTSC);
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
167*4882a593Smuzhiyun static DEFINE_TIMER(touch_timer, touch_timer_fire);
168*4882a593Smuzhiyun
169*4882a593Smuzhiyun /**
170*4882a593Smuzhiyun * stylus_irq - touchscreen stylus event interrupt
171*4882a593Smuzhiyun * @irq: The interrupt number
172*4882a593Smuzhiyun * @dev_id: The device ID.
173*4882a593Smuzhiyun *
174*4882a593Smuzhiyun * Called when the IRQ_TC is fired for a pen up or down event.
175*4882a593Smuzhiyun */
stylus_irq(int irq,void * dev_id)176*4882a593Smuzhiyun static irqreturn_t stylus_irq(int irq, void *dev_id)
177*4882a593Smuzhiyun {
178*4882a593Smuzhiyun unsigned long data0;
179*4882a593Smuzhiyun unsigned long data1;
180*4882a593Smuzhiyun bool down;
181*4882a593Smuzhiyun
182*4882a593Smuzhiyun data0 = readl(ts.io + S3C2410_ADCDAT0);
183*4882a593Smuzhiyun data1 = readl(ts.io + S3C2410_ADCDAT1);
184*4882a593Smuzhiyun
185*4882a593Smuzhiyun down = get_down(data0, data1);
186*4882a593Smuzhiyun
187*4882a593Smuzhiyun /* TODO we should never get an interrupt with down set while
188*4882a593Smuzhiyun * the timer is running, but maybe we ought to verify that the
189*4882a593Smuzhiyun * timer isn't running anyways. */
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun if (down)
192*4882a593Smuzhiyun s3c_adc_start(ts.client, 0, 1 << ts.shift);
193*4882a593Smuzhiyun else
194*4882a593Smuzhiyun dev_dbg(ts.dev, "%s: count=%d\n", __func__, ts.count);
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun if (ts.features & FEAT_PEN_IRQ) {
197*4882a593Smuzhiyun /* Clear pen down/up interrupt */
198*4882a593Smuzhiyun writel(0x0, ts.io + S3C64XX_ADCCLRINTPNDNUP);
199*4882a593Smuzhiyun }
200*4882a593Smuzhiyun
201*4882a593Smuzhiyun return IRQ_HANDLED;
202*4882a593Smuzhiyun }
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun /**
205*4882a593Smuzhiyun * s3c24xx_ts_conversion - ADC conversion callback
206*4882a593Smuzhiyun * @client: The client that was registered with the ADC core.
207*4882a593Smuzhiyun * @data0: The reading from ADCDAT0.
208*4882a593Smuzhiyun * @data1: The reading from ADCDAT1.
209*4882a593Smuzhiyun * @left: The number of samples left.
210*4882a593Smuzhiyun *
211*4882a593Smuzhiyun * Called when a conversion has finished.
212*4882a593Smuzhiyun */
s3c24xx_ts_conversion(struct s3c_adc_client * client,unsigned data0,unsigned data1,unsigned * left)213*4882a593Smuzhiyun static void s3c24xx_ts_conversion(struct s3c_adc_client *client,
214*4882a593Smuzhiyun unsigned data0, unsigned data1,
215*4882a593Smuzhiyun unsigned *left)
216*4882a593Smuzhiyun {
217*4882a593Smuzhiyun dev_dbg(ts.dev, "%s: %d,%d\n", __func__, data0, data1);
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun ts.xp += data0;
220*4882a593Smuzhiyun ts.yp += data1;
221*4882a593Smuzhiyun
222*4882a593Smuzhiyun ts.count++;
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun /* From tests, it seems that it is unlikely to get a pen-up
225*4882a593Smuzhiyun * event during the conversion process which means we can
226*4882a593Smuzhiyun * ignore any pen-up events with less than the requisite
227*4882a593Smuzhiyun * count done.
228*4882a593Smuzhiyun *
229*4882a593Smuzhiyun * In several thousand conversions, no pen-ups where detected
230*4882a593Smuzhiyun * before count completed.
231*4882a593Smuzhiyun */
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun /**
235*4882a593Smuzhiyun * s3c24xx_ts_select - ADC selection callback.
236*4882a593Smuzhiyun * @client: The client that was registered with the ADC core.
237*4882a593Smuzhiyun * @select: The reason for select.
238*4882a593Smuzhiyun *
239*4882a593Smuzhiyun * Called when the ADC core selects (or deslects) us as a client.
240*4882a593Smuzhiyun */
s3c24xx_ts_select(struct s3c_adc_client * client,unsigned select)241*4882a593Smuzhiyun static void s3c24xx_ts_select(struct s3c_adc_client *client, unsigned select)
242*4882a593Smuzhiyun {
243*4882a593Smuzhiyun if (select) {
244*4882a593Smuzhiyun writel(S3C2410_ADCTSC_PULL_UP_DISABLE | AUTOPST,
245*4882a593Smuzhiyun ts.io + S3C2410_ADCTSC);
246*4882a593Smuzhiyun } else {
247*4882a593Smuzhiyun mod_timer(&touch_timer, jiffies+1);
248*4882a593Smuzhiyun writel(WAIT4INT | INT_UP, ts.io + S3C2410_ADCTSC);
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun }
251*4882a593Smuzhiyun
252*4882a593Smuzhiyun /**
253*4882a593Smuzhiyun * s3c2410ts_probe - device core probe entry point
254*4882a593Smuzhiyun * @pdev: The device we are being bound to.
255*4882a593Smuzhiyun *
256*4882a593Smuzhiyun * Initialise, find and allocate any resources we need to run and then
257*4882a593Smuzhiyun * register with the ADC and input systems.
258*4882a593Smuzhiyun */
s3c2410ts_probe(struct platform_device * pdev)259*4882a593Smuzhiyun static int s3c2410ts_probe(struct platform_device *pdev)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun struct s3c2410_ts_mach_info *info;
262*4882a593Smuzhiyun struct device *dev = &pdev->dev;
263*4882a593Smuzhiyun struct input_dev *input_dev;
264*4882a593Smuzhiyun struct resource *res;
265*4882a593Smuzhiyun int ret = -EINVAL;
266*4882a593Smuzhiyun
267*4882a593Smuzhiyun /* Initialise input stuff */
268*4882a593Smuzhiyun memset(&ts, 0, sizeof(struct s3c2410ts));
269*4882a593Smuzhiyun
270*4882a593Smuzhiyun ts.dev = dev;
271*4882a593Smuzhiyun
272*4882a593Smuzhiyun info = dev_get_platdata(dev);
273*4882a593Smuzhiyun if (!info) {
274*4882a593Smuzhiyun dev_err(dev, "no platform data, cannot attach\n");
275*4882a593Smuzhiyun return -EINVAL;
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun dev_dbg(dev, "initialising touchscreen\n");
279*4882a593Smuzhiyun
280*4882a593Smuzhiyun ts.clock = clk_get(dev, "adc");
281*4882a593Smuzhiyun if (IS_ERR(ts.clock)) {
282*4882a593Smuzhiyun dev_err(dev, "cannot get adc clock source\n");
283*4882a593Smuzhiyun return -ENOENT;
284*4882a593Smuzhiyun }
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun ret = clk_prepare_enable(ts.clock);
287*4882a593Smuzhiyun if (ret) {
288*4882a593Smuzhiyun dev_err(dev, "Failed! to enabled clocks\n");
289*4882a593Smuzhiyun goto err_clk_get;
290*4882a593Smuzhiyun }
291*4882a593Smuzhiyun dev_dbg(dev, "got and enabled clocks\n");
292*4882a593Smuzhiyun
293*4882a593Smuzhiyun ts.irq_tc = ret = platform_get_irq(pdev, 0);
294*4882a593Smuzhiyun if (ret < 0) {
295*4882a593Smuzhiyun dev_err(dev, "no resource for interrupt\n");
296*4882a593Smuzhiyun goto err_clk;
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun
299*4882a593Smuzhiyun res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
300*4882a593Smuzhiyun if (!res) {
301*4882a593Smuzhiyun dev_err(dev, "no resource for registers\n");
302*4882a593Smuzhiyun ret = -ENOENT;
303*4882a593Smuzhiyun goto err_clk;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun ts.io = ioremap(res->start, resource_size(res));
307*4882a593Smuzhiyun if (ts.io == NULL) {
308*4882a593Smuzhiyun dev_err(dev, "cannot map registers\n");
309*4882a593Smuzhiyun ret = -ENOMEM;
310*4882a593Smuzhiyun goto err_clk;
311*4882a593Smuzhiyun }
312*4882a593Smuzhiyun
313*4882a593Smuzhiyun /* inititalise the gpio */
314*4882a593Smuzhiyun if (info->cfg_gpio)
315*4882a593Smuzhiyun info->cfg_gpio(to_platform_device(ts.dev));
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun ts.client = s3c_adc_register(pdev, s3c24xx_ts_select,
318*4882a593Smuzhiyun s3c24xx_ts_conversion, 1);
319*4882a593Smuzhiyun if (IS_ERR(ts.client)) {
320*4882a593Smuzhiyun dev_err(dev, "failed to register adc client\n");
321*4882a593Smuzhiyun ret = PTR_ERR(ts.client);
322*4882a593Smuzhiyun goto err_iomap;
323*4882a593Smuzhiyun }
324*4882a593Smuzhiyun
325*4882a593Smuzhiyun /* Initialise registers */
326*4882a593Smuzhiyun if ((info->delay & 0xffff) > 0)
327*4882a593Smuzhiyun writel(info->delay & 0xffff, ts.io + S3C2410_ADCDLY);
328*4882a593Smuzhiyun
329*4882a593Smuzhiyun writel(WAIT4INT | INT_DOWN, ts.io + S3C2410_ADCTSC);
330*4882a593Smuzhiyun
331*4882a593Smuzhiyun input_dev = input_allocate_device();
332*4882a593Smuzhiyun if (!input_dev) {
333*4882a593Smuzhiyun dev_err(dev, "Unable to allocate the input device !!\n");
334*4882a593Smuzhiyun ret = -ENOMEM;
335*4882a593Smuzhiyun goto err_iomap;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun
338*4882a593Smuzhiyun ts.input = input_dev;
339*4882a593Smuzhiyun ts.input->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
340*4882a593Smuzhiyun ts.input->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
341*4882a593Smuzhiyun input_set_abs_params(ts.input, ABS_X, 0, 0x3FF, 0, 0);
342*4882a593Smuzhiyun input_set_abs_params(ts.input, ABS_Y, 0, 0x3FF, 0, 0);
343*4882a593Smuzhiyun
344*4882a593Smuzhiyun ts.input->name = "S3C24XX TouchScreen";
345*4882a593Smuzhiyun ts.input->id.bustype = BUS_HOST;
346*4882a593Smuzhiyun ts.input->id.vendor = 0xDEAD;
347*4882a593Smuzhiyun ts.input->id.product = 0xBEEF;
348*4882a593Smuzhiyun ts.input->id.version = 0x0102;
349*4882a593Smuzhiyun
350*4882a593Smuzhiyun ts.shift = info->oversampling_shift;
351*4882a593Smuzhiyun ts.features = platform_get_device_id(pdev)->driver_data;
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun ret = request_irq(ts.irq_tc, stylus_irq, 0,
354*4882a593Smuzhiyun "s3c2410_ts_pen", ts.input);
355*4882a593Smuzhiyun if (ret) {
356*4882a593Smuzhiyun dev_err(dev, "cannot get TC interrupt\n");
357*4882a593Smuzhiyun goto err_inputdev;
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun dev_info(dev, "driver attached, registering input device\n");
361*4882a593Smuzhiyun
362*4882a593Smuzhiyun /* All went ok, so register to the input system */
363*4882a593Smuzhiyun ret = input_register_device(ts.input);
364*4882a593Smuzhiyun if (ret < 0) {
365*4882a593Smuzhiyun dev_err(dev, "failed to register input device\n");
366*4882a593Smuzhiyun ret = -EIO;
367*4882a593Smuzhiyun goto err_tcirq;
368*4882a593Smuzhiyun }
369*4882a593Smuzhiyun
370*4882a593Smuzhiyun return 0;
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun err_tcirq:
373*4882a593Smuzhiyun free_irq(ts.irq_tc, ts.input);
374*4882a593Smuzhiyun err_inputdev:
375*4882a593Smuzhiyun input_free_device(ts.input);
376*4882a593Smuzhiyun err_iomap:
377*4882a593Smuzhiyun iounmap(ts.io);
378*4882a593Smuzhiyun err_clk:
379*4882a593Smuzhiyun clk_disable_unprepare(ts.clock);
380*4882a593Smuzhiyun del_timer_sync(&touch_timer);
381*4882a593Smuzhiyun err_clk_get:
382*4882a593Smuzhiyun clk_put(ts.clock);
383*4882a593Smuzhiyun return ret;
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun
386*4882a593Smuzhiyun /**
387*4882a593Smuzhiyun * s3c2410ts_remove - device core removal entry point
388*4882a593Smuzhiyun * @pdev: The device we are being removed from.
389*4882a593Smuzhiyun *
390*4882a593Smuzhiyun * Free up our state ready to be removed.
391*4882a593Smuzhiyun */
s3c2410ts_remove(struct platform_device * pdev)392*4882a593Smuzhiyun static int s3c2410ts_remove(struct platform_device *pdev)
393*4882a593Smuzhiyun {
394*4882a593Smuzhiyun free_irq(ts.irq_tc, ts.input);
395*4882a593Smuzhiyun del_timer_sync(&touch_timer);
396*4882a593Smuzhiyun
397*4882a593Smuzhiyun clk_disable_unprepare(ts.clock);
398*4882a593Smuzhiyun clk_put(ts.clock);
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun input_unregister_device(ts.input);
401*4882a593Smuzhiyun iounmap(ts.io);
402*4882a593Smuzhiyun
403*4882a593Smuzhiyun return 0;
404*4882a593Smuzhiyun }
405*4882a593Smuzhiyun
406*4882a593Smuzhiyun #ifdef CONFIG_PM
s3c2410ts_suspend(struct device * dev)407*4882a593Smuzhiyun static int s3c2410ts_suspend(struct device *dev)
408*4882a593Smuzhiyun {
409*4882a593Smuzhiyun writel(TSC_SLEEP, ts.io + S3C2410_ADCTSC);
410*4882a593Smuzhiyun disable_irq(ts.irq_tc);
411*4882a593Smuzhiyun clk_disable(ts.clock);
412*4882a593Smuzhiyun
413*4882a593Smuzhiyun return 0;
414*4882a593Smuzhiyun }
415*4882a593Smuzhiyun
s3c2410ts_resume(struct device * dev)416*4882a593Smuzhiyun static int s3c2410ts_resume(struct device *dev)
417*4882a593Smuzhiyun {
418*4882a593Smuzhiyun struct platform_device *pdev = to_platform_device(dev);
419*4882a593Smuzhiyun struct s3c2410_ts_mach_info *info = dev_get_platdata(&pdev->dev);
420*4882a593Smuzhiyun
421*4882a593Smuzhiyun clk_enable(ts.clock);
422*4882a593Smuzhiyun enable_irq(ts.irq_tc);
423*4882a593Smuzhiyun
424*4882a593Smuzhiyun /* Initialise registers */
425*4882a593Smuzhiyun if ((info->delay & 0xffff) > 0)
426*4882a593Smuzhiyun writel(info->delay & 0xffff, ts.io + S3C2410_ADCDLY);
427*4882a593Smuzhiyun
428*4882a593Smuzhiyun writel(WAIT4INT | INT_DOWN, ts.io + S3C2410_ADCTSC);
429*4882a593Smuzhiyun
430*4882a593Smuzhiyun return 0;
431*4882a593Smuzhiyun }
432*4882a593Smuzhiyun
433*4882a593Smuzhiyun static const struct dev_pm_ops s3c_ts_pmops = {
434*4882a593Smuzhiyun .suspend = s3c2410ts_suspend,
435*4882a593Smuzhiyun .resume = s3c2410ts_resume,
436*4882a593Smuzhiyun };
437*4882a593Smuzhiyun #endif
438*4882a593Smuzhiyun
439*4882a593Smuzhiyun static const struct platform_device_id s3cts_driver_ids[] = {
440*4882a593Smuzhiyun { "s3c2410-ts", 0 },
441*4882a593Smuzhiyun { "s3c2440-ts", 0 },
442*4882a593Smuzhiyun { "s3c64xx-ts", FEAT_PEN_IRQ },
443*4882a593Smuzhiyun { }
444*4882a593Smuzhiyun };
445*4882a593Smuzhiyun MODULE_DEVICE_TABLE(platform, s3cts_driver_ids);
446*4882a593Smuzhiyun
447*4882a593Smuzhiyun static struct platform_driver s3c_ts_driver = {
448*4882a593Smuzhiyun .driver = {
449*4882a593Smuzhiyun .name = "samsung-ts",
450*4882a593Smuzhiyun #ifdef CONFIG_PM
451*4882a593Smuzhiyun .pm = &s3c_ts_pmops,
452*4882a593Smuzhiyun #endif
453*4882a593Smuzhiyun },
454*4882a593Smuzhiyun .id_table = s3cts_driver_ids,
455*4882a593Smuzhiyun .probe = s3c2410ts_probe,
456*4882a593Smuzhiyun .remove = s3c2410ts_remove,
457*4882a593Smuzhiyun };
458*4882a593Smuzhiyun module_platform_driver(s3c_ts_driver);
459*4882a593Smuzhiyun
460*4882a593Smuzhiyun MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>, "
461*4882a593Smuzhiyun "Ben Dooks <ben@simtec.co.uk>, "
462*4882a593Smuzhiyun "Simtec Electronics <linux@simtec.co.uk>");
463*4882a593Smuzhiyun MODULE_DESCRIPTION("S3C24XX Touchscreen driver");
464*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
465