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> 23a3364409SRussell King #include <linux/interrupt.h> 24acb45439SRussell King #include <linux/sched.h> 25a3364409SRussell King #include <linux/spinlock.h> 26acb45439SRussell King #include <linux/completion.h> 27acb45439SRussell King #include <linux/delay.h> 28acb45439SRussell King #include <linux/string.h> 29acb45439SRussell King #include <linux/input.h> 30acb45439SRussell King #include <linux/device.h> 317dfb7103SNigel Cunningham #include <linux/freezer.h> 32acb45439SRussell King #include <linux/slab.h> 335437775eSPavel Machek #include <linux/kthread.h> 34c8602edfSThomas Kunze #include <linux/mfd/ucb1x00.h> 35acb45439SRussell King 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 45a3364409SRussell King spinlock_t irq_lock; 46a3364409SRussell King unsigned irq_disabled; 47acb45439SRussell King wait_queue_head_t irq_wait; 48acb45439SRussell King struct task_struct *rtask; 49acb45439SRussell King u16 x_res; 50acb45439SRussell King u16 y_res; 51acb45439SRussell King 526b9ea421SRussell King unsigned int adcsync:1; 53acb45439SRussell King }; 54acb45439SRussell King 55acb45439SRussell King static int adcsync; 56acb45439SRussell King 57acb45439SRussell King static inline void ucb1x00_ts_evt_add(struct ucb1x00_ts *ts, u16 pressure, u16 x, u16 y) 58acb45439SRussell King { 591393c3edSNicolas Pitre struct input_dev *idev = ts->idev; 6008c67d2aSDmitry Torokhov 611393c3edSNicolas Pitre input_report_abs(idev, ABS_X, x); 621393c3edSNicolas Pitre input_report_abs(idev, ABS_Y, y); 631393c3edSNicolas Pitre input_report_abs(idev, ABS_PRESSURE, pressure); 64de8c8b06SJochen Friedrich input_report_key(idev, BTN_TOUCH, 1); 651393c3edSNicolas Pitre input_sync(idev); 66acb45439SRussell King } 67acb45439SRussell King 68acb45439SRussell King static inline void ucb1x00_ts_event_release(struct ucb1x00_ts *ts) 69acb45439SRussell King { 701393c3edSNicolas Pitre struct input_dev *idev = ts->idev; 7108c67d2aSDmitry Torokhov 721393c3edSNicolas Pitre input_report_abs(idev, ABS_PRESSURE, 0); 73de8c8b06SJochen Friedrich input_report_key(idev, BTN_TOUCH, 0); 741393c3edSNicolas Pitre input_sync(idev); 75acb45439SRussell King } 76acb45439SRussell King 77acb45439SRussell King /* 78acb45439SRussell King * Switch to interrupt mode. 79acb45439SRussell King */ 80acb45439SRussell King static inline void ucb1x00_ts_mode_int(struct ucb1x00_ts *ts) 81acb45439SRussell King { 82acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 83acb45439SRussell King UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | 84acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | 85acb45439SRussell King UCB_TS_CR_MODE_INT); 86acb45439SRussell King } 87acb45439SRussell King 88acb45439SRussell King /* 89acb45439SRussell King * Switch to pressure mode, and read pressure. We don't need to wait 90acb45439SRussell King * here, since both plates are being driven. 91acb45439SRussell King */ 92acb45439SRussell King static inline unsigned int ucb1x00_ts_read_pressure(struct ucb1x00_ts *ts) 93acb45439SRussell King { 9417532989SPavel Machek if (machine_is_collie()) { 9517532989SPavel Machek ucb1x00_io_write(ts->ucb, COLLIE_TC35143_GPIO_TBL_CHK, 0); 9617532989SPavel Machek ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 9717532989SPavel Machek UCB_TS_CR_TSPX_POW | UCB_TS_CR_TSMX_POW | 9817532989SPavel Machek UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 9917532989SPavel Machek 10017532989SPavel Machek udelay(55); 10117532989SPavel Machek 10217532989SPavel Machek return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_AD2, ts->adcsync); 10317532989SPavel Machek } else { 104acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 105acb45439SRussell King UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | 106acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | 107acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 108acb45439SRussell King 109acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync); 110acb45439SRussell King } 11117532989SPavel Machek } 112acb45439SRussell King 113acb45439SRussell King /* 114acb45439SRussell King * Switch to X position mode and measure Y plate. We switch the plate 115acb45439SRussell King * configuration in pressure mode, then switch to position mode. This 116acb45439SRussell King * gives a faster response time. Even so, we need to wait about 55us 117acb45439SRussell King * for things to stabilise. 118acb45439SRussell King */ 119acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xpos(struct ucb1x00_ts *ts) 120acb45439SRussell King { 12117532989SPavel Machek if (machine_is_collie()) 12217532989SPavel Machek ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK); 12317532989SPavel Machek else { 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); 127acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 128acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 129acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 13017532989SPavel Machek } 131acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 132acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 133acb45439SRussell King UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 134acb45439SRussell King 135acb45439SRussell King udelay(55); 136acb45439SRussell King 137acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync); 138acb45439SRussell King } 139acb45439SRussell King 140acb45439SRussell King /* 141acb45439SRussell King * Switch to Y position mode and measure X plate. We switch the plate 142acb45439SRussell King * configuration in pressure mode, then switch to position mode. This 143acb45439SRussell King * gives a faster response time. Even so, we need to wait about 55us 144acb45439SRussell King * for things to stabilise. 145acb45439SRussell King */ 146acb45439SRussell King static inline unsigned int ucb1x00_ts_read_ypos(struct ucb1x00_ts *ts) 147acb45439SRussell King { 14817532989SPavel Machek if (machine_is_collie()) 14917532989SPavel Machek ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK); 15017532989SPavel Machek else { 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); 154acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 155acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 156acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 15717532989SPavel Machek } 15817532989SPavel Machek 159acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 160acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 161acb45439SRussell King UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 162acb45439SRussell King 163acb45439SRussell King udelay(55); 164acb45439SRussell King 165acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPX, ts->adcsync); 166acb45439SRussell King } 167acb45439SRussell King 168acb45439SRussell King /* 169acb45439SRussell King * Switch to X plate resistance mode. Set MX to ground, PX to 170acb45439SRussell King * supply. Measure current. 171acb45439SRussell King */ 172acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xres(struct ucb1x00_ts *ts) 173acb45439SRussell King { 174acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 175acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 176acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 177acb45439SRussell King return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync); 178acb45439SRussell King } 179acb45439SRussell King 180acb45439SRussell King /* 181acb45439SRussell King * Switch to Y plate resistance mode. Set MY to ground, PY to 182acb45439SRussell King * supply. Measure current. 183acb45439SRussell King */ 184acb45439SRussell King static inline unsigned int ucb1x00_ts_read_yres(struct ucb1x00_ts *ts) 185acb45439SRussell King { 186acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 187acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 188acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 189acb45439SRussell King return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync); 190acb45439SRussell King } 191acb45439SRussell King 19217532989SPavel Machek static inline int ucb1x00_ts_pen_down(struct ucb1x00_ts *ts) 19317532989SPavel Machek { 19417532989SPavel Machek unsigned int val = ucb1x00_reg_read(ts->ucb, UCB_TS_CR); 19508c67d2aSDmitry Torokhov 19617532989SPavel Machek if (machine_is_collie()) 19717532989SPavel Machek return (!(val & (UCB_TS_CR_TSPX_LOW))); 19817532989SPavel Machek else 19917532989SPavel Machek return (val & (UCB_TS_CR_TSPX_LOW | UCB_TS_CR_TSMX_LOW)); 20017532989SPavel Machek } 20117532989SPavel Machek 202acb45439SRussell King /* 203acb45439SRussell King * This is a RT kernel thread that handles the ADC accesses 204acb45439SRussell King * (mainly so we can use semaphores in the UCB1200 core code 205acb45439SRussell King * to serialise accesses to the ADC). 206acb45439SRussell King */ 207acb45439SRussell King static int ucb1x00_thread(void *_ts) 208acb45439SRussell King { 209acb45439SRussell King struct ucb1x00_ts *ts = _ts; 210f7440b0eSRobert P. J. Day DECLARE_WAITQUEUE(wait, current); 2110af5e4c3SRussell King bool frozen, ignore = false; 2121124d5caSDmitry Torokhov int valid = 0; 213acb45439SRussell King 21483144186SRafael J. Wysocki set_freezable(); 215acb45439SRussell King add_wait_queue(&ts->irq_wait, &wait); 2160af5e4c3SRussell King while (!kthread_freezable_should_stop(&frozen)) { 21717532989SPavel Machek unsigned int x, y, p; 218acb45439SRussell King signed long timeout; 219acb45439SRussell King 2200af5e4c3SRussell King if (frozen) 2210af5e4c3SRussell King ignore = true; 222acb45439SRussell King 223acb45439SRussell King ucb1x00_adc_enable(ts->ucb); 224acb45439SRussell King 225acb45439SRussell King x = ucb1x00_ts_read_xpos(ts); 226acb45439SRussell King y = ucb1x00_ts_read_ypos(ts); 227acb45439SRussell King p = ucb1x00_ts_read_pressure(ts); 228acb45439SRussell King 229acb45439SRussell King /* 230acb45439SRussell King * Switch back to interrupt mode. 231acb45439SRussell King */ 232acb45439SRussell King ucb1x00_ts_mode_int(ts); 233acb45439SRussell King ucb1x00_adc_disable(ts->ucb); 234acb45439SRussell King 2355437775eSPavel Machek msleep(10); 236acb45439SRussell King 237acb45439SRussell King ucb1x00_enable(ts->ucb); 238acb45439SRussell King 23917532989SPavel Machek 24017532989SPavel Machek if (ucb1x00_ts_pen_down(ts)) { 241f7440b0eSRobert P. J. Day set_current_state(TASK_INTERRUPTIBLE); 242acb45439SRussell King 243a3364409SRussell King spin_lock_irq(&ts->irq_lock); 244a3364409SRussell King if (ts->irq_disabled) { 245a3364409SRussell King ts->irq_disabled = 0; 246a3364409SRussell King enable_irq(ts->ucb->irq_base + UCB_IRQ_TSPX); 247a3364409SRussell King } 248a3364409SRussell King spin_unlock_irq(&ts->irq_lock); 249acb45439SRussell King ucb1x00_disable(ts->ucb); 250acb45439SRussell King 251acb45439SRussell King /* 252acb45439SRussell King * If we spat out a valid sample set last time, 253acb45439SRussell King * spit out a "pen off" sample here. 254acb45439SRussell King */ 255acb45439SRussell King if (valid) { 256acb45439SRussell King ucb1x00_ts_event_release(ts); 257acb45439SRussell King valid = 0; 258acb45439SRussell King } 259acb45439SRussell King 260acb45439SRussell King timeout = MAX_SCHEDULE_TIMEOUT; 261acb45439SRussell King } else { 262acb45439SRussell King ucb1x00_disable(ts->ucb); 263acb45439SRussell King 264acb45439SRussell King /* 265acb45439SRussell King * Filtering is policy. Policy belongs in user 266acb45439SRussell King * space. We therefore leave it to user space 267acb45439SRussell King * to do any filtering they please. 268acb45439SRussell King */ 2690af5e4c3SRussell King if (!ignore) { 270acb45439SRussell King ucb1x00_ts_evt_add(ts, p, x, y); 271acb45439SRussell King valid = 1; 272acb45439SRussell King } 273acb45439SRussell King 274f7440b0eSRobert P. J. Day set_current_state(TASK_INTERRUPTIBLE); 275acb45439SRussell King timeout = HZ / 100; 276acb45439SRussell King } 277acb45439SRussell King 278acb45439SRussell King schedule_timeout(timeout); 279acb45439SRussell King } 280acb45439SRussell King 281acb45439SRussell King remove_wait_queue(&ts->irq_wait, &wait); 282acb45439SRussell King 283acb45439SRussell King ts->rtask = NULL; 2845437775eSPavel Machek return 0; 285acb45439SRussell King } 286acb45439SRussell King 287acb45439SRussell King /* 288acb45439SRussell King * We only detect touch screen _touches_ with this interrupt 289acb45439SRussell King * handler, and even then we just schedule our task. 290acb45439SRussell King */ 291a3364409SRussell King static irqreturn_t ucb1x00_ts_irq(int irq, void *id) 292acb45439SRussell King { 293acb45439SRussell King struct ucb1x00_ts *ts = id; 29408c67d2aSDmitry Torokhov 295a3364409SRussell King spin_lock(&ts->irq_lock); 296a3364409SRussell King ts->irq_disabled = 1; 297a3364409SRussell King disable_irq_nosync(ts->ucb->irq_base + UCB_IRQ_TSPX); 298a3364409SRussell King spin_unlock(&ts->irq_lock); 299acb45439SRussell King wake_up(&ts->irq_wait); 300a3364409SRussell King 301a3364409SRussell King return IRQ_HANDLED; 302acb45439SRussell King } 303acb45439SRussell King 304acb45439SRussell King static int ucb1x00_ts_open(struct input_dev *idev) 305acb45439SRussell King { 30626be5a50SDmitry Torokhov struct ucb1x00_ts *ts = input_get_drvdata(idev); 307a3364409SRussell King unsigned long flags = 0; 308acb45439SRussell King int ret = 0; 309acb45439SRussell King 3105437775eSPavel Machek BUG_ON(ts->rtask); 311acb45439SRussell King 312a3364409SRussell King if (machine_is_collie()) 313a3364409SRussell King flags = IRQF_TRIGGER_RISING; 314a3364409SRussell King else 315a3364409SRussell King flags = IRQF_TRIGGER_FALLING; 316a3364409SRussell King 317a3364409SRussell King ts->irq_disabled = 0; 318a3364409SRussell King 319acb45439SRussell King init_waitqueue_head(&ts->irq_wait); 320a3364409SRussell King ret = request_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ucb1x00_ts_irq, 321a3364409SRussell King flags, "ucb1x00-ts", ts); 322acb45439SRussell King if (ret < 0) 323acb45439SRussell King goto out; 324acb45439SRussell King 325acb45439SRussell King /* 326acb45439SRussell King * If we do this at all, we should allow the user to 327acb45439SRussell King * measure and read the X and Y resistance at any time. 328acb45439SRussell King */ 329acb45439SRussell King ucb1x00_adc_enable(ts->ucb); 330acb45439SRussell King ts->x_res = ucb1x00_ts_read_xres(ts); 331acb45439SRussell King ts->y_res = ucb1x00_ts_read_yres(ts); 332acb45439SRussell King ucb1x00_adc_disable(ts->ucb); 333acb45439SRussell King 3345437775eSPavel Machek ts->rtask = kthread_run(ucb1x00_thread, ts, "ktsd"); 3355437775eSPavel Machek if (!IS_ERR(ts->rtask)) { 336acb45439SRussell King ret = 0; 337acb45439SRussell King } else { 338a3364409SRussell King free_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ts); 3395437775eSPavel Machek ts->rtask = NULL; 3405437775eSPavel Machek ret = -EFAULT; 341acb45439SRussell King } 342acb45439SRussell King 343acb45439SRussell King out: 344acb45439SRussell King return ret; 345acb45439SRussell King } 346acb45439SRussell King 347acb45439SRussell King /* 348acb45439SRussell King * Release touchscreen resources. Disable IRQs. 349acb45439SRussell King */ 350acb45439SRussell King static void ucb1x00_ts_close(struct input_dev *idev) 351acb45439SRussell King { 35226be5a50SDmitry Torokhov struct ucb1x00_ts *ts = input_get_drvdata(idev); 353acb45439SRussell King 3545437775eSPavel Machek if (ts->rtask) 3555437775eSPavel Machek kthread_stop(ts->rtask); 356acb45439SRussell King 357acb45439SRussell King ucb1x00_enable(ts->ucb); 358a3364409SRussell King free_irq(ts->ucb->irq_base + UCB_IRQ_TSPX, ts); 359acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 0); 360acb45439SRussell King ucb1x00_disable(ts->ucb); 361acb45439SRussell King } 362acb45439SRussell King 363acb45439SRussell King 364acb45439SRussell King /* 365acb45439SRussell King * Initialisation. 366acb45439SRussell King */ 367acb45439SRussell King static int ucb1x00_ts_add(struct ucb1x00_dev *dev) 368acb45439SRussell King { 369acb45439SRussell King struct ucb1x00_ts *ts; 37008c67d2aSDmitry Torokhov struct input_dev *idev; 37108c67d2aSDmitry Torokhov int err; 372acb45439SRussell King 373bd622663SDmitry Torokhov ts = kzalloc(sizeof(struct ucb1x00_ts), GFP_KERNEL); 37408c67d2aSDmitry Torokhov idev = input_allocate_device(); 37508c67d2aSDmitry Torokhov if (!ts || !idev) { 37608c67d2aSDmitry Torokhov err = -ENOMEM; 37708c67d2aSDmitry Torokhov goto fail; 378bd622663SDmitry Torokhov } 379acb45439SRussell King 380acb45439SRussell King ts->ucb = dev->ucb; 38108c67d2aSDmitry Torokhov ts->idev = idev; 382acb45439SRussell King ts->adcsync = adcsync ? UCB_SYNC : UCB_NOSYNC; 383a3364409SRussell King spin_lock_init(&ts->irq_lock); 384acb45439SRussell King 38508c67d2aSDmitry Torokhov idev->name = "Touchscreen panel"; 38665f2e753SRussell King idev->id.product = ts->ucb->id; 38708c67d2aSDmitry Torokhov idev->open = ucb1x00_ts_open; 38808c67d2aSDmitry Torokhov idev->close = ucb1x00_ts_close; 389945f6310SRussell King idev->dev.parent = &ts->ucb->dev; 390acb45439SRussell King 391de8c8b06SJochen Friedrich idev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY); 392de8c8b06SJochen Friedrich idev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); 393acb45439SRussell King 39426be5a50SDmitry Torokhov input_set_drvdata(idev, ts); 39526be5a50SDmitry Torokhov 3969063f1f1SJochen Friedrich ucb1x00_adc_enable(ts->ucb); 3979063f1f1SJochen Friedrich ts->x_res = ucb1x00_ts_read_xres(ts); 3989063f1f1SJochen Friedrich ts->y_res = ucb1x00_ts_read_yres(ts); 3999063f1f1SJochen Friedrich ucb1x00_adc_disable(ts->ucb); 4009063f1f1SJochen Friedrich 4019063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_X, 0, ts->x_res, 0, 0); 4029063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_Y, 0, ts->y_res, 0, 0); 4039063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_PRESSURE, 0, 0, 0, 0); 4049063f1f1SJochen Friedrich 40508c67d2aSDmitry Torokhov err = input_register_device(idev); 40608c67d2aSDmitry Torokhov if (err) 40708c67d2aSDmitry Torokhov goto fail; 408acb45439SRussell King 409acb45439SRussell King dev->priv = ts; 410acb45439SRussell King 411acb45439SRussell King return 0; 41208c67d2aSDmitry Torokhov 41308c67d2aSDmitry Torokhov fail: 41408c67d2aSDmitry Torokhov input_free_device(idev); 41508c67d2aSDmitry Torokhov kfree(ts); 41608c67d2aSDmitry Torokhov return err; 417acb45439SRussell King } 418acb45439SRussell King 419acb45439SRussell King static void ucb1x00_ts_remove(struct ucb1x00_dev *dev) 420acb45439SRussell King { 421acb45439SRussell King struct ucb1x00_ts *ts = dev->priv; 422bd622663SDmitry Torokhov 423bd622663SDmitry Torokhov input_unregister_device(ts->idev); 424acb45439SRussell King kfree(ts); 425acb45439SRussell King } 426acb45439SRussell King 427acb45439SRussell King static struct ucb1x00_driver ucb1x00_ts_driver = { 428acb45439SRussell King .add = ucb1x00_ts_add, 429acb45439SRussell King .remove = ucb1x00_ts_remove, 430acb45439SRussell King }; 431acb45439SRussell King 432acb45439SRussell King static int __init ucb1x00_ts_init(void) 433acb45439SRussell King { 434acb45439SRussell King return ucb1x00_register_driver(&ucb1x00_ts_driver); 435acb45439SRussell King } 436acb45439SRussell King 437acb45439SRussell King static void __exit ucb1x00_ts_exit(void) 438acb45439SRussell King { 439acb45439SRussell King ucb1x00_unregister_driver(&ucb1x00_ts_driver); 440acb45439SRussell King } 441acb45439SRussell King 442acb45439SRussell King module_param(adcsync, int, 0444); 443acb45439SRussell King module_init(ucb1x00_ts_init); 444acb45439SRussell King module_exit(ucb1x00_ts_exit); 445acb45439SRussell King 446acb45439SRussell King MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>"); 447acb45439SRussell King MODULE_DESCRIPTION("UCB1x00 touchscreen driver"); 448acb45439SRussell King MODULE_LICENSE("GPL"); 449