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> 23acb45439SRussell King #include <linux/smp.h> 24acb45439SRussell King #include <linux/sched.h> 25acb45439SRussell King #include <linux/completion.h> 26acb45439SRussell King #include <linux/delay.h> 27acb45439SRussell King #include <linux/string.h> 28acb45439SRussell King #include <linux/input.h> 29acb45439SRussell King #include <linux/device.h> 307dfb7103SNigel Cunningham #include <linux/freezer.h> 31acb45439SRussell King #include <linux/slab.h> 325437775eSPavel Machek #include <linux/kthread.h> 33c8602edfSThomas Kunze #include <linux/mfd/ucb1x00.h> 34acb45439SRussell King 35dcea83adSRussell King #include <mach/dma.h> 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 45acb45439SRussell King wait_queue_head_t irq_wait; 46acb45439SRussell King struct task_struct *rtask; 47acb45439SRussell King u16 x_res; 48acb45439SRussell King u16 y_res; 49acb45439SRussell King 506b9ea421SRussell King unsigned int restart:1; 516b9ea421SRussell King unsigned int adcsync:1; 52acb45439SRussell King }; 53acb45439SRussell King 54acb45439SRussell King static int adcsync; 55acb45439SRussell King 56acb45439SRussell King static inline void ucb1x00_ts_evt_add(struct ucb1x00_ts *ts, u16 pressure, u16 x, u16 y) 57acb45439SRussell King { 581393c3edSNicolas Pitre struct input_dev *idev = ts->idev; 5908c67d2aSDmitry Torokhov 601393c3edSNicolas Pitre input_report_abs(idev, ABS_X, x); 611393c3edSNicolas Pitre input_report_abs(idev, ABS_Y, y); 621393c3edSNicolas Pitre input_report_abs(idev, ABS_PRESSURE, pressure); 63de8c8b06SJochen Friedrich input_report_key(idev, BTN_TOUCH, 1); 641393c3edSNicolas Pitre input_sync(idev); 65acb45439SRussell King } 66acb45439SRussell King 67acb45439SRussell King static inline void ucb1x00_ts_event_release(struct ucb1x00_ts *ts) 68acb45439SRussell King { 691393c3edSNicolas Pitre struct input_dev *idev = ts->idev; 7008c67d2aSDmitry Torokhov 711393c3edSNicolas Pitre input_report_abs(idev, ABS_PRESSURE, 0); 72de8c8b06SJochen Friedrich input_report_key(idev, BTN_TOUCH, 0); 731393c3edSNicolas Pitre input_sync(idev); 74acb45439SRussell King } 75acb45439SRussell King 76acb45439SRussell King /* 77acb45439SRussell King * Switch to interrupt mode. 78acb45439SRussell King */ 79acb45439SRussell King static inline void ucb1x00_ts_mode_int(struct ucb1x00_ts *ts) 80acb45439SRussell King { 81acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 82acb45439SRussell King UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | 83acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | 84acb45439SRussell King UCB_TS_CR_MODE_INT); 85acb45439SRussell King } 86acb45439SRussell King 87acb45439SRussell King /* 88acb45439SRussell King * Switch to pressure mode, and read pressure. We don't need to wait 89acb45439SRussell King * here, since both plates are being driven. 90acb45439SRussell King */ 91acb45439SRussell King static inline unsigned int ucb1x00_ts_read_pressure(struct ucb1x00_ts *ts) 92acb45439SRussell King { 9317532989SPavel Machek if (machine_is_collie()) { 9417532989SPavel Machek ucb1x00_io_write(ts->ucb, COLLIE_TC35143_GPIO_TBL_CHK, 0); 9517532989SPavel Machek ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 9617532989SPavel Machek UCB_TS_CR_TSPX_POW | UCB_TS_CR_TSMX_POW | 9717532989SPavel Machek UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 9817532989SPavel Machek 9917532989SPavel Machek udelay(55); 10017532989SPavel Machek 10117532989SPavel Machek return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_AD2, ts->adcsync); 10217532989SPavel Machek } else { 103acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 104acb45439SRussell King UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW | 105acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND | 106acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 107acb45439SRussell King 108acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync); 109acb45439SRussell King } 11017532989SPavel Machek } 111acb45439SRussell King 112acb45439SRussell King /* 113acb45439SRussell King * Switch to X position mode and measure Y plate. We switch the plate 114acb45439SRussell King * configuration in pressure mode, then switch to position mode. This 115acb45439SRussell King * gives a faster response time. Even so, we need to wait about 55us 116acb45439SRussell King * for things to stabilise. 117acb45439SRussell King */ 118acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xpos(struct ucb1x00_ts *ts) 119acb45439SRussell King { 12017532989SPavel Machek if (machine_is_collie()) 12117532989SPavel Machek ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK); 12217532989SPavel Machek else { 123acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 124acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 125acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 126acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 127acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 128acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 12917532989SPavel Machek } 130acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 131acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 132acb45439SRussell King UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 133acb45439SRussell King 134acb45439SRussell King udelay(55); 135acb45439SRussell King 136acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync); 137acb45439SRussell King } 138acb45439SRussell King 139acb45439SRussell King /* 140acb45439SRussell King * Switch to Y position mode and measure X plate. We switch the plate 141acb45439SRussell King * configuration in pressure mode, then switch to position mode. This 142acb45439SRussell King * gives a faster response time. Even so, we need to wait about 55us 143acb45439SRussell King * for things to stabilise. 144acb45439SRussell King */ 145acb45439SRussell King static inline unsigned int ucb1x00_ts_read_ypos(struct ucb1x00_ts *ts) 146acb45439SRussell King { 14717532989SPavel Machek if (machine_is_collie()) 14817532989SPavel Machek ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK); 14917532989SPavel Machek else { 150acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 151acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 152acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 153acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 154acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 155acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 15617532989SPavel Machek } 15717532989SPavel Machek 158acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 159acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 160acb45439SRussell King UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA); 161acb45439SRussell King 162acb45439SRussell King udelay(55); 163acb45439SRussell King 164acb45439SRussell King return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPX, ts->adcsync); 165acb45439SRussell King } 166acb45439SRussell King 167acb45439SRussell King /* 168acb45439SRussell King * Switch to X plate resistance mode. Set MX to ground, PX to 169acb45439SRussell King * supply. Measure current. 170acb45439SRussell King */ 171acb45439SRussell King static inline unsigned int ucb1x00_ts_read_xres(struct ucb1x00_ts *ts) 172acb45439SRussell King { 173acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 174acb45439SRussell King UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW | 175acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 176acb45439SRussell King return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync); 177acb45439SRussell King } 178acb45439SRussell King 179acb45439SRussell King /* 180acb45439SRussell King * Switch to Y plate resistance mode. Set MY to ground, PY to 181acb45439SRussell King * supply. Measure current. 182acb45439SRussell King */ 183acb45439SRussell King static inline unsigned int ucb1x00_ts_read_yres(struct ucb1x00_ts *ts) 184acb45439SRussell King { 185acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 186acb45439SRussell King UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW | 187acb45439SRussell King UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA); 188acb45439SRussell King return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync); 189acb45439SRussell King } 190acb45439SRussell King 19117532989SPavel Machek static inline int ucb1x00_ts_pen_down(struct ucb1x00_ts *ts) 19217532989SPavel Machek { 19317532989SPavel Machek unsigned int val = ucb1x00_reg_read(ts->ucb, UCB_TS_CR); 19408c67d2aSDmitry Torokhov 19517532989SPavel Machek if (machine_is_collie()) 19617532989SPavel Machek return (!(val & (UCB_TS_CR_TSPX_LOW))); 19717532989SPavel Machek else 19817532989SPavel Machek return (val & (UCB_TS_CR_TSPX_LOW | UCB_TS_CR_TSMX_LOW)); 19917532989SPavel Machek } 20017532989SPavel Machek 201acb45439SRussell King /* 202acb45439SRussell King * This is a RT kernel thread that handles the ADC accesses 203acb45439SRussell King * (mainly so we can use semaphores in the UCB1200 core code 204acb45439SRussell King * to serialise accesses to the ADC). 205acb45439SRussell King */ 206acb45439SRussell King static int ucb1x00_thread(void *_ts) 207acb45439SRussell King { 208acb45439SRussell King struct ucb1x00_ts *ts = _ts; 209f7440b0eSRobert P. J. Day DECLARE_WAITQUEUE(wait, current); 2101124d5caSDmitry Torokhov int valid = 0; 211acb45439SRussell King 21283144186SRafael J. Wysocki set_freezable(); 213acb45439SRussell King add_wait_queue(&ts->irq_wait, &wait); 2145437775eSPavel Machek while (!kthread_should_stop()) { 21517532989SPavel Machek unsigned int x, y, p; 216acb45439SRussell King signed long timeout; 217acb45439SRussell King 218acb45439SRussell King ts->restart = 0; 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 24017532989SPavel Machek ucb1x00_enable_irq(ts->ucb, UCB_IRQ_TSPX, machine_is_collie() ? UCB_RISING : UCB_FALLING); 241acb45439SRussell King ucb1x00_disable(ts->ucb); 242acb45439SRussell King 243acb45439SRussell King /* 244acb45439SRussell King * If we spat out a valid sample set last time, 245acb45439SRussell King * spit out a "pen off" sample here. 246acb45439SRussell King */ 247acb45439SRussell King if (valid) { 248acb45439SRussell King ucb1x00_ts_event_release(ts); 249acb45439SRussell King valid = 0; 250acb45439SRussell King } 251acb45439SRussell King 252acb45439SRussell King timeout = MAX_SCHEDULE_TIMEOUT; 253acb45439SRussell King } else { 254acb45439SRussell King ucb1x00_disable(ts->ucb); 255acb45439SRussell King 256acb45439SRussell King /* 257acb45439SRussell King * Filtering is policy. Policy belongs in user 258acb45439SRussell King * space. We therefore leave it to user space 259acb45439SRussell King * to do any filtering they please. 260acb45439SRussell King */ 261acb45439SRussell King if (!ts->restart) { 262acb45439SRussell King ucb1x00_ts_evt_add(ts, p, x, y); 263acb45439SRussell King valid = 1; 264acb45439SRussell King } 265acb45439SRussell King 266f7440b0eSRobert P. J. Day set_current_state(TASK_INTERRUPTIBLE); 267acb45439SRussell King timeout = HZ / 100; 268acb45439SRussell King } 269acb45439SRussell King 270acb45439SRussell King try_to_freeze(); 271acb45439SRussell King 272acb45439SRussell King schedule_timeout(timeout); 273acb45439SRussell King } 274acb45439SRussell King 275acb45439SRussell King remove_wait_queue(&ts->irq_wait, &wait); 276acb45439SRussell King 277acb45439SRussell King ts->rtask = NULL; 2785437775eSPavel Machek return 0; 279acb45439SRussell King } 280acb45439SRussell King 281acb45439SRussell King /* 282acb45439SRussell King * We only detect touch screen _touches_ with this interrupt 283acb45439SRussell King * handler, and even then we just schedule our task. 284acb45439SRussell King */ 285acb45439SRussell King static void ucb1x00_ts_irq(int idx, void *id) 286acb45439SRussell King { 287acb45439SRussell King struct ucb1x00_ts *ts = id; 28808c67d2aSDmitry Torokhov 289acb45439SRussell King ucb1x00_disable_irq(ts->ucb, UCB_IRQ_TSPX, UCB_FALLING); 290acb45439SRussell King wake_up(&ts->irq_wait); 291acb45439SRussell King } 292acb45439SRussell King 293acb45439SRussell King static int ucb1x00_ts_open(struct input_dev *idev) 294acb45439SRussell King { 29526be5a50SDmitry Torokhov struct ucb1x00_ts *ts = input_get_drvdata(idev); 296acb45439SRussell King int ret = 0; 297acb45439SRussell King 2985437775eSPavel Machek BUG_ON(ts->rtask); 299acb45439SRussell King 300acb45439SRussell King init_waitqueue_head(&ts->irq_wait); 301acb45439SRussell King ret = ucb1x00_hook_irq(ts->ucb, UCB_IRQ_TSPX, ucb1x00_ts_irq, ts); 302acb45439SRussell King if (ret < 0) 303acb45439SRussell King goto out; 304acb45439SRussell King 305acb45439SRussell King /* 306acb45439SRussell King * If we do this at all, we should allow the user to 307acb45439SRussell King * measure and read the X and Y resistance at any time. 308acb45439SRussell King */ 309acb45439SRussell King ucb1x00_adc_enable(ts->ucb); 310acb45439SRussell King ts->x_res = ucb1x00_ts_read_xres(ts); 311acb45439SRussell King ts->y_res = ucb1x00_ts_read_yres(ts); 312acb45439SRussell King ucb1x00_adc_disable(ts->ucb); 313acb45439SRussell King 3145437775eSPavel Machek ts->rtask = kthread_run(ucb1x00_thread, ts, "ktsd"); 3155437775eSPavel Machek if (!IS_ERR(ts->rtask)) { 316acb45439SRussell King ret = 0; 317acb45439SRussell King } else { 318acb45439SRussell King ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts); 3195437775eSPavel Machek ts->rtask = NULL; 3205437775eSPavel Machek ret = -EFAULT; 321acb45439SRussell King } 322acb45439SRussell King 323acb45439SRussell King out: 324acb45439SRussell King return ret; 325acb45439SRussell King } 326acb45439SRussell King 327acb45439SRussell King /* 328acb45439SRussell King * Release touchscreen resources. Disable IRQs. 329acb45439SRussell King */ 330acb45439SRussell King static void ucb1x00_ts_close(struct input_dev *idev) 331acb45439SRussell King { 33226be5a50SDmitry Torokhov struct ucb1x00_ts *ts = input_get_drvdata(idev); 333acb45439SRussell King 3345437775eSPavel Machek if (ts->rtask) 3355437775eSPavel Machek kthread_stop(ts->rtask); 336acb45439SRussell King 337acb45439SRussell King ucb1x00_enable(ts->ucb); 338acb45439SRussell King ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts); 339acb45439SRussell King ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 0); 340acb45439SRussell King ucb1x00_disable(ts->ucb); 341acb45439SRussell King } 342acb45439SRussell King 343acb45439SRussell King #ifdef CONFIG_PM 344acb45439SRussell King static int ucb1x00_ts_resume(struct ucb1x00_dev *dev) 345acb45439SRussell King { 346acb45439SRussell King struct ucb1x00_ts *ts = dev->priv; 347acb45439SRussell King 348acb45439SRussell King if (ts->rtask != NULL) { 349acb45439SRussell King /* 350acb45439SRussell King * Restart the TS thread to ensure the 351acb45439SRussell King * TS interrupt mode is set up again 352acb45439SRussell King * after sleep. 353acb45439SRussell King */ 354acb45439SRussell King ts->restart = 1; 355acb45439SRussell King wake_up(&ts->irq_wait); 356acb45439SRussell King } 357acb45439SRussell King return 0; 358acb45439SRussell King } 359acb45439SRussell King #else 360acb45439SRussell King #define ucb1x00_ts_resume NULL 361acb45439SRussell King #endif 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; 383acb45439SRussell King 38408c67d2aSDmitry Torokhov idev->name = "Touchscreen panel"; 38565f2e753SRussell King idev->id.product = ts->ucb->id; 38608c67d2aSDmitry Torokhov idev->open = ucb1x00_ts_open; 38708c67d2aSDmitry Torokhov idev->close = ucb1x00_ts_close; 388acb45439SRussell King 389de8c8b06SJochen Friedrich idev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY); 390de8c8b06SJochen Friedrich idev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); 391acb45439SRussell King 39226be5a50SDmitry Torokhov input_set_drvdata(idev, ts); 39326be5a50SDmitry Torokhov 3949063f1f1SJochen Friedrich ucb1x00_adc_enable(ts->ucb); 3959063f1f1SJochen Friedrich ts->x_res = ucb1x00_ts_read_xres(ts); 3969063f1f1SJochen Friedrich ts->y_res = ucb1x00_ts_read_yres(ts); 3979063f1f1SJochen Friedrich ucb1x00_adc_disable(ts->ucb); 3989063f1f1SJochen Friedrich 3999063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_X, 0, ts->x_res, 0, 0); 4009063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_Y, 0, ts->y_res, 0, 0); 4019063f1f1SJochen Friedrich input_set_abs_params(idev, ABS_PRESSURE, 0, 0, 0, 0); 4029063f1f1SJochen Friedrich 40308c67d2aSDmitry Torokhov err = input_register_device(idev); 40408c67d2aSDmitry Torokhov if (err) 40508c67d2aSDmitry Torokhov goto fail; 406acb45439SRussell King 407acb45439SRussell King dev->priv = ts; 408acb45439SRussell King 409acb45439SRussell King return 0; 41008c67d2aSDmitry Torokhov 41108c67d2aSDmitry Torokhov fail: 41208c67d2aSDmitry Torokhov input_free_device(idev); 41308c67d2aSDmitry Torokhov kfree(ts); 41408c67d2aSDmitry Torokhov return err; 415acb45439SRussell King } 416acb45439SRussell King 417acb45439SRussell King static void ucb1x00_ts_remove(struct ucb1x00_dev *dev) 418acb45439SRussell King { 419acb45439SRussell King struct ucb1x00_ts *ts = dev->priv; 420bd622663SDmitry Torokhov 421bd622663SDmitry Torokhov input_unregister_device(ts->idev); 422acb45439SRussell King kfree(ts); 423acb45439SRussell King } 424acb45439SRussell King 425acb45439SRussell King static struct ucb1x00_driver ucb1x00_ts_driver = { 426acb45439SRussell King .add = ucb1x00_ts_add, 427acb45439SRussell King .remove = ucb1x00_ts_remove, 428acb45439SRussell King .resume = ucb1x00_ts_resume, 429acb45439SRussell King }; 430acb45439SRussell King 431acb45439SRussell King static int __init ucb1x00_ts_init(void) 432acb45439SRussell King { 433acb45439SRussell King return ucb1x00_register_driver(&ucb1x00_ts_driver); 434acb45439SRussell King } 435acb45439SRussell King 436acb45439SRussell King static void __exit ucb1x00_ts_exit(void) 437acb45439SRussell King { 438acb45439SRussell King ucb1x00_unregister_driver(&ucb1x00_ts_driver); 439acb45439SRussell King } 440acb45439SRussell King 441acb45439SRussell King module_param(adcsync, int, 0444); 442acb45439SRussell King module_init(ucb1x00_ts_init); 443acb45439SRussell King module_exit(ucb1x00_ts_exit); 444acb45439SRussell King 445acb45439SRussell King MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>"); 446acb45439SRussell King MODULE_DESCRIPTION("UCB1x00 touchscreen driver"); 447acb45439SRussell King MODULE_LICENSE("GPL"); 448