1febf1dffSMark Brown /* 2febf1dffSMark Brown * wm97xx-core.c -- Touch screen driver core for Wolfson WM9705, WM9712 3febf1dffSMark Brown * and WM9713 AC97 Codecs. 4febf1dffSMark Brown * 5febf1dffSMark Brown * Copyright 2003, 2004, 2005, 2006, 2007, 2008 Wolfson Microelectronics PLC. 6febf1dffSMark Brown * Author: Liam Girdwood 7febf1dffSMark Brown * liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com 8febf1dffSMark Brown * Parts Copyright : Ian Molton <spyro@f2s.com> 9febf1dffSMark Brown * Andrew Zabolotny <zap@homelink.ru> 10febf1dffSMark Brown * Russell King <rmk@arm.linux.org.uk> 11febf1dffSMark Brown * 12febf1dffSMark Brown * This program is free software; you can redistribute it and/or modify it 13febf1dffSMark Brown * under the terms of the GNU General Public License as published by the 14febf1dffSMark Brown * Free Software Foundation; either version 2 of the License, or (at your 15febf1dffSMark Brown * option) any later version. 16febf1dffSMark Brown * 17febf1dffSMark Brown * Notes: 18febf1dffSMark Brown * 19febf1dffSMark Brown * Features: 20febf1dffSMark Brown * - supports WM9705, WM9712, WM9713 21febf1dffSMark Brown * - polling mode 22febf1dffSMark Brown * - continuous mode (arch-dependent) 23febf1dffSMark Brown * - adjustable rpu/dpp settings 24febf1dffSMark Brown * - adjustable pressure current 25febf1dffSMark Brown * - adjustable sample settle delay 26febf1dffSMark Brown * - 4 and 5 wire touchscreens (5 wire is WM9712 only) 27febf1dffSMark Brown * - pen down detection 28febf1dffSMark Brown * - battery monitor 29febf1dffSMark Brown * - sample AUX adcs 30febf1dffSMark Brown * - power management 31febf1dffSMark Brown * - codec GPIO 32febf1dffSMark Brown * - codec event notification 33febf1dffSMark Brown * Todo 34febf1dffSMark Brown * - Support for async sampling control for noisy LCDs. 35febf1dffSMark Brown * 36febf1dffSMark Brown */ 37febf1dffSMark Brown 38febf1dffSMark Brown #include <linux/module.h> 39febf1dffSMark Brown #include <linux/moduleparam.h> 40febf1dffSMark Brown #include <linux/version.h> 41febf1dffSMark Brown #include <linux/kernel.h> 42febf1dffSMark Brown #include <linux/init.h> 43febf1dffSMark Brown #include <linux/delay.h> 44febf1dffSMark Brown #include <linux/string.h> 45febf1dffSMark Brown #include <linux/proc_fs.h> 46febf1dffSMark Brown #include <linux/pm.h> 47febf1dffSMark Brown #include <linux/interrupt.h> 48febf1dffSMark Brown #include <linux/bitops.h> 49febf1dffSMark Brown #include <linux/workqueue.h> 50febf1dffSMark Brown #include <linux/wm97xx.h> 51febf1dffSMark Brown #include <linux/uaccess.h> 52febf1dffSMark Brown #include <linux/io.h> 53febf1dffSMark Brown 54febf1dffSMark Brown #define TS_NAME "wm97xx" 55febf1dffSMark Brown #define WM_CORE_VERSION "1.00" 56febf1dffSMark Brown #define DEFAULT_PRESSURE 0xb0c0 57febf1dffSMark Brown 58febf1dffSMark Brown 59febf1dffSMark Brown /* 60febf1dffSMark Brown * Touchscreen absolute values 61febf1dffSMark Brown * 62febf1dffSMark Brown * These parameters are used to help the input layer discard out of 63febf1dffSMark Brown * range readings and reduce jitter etc. 64febf1dffSMark Brown * 65febf1dffSMark Brown * o min, max:- indicate the min and max values your touch screen returns 66febf1dffSMark Brown * o fuzz:- use a higher number to reduce jitter 67febf1dffSMark Brown * 68febf1dffSMark Brown * The default values correspond to Mainstone II in QVGA mode 69febf1dffSMark Brown * 70febf1dffSMark Brown * Please read 71febf1dffSMark Brown * Documentation/input/input-programming.txt for more details. 72febf1dffSMark Brown */ 73febf1dffSMark Brown 74febf1dffSMark Brown static int abs_x[3] = {350, 3900, 5}; 75febf1dffSMark Brown module_param_array(abs_x, int, NULL, 0); 76febf1dffSMark Brown MODULE_PARM_DESC(abs_x, "Touchscreen absolute X min, max, fuzz"); 77febf1dffSMark Brown 78febf1dffSMark Brown static int abs_y[3] = {320, 3750, 40}; 79febf1dffSMark Brown module_param_array(abs_y, int, NULL, 0); 80febf1dffSMark Brown MODULE_PARM_DESC(abs_y, "Touchscreen absolute Y min, max, fuzz"); 81febf1dffSMark Brown 82febf1dffSMark Brown static int abs_p[3] = {0, 150, 4}; 83febf1dffSMark Brown module_param_array(abs_p, int, NULL, 0); 84febf1dffSMark Brown MODULE_PARM_DESC(abs_p, "Touchscreen absolute Pressure min, max, fuzz"); 85febf1dffSMark Brown 86febf1dffSMark Brown /* 87febf1dffSMark Brown * wm97xx IO access, all IO locking done by AC97 layer 88febf1dffSMark Brown */ 89febf1dffSMark Brown int wm97xx_reg_read(struct wm97xx *wm, u16 reg) 90febf1dffSMark Brown { 91febf1dffSMark Brown if (wm->ac97) 92febf1dffSMark Brown return wm->ac97->bus->ops->read(wm->ac97, reg); 93febf1dffSMark Brown else 94febf1dffSMark Brown return -1; 95febf1dffSMark Brown } 96febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_reg_read); 97febf1dffSMark Brown 98febf1dffSMark Brown void wm97xx_reg_write(struct wm97xx *wm, u16 reg, u16 val) 99febf1dffSMark Brown { 100febf1dffSMark Brown /* cache digitiser registers */ 101febf1dffSMark Brown if (reg >= AC97_WM9713_DIG1 && reg <= AC97_WM9713_DIG3) 102febf1dffSMark Brown wm->dig[(reg - AC97_WM9713_DIG1) >> 1] = val; 103febf1dffSMark Brown 104febf1dffSMark Brown /* cache gpio regs */ 105febf1dffSMark Brown if (reg >= AC97_GPIO_CFG && reg <= AC97_MISC_AFE) 106febf1dffSMark Brown wm->gpio[(reg - AC97_GPIO_CFG) >> 1] = val; 107febf1dffSMark Brown 108febf1dffSMark Brown /* wm9713 irq reg */ 109febf1dffSMark Brown if (reg == 0x5a) 110febf1dffSMark Brown wm->misc = val; 111febf1dffSMark Brown 112febf1dffSMark Brown if (wm->ac97) 113febf1dffSMark Brown wm->ac97->bus->ops->write(wm->ac97, reg, val); 114febf1dffSMark Brown } 115febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_reg_write); 116febf1dffSMark Brown 117febf1dffSMark Brown /** 118febf1dffSMark Brown * wm97xx_read_aux_adc - Read the aux adc. 119febf1dffSMark Brown * @wm: wm97xx device. 120febf1dffSMark Brown * @adcsel: codec ADC to be read 121febf1dffSMark Brown * 122febf1dffSMark Brown * Reads the selected AUX ADC. 123febf1dffSMark Brown */ 124febf1dffSMark Brown 125febf1dffSMark Brown int wm97xx_read_aux_adc(struct wm97xx *wm, u16 adcsel) 126febf1dffSMark Brown { 127febf1dffSMark Brown int power_adc = 0, auxval; 128febf1dffSMark Brown u16 power = 0; 129febf1dffSMark Brown 130febf1dffSMark Brown /* get codec */ 131febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 132febf1dffSMark Brown 133febf1dffSMark Brown /* When the touchscreen is not in use, we may have to power up 134febf1dffSMark Brown * the AUX ADC before we can use sample the AUX inputs-> 135febf1dffSMark Brown */ 136febf1dffSMark Brown if (wm->id == WM9713_ID2 && 137febf1dffSMark Brown (power = wm97xx_reg_read(wm, AC97_EXTENDED_MID)) & 0x8000) { 138febf1dffSMark Brown power_adc = 1; 139febf1dffSMark Brown wm97xx_reg_write(wm, AC97_EXTENDED_MID, power & 0x7fff); 140febf1dffSMark Brown } 141febf1dffSMark Brown 142febf1dffSMark Brown /* Prepare the codec for AUX reading */ 143febf1dffSMark Brown wm->codec->aux_prepare(wm); 144febf1dffSMark Brown 145febf1dffSMark Brown /* Turn polling mode on to read AUX ADC */ 146febf1dffSMark Brown wm->pen_probably_down = 1; 147febf1dffSMark Brown wm->codec->poll_sample(wm, adcsel, &auxval); 148febf1dffSMark Brown 149febf1dffSMark Brown if (power_adc) 150febf1dffSMark Brown wm97xx_reg_write(wm, AC97_EXTENDED_MID, power | 0x8000); 151febf1dffSMark Brown 152febf1dffSMark Brown wm->codec->dig_restore(wm); 153febf1dffSMark Brown 154febf1dffSMark Brown wm->pen_probably_down = 0; 155febf1dffSMark Brown 156febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 157febf1dffSMark Brown return auxval & 0xfff; 158febf1dffSMark Brown } 159febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_read_aux_adc); 160febf1dffSMark Brown 161febf1dffSMark Brown /** 162febf1dffSMark Brown * wm97xx_get_gpio - Get the status of a codec GPIO. 163febf1dffSMark Brown * @wm: wm97xx device. 164febf1dffSMark Brown * @gpio: gpio 165febf1dffSMark Brown * 166febf1dffSMark Brown * Get the status of a codec GPIO pin 167febf1dffSMark Brown */ 168febf1dffSMark Brown 169febf1dffSMark Brown enum wm97xx_gpio_status wm97xx_get_gpio(struct wm97xx *wm, u32 gpio) 170febf1dffSMark Brown { 171febf1dffSMark Brown u16 status; 172febf1dffSMark Brown enum wm97xx_gpio_status ret; 173febf1dffSMark Brown 174febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 175febf1dffSMark Brown status = wm97xx_reg_read(wm, AC97_GPIO_STATUS); 176febf1dffSMark Brown 177febf1dffSMark Brown if (status & gpio) 178febf1dffSMark Brown ret = WM97XX_GPIO_HIGH; 179febf1dffSMark Brown else 180febf1dffSMark Brown ret = WM97XX_GPIO_LOW; 181febf1dffSMark Brown 182febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 183febf1dffSMark Brown return ret; 184febf1dffSMark Brown } 185febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_get_gpio); 186febf1dffSMark Brown 187febf1dffSMark Brown /** 188febf1dffSMark Brown * wm97xx_set_gpio - Set the status of a codec GPIO. 189febf1dffSMark Brown * @wm: wm97xx device. 190febf1dffSMark Brown * @gpio: gpio 191febf1dffSMark Brown * 192febf1dffSMark Brown * 193febf1dffSMark Brown * Set the status of a codec GPIO pin 194febf1dffSMark Brown */ 195febf1dffSMark Brown 196febf1dffSMark Brown void wm97xx_set_gpio(struct wm97xx *wm, u32 gpio, 197febf1dffSMark Brown enum wm97xx_gpio_status status) 198febf1dffSMark Brown { 199febf1dffSMark Brown u16 reg; 200febf1dffSMark Brown 201febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 202febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_GPIO_STATUS); 203febf1dffSMark Brown 204febf1dffSMark Brown if (status & WM97XX_GPIO_HIGH) 205febf1dffSMark Brown reg |= gpio; 206febf1dffSMark Brown else 207febf1dffSMark Brown reg &= ~gpio; 208febf1dffSMark Brown 209febf1dffSMark Brown if (wm->id == WM9712_ID2) 210febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STATUS, reg << 1); 211febf1dffSMark Brown else 212febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STATUS, reg); 213febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 214febf1dffSMark Brown } 215febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_set_gpio); 216febf1dffSMark Brown 217febf1dffSMark Brown /* 218febf1dffSMark Brown * Codec GPIO pin configuration, this sets pin direction, polarity, 219febf1dffSMark Brown * stickyness and wake up. 220febf1dffSMark Brown */ 221febf1dffSMark Brown void wm97xx_config_gpio(struct wm97xx *wm, u32 gpio, enum wm97xx_gpio_dir dir, 222febf1dffSMark Brown enum wm97xx_gpio_pol pol, enum wm97xx_gpio_sticky sticky, 223febf1dffSMark Brown enum wm97xx_gpio_wake wake) 224febf1dffSMark Brown { 225febf1dffSMark Brown u16 reg; 226febf1dffSMark Brown 227febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 228febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_GPIO_POLARITY); 229febf1dffSMark Brown 230febf1dffSMark Brown if (pol == WM97XX_GPIO_POL_HIGH) 231febf1dffSMark Brown reg |= gpio; 232febf1dffSMark Brown else 233febf1dffSMark Brown reg &= ~gpio; 234febf1dffSMark Brown 235febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_POLARITY, reg); 236febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_GPIO_STICKY); 237febf1dffSMark Brown 238febf1dffSMark Brown if (sticky == WM97XX_GPIO_STICKY) 239febf1dffSMark Brown reg |= gpio; 240febf1dffSMark Brown else 241febf1dffSMark Brown reg &= ~gpio; 242febf1dffSMark Brown 243febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STICKY, reg); 244febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_GPIO_WAKEUP); 245febf1dffSMark Brown 246febf1dffSMark Brown if (wake == WM97XX_GPIO_WAKE) 247febf1dffSMark Brown reg |= gpio; 248febf1dffSMark Brown else 249febf1dffSMark Brown reg &= ~gpio; 250febf1dffSMark Brown 251febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_WAKEUP, reg); 252febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_GPIO_CFG); 253febf1dffSMark Brown 254febf1dffSMark Brown if (dir == WM97XX_GPIO_IN) 255febf1dffSMark Brown reg |= gpio; 256febf1dffSMark Brown else 257febf1dffSMark Brown reg &= ~gpio; 258febf1dffSMark Brown 259febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_CFG, reg); 260febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 261febf1dffSMark Brown } 262febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_config_gpio); 263febf1dffSMark Brown 264febf1dffSMark Brown /* 26534d27853SMark Brown * Configure the WM97XX_PRP value to use while system is suspended. 26634d27853SMark Brown * If a value other than 0 is set then WM97xx pen detection will be 26734d27853SMark Brown * left enabled in the configured mode while the system is in suspend, 26834d27853SMark Brown * the device has users and suspend has not been disabled via the 26934d27853SMark Brown * wakeup sysfs entries. 27034d27853SMark Brown * 27134d27853SMark Brown * @wm: WM97xx device to configure 27234d27853SMark Brown * @mode: WM97XX_PRP value to configure while suspended 27334d27853SMark Brown */ 27434d27853SMark Brown void wm97xx_set_suspend_mode(struct wm97xx *wm, u16 mode) 27534d27853SMark Brown { 27634d27853SMark Brown wm->suspend_mode = mode; 27734d27853SMark Brown device_init_wakeup(&wm->input_dev->dev, mode != 0); 27834d27853SMark Brown } 27934d27853SMark Brown EXPORT_SYMBOL_GPL(wm97xx_set_suspend_mode); 28034d27853SMark Brown 28134d27853SMark Brown /* 282febf1dffSMark Brown * Handle a pen down interrupt. 283febf1dffSMark Brown */ 284febf1dffSMark Brown static void wm97xx_pen_irq_worker(struct work_struct *work) 285febf1dffSMark Brown { 286febf1dffSMark Brown struct wm97xx *wm = container_of(work, struct wm97xx, pen_event_work); 287febf1dffSMark Brown int pen_was_down = wm->pen_is_down; 288febf1dffSMark Brown 289febf1dffSMark Brown /* do we need to enable the touch panel reader */ 290febf1dffSMark Brown if (wm->id == WM9705_ID2) { 291febf1dffSMark Brown if (wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD) & 292febf1dffSMark Brown WM97XX_PEN_DOWN) 293febf1dffSMark Brown wm->pen_is_down = 1; 294febf1dffSMark Brown else 295febf1dffSMark Brown wm->pen_is_down = 0; 296febf1dffSMark Brown } else { 297febf1dffSMark Brown u16 status, pol; 298febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 299febf1dffSMark Brown status = wm97xx_reg_read(wm, AC97_GPIO_STATUS); 300febf1dffSMark Brown pol = wm97xx_reg_read(wm, AC97_GPIO_POLARITY); 301febf1dffSMark Brown 302febf1dffSMark Brown if (WM97XX_GPIO_13 & pol & status) { 303febf1dffSMark Brown wm->pen_is_down = 1; 304febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_POLARITY, pol & 305febf1dffSMark Brown ~WM97XX_GPIO_13); 306febf1dffSMark Brown } else { 307febf1dffSMark Brown wm->pen_is_down = 0; 308febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_POLARITY, pol | 309febf1dffSMark Brown WM97XX_GPIO_13); 310febf1dffSMark Brown } 311febf1dffSMark Brown 312febf1dffSMark Brown if (wm->id == WM9712_ID2) 313febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STATUS, (status & 314febf1dffSMark Brown ~WM97XX_GPIO_13) << 1); 315febf1dffSMark Brown else 316febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STATUS, status & 317febf1dffSMark Brown ~WM97XX_GPIO_13); 318febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 319febf1dffSMark Brown } 320febf1dffSMark Brown 321febf1dffSMark Brown /* If the system is not using continuous mode or it provides a 322febf1dffSMark Brown * pen down operation then we need to schedule polls while the 323febf1dffSMark Brown * pen is down. Otherwise the machine driver is responsible 324febf1dffSMark Brown * for scheduling reads. 325febf1dffSMark Brown */ 326febf1dffSMark Brown if (!wm->mach_ops->acc_enabled || wm->mach_ops->acc_pen_down) { 327febf1dffSMark Brown if (wm->pen_is_down && !pen_was_down) { 328febf1dffSMark Brown /* Data is not availiable immediately on pen down */ 329febf1dffSMark Brown queue_delayed_work(wm->ts_workq, &wm->ts_reader, 1); 330febf1dffSMark Brown } 331febf1dffSMark Brown 332febf1dffSMark Brown /* Let ts_reader report the pen up for debounce. */ 333febf1dffSMark Brown if (!wm->pen_is_down && pen_was_down) 334febf1dffSMark Brown wm->pen_is_down = 1; 335febf1dffSMark Brown } 336febf1dffSMark Brown 337febf1dffSMark Brown if (!wm->pen_is_down && wm->mach_ops->acc_enabled) 338febf1dffSMark Brown wm->mach_ops->acc_pen_up(wm); 339febf1dffSMark Brown 340febf1dffSMark Brown wm->mach_ops->irq_enable(wm, 1); 341febf1dffSMark Brown } 342febf1dffSMark Brown 343febf1dffSMark Brown /* 344febf1dffSMark Brown * Codec PENDOWN irq handler 345febf1dffSMark Brown * 346febf1dffSMark Brown * We have to disable the codec interrupt in the handler because it 347febf1dffSMark Brown * can take upto 1ms to clear the interrupt source. We schedule a task 348d808fbe5SMark Brown * in a work queue to do the actual interaction with the chip. The 349d808fbe5SMark Brown * interrupt is then enabled again in the slow handler when the source 350d808fbe5SMark Brown * has been cleared. 351febf1dffSMark Brown */ 352febf1dffSMark Brown static irqreturn_t wm97xx_pen_interrupt(int irq, void *dev_id) 353febf1dffSMark Brown { 354febf1dffSMark Brown struct wm97xx *wm = dev_id; 355febf1dffSMark Brown 356d808fbe5SMark Brown if (!work_pending(&wm->pen_event_work)) { 357febf1dffSMark Brown wm->mach_ops->irq_enable(wm, 0); 358febf1dffSMark Brown queue_work(wm->ts_workq, &wm->pen_event_work); 359d808fbe5SMark Brown } 360febf1dffSMark Brown 361febf1dffSMark Brown return IRQ_HANDLED; 362febf1dffSMark Brown } 363febf1dffSMark Brown 364febf1dffSMark Brown /* 365febf1dffSMark Brown * initialise pen IRQ handler and workqueue 366febf1dffSMark Brown */ 367febf1dffSMark Brown static int wm97xx_init_pen_irq(struct wm97xx *wm) 368febf1dffSMark Brown { 369febf1dffSMark Brown u16 reg; 370febf1dffSMark Brown 371febf1dffSMark Brown /* If an interrupt is supplied an IRQ enable operation must also be 372febf1dffSMark Brown * provided. */ 373febf1dffSMark Brown BUG_ON(!wm->mach_ops->irq_enable); 374febf1dffSMark Brown 375db7c10e7SMark Brown if (request_irq(wm->pen_irq, wm97xx_pen_interrupt, 376db7c10e7SMark Brown IRQF_SHARED | IRQF_SAMPLE_RANDOM, 377febf1dffSMark Brown "wm97xx-pen", wm)) { 378febf1dffSMark Brown dev_err(wm->dev, 379febf1dffSMark Brown "Failed to register pen down interrupt, polling"); 380febf1dffSMark Brown wm->pen_irq = 0; 381febf1dffSMark Brown return -EINVAL; 382febf1dffSMark Brown } 383febf1dffSMark Brown 384febf1dffSMark Brown /* Configure GPIO as interrupt source on WM971x */ 385febf1dffSMark Brown if (wm->id != WM9705_ID2) { 386febf1dffSMark Brown BUG_ON(!wm->mach_ops->irq_gpio); 387febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_MISC_AFE); 388febf1dffSMark Brown wm97xx_reg_write(wm, AC97_MISC_AFE, 389febf1dffSMark Brown reg & ~(wm->mach_ops->irq_gpio)); 390febf1dffSMark Brown reg = wm97xx_reg_read(wm, 0x5a); 391febf1dffSMark Brown wm97xx_reg_write(wm, 0x5a, reg & ~0x0001); 392febf1dffSMark Brown } 393febf1dffSMark Brown 394febf1dffSMark Brown return 0; 395febf1dffSMark Brown } 396febf1dffSMark Brown 397febf1dffSMark Brown static int wm97xx_read_samples(struct wm97xx *wm) 398febf1dffSMark Brown { 399febf1dffSMark Brown struct wm97xx_data data; 400febf1dffSMark Brown int rc; 401febf1dffSMark Brown 402febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 403febf1dffSMark Brown 404febf1dffSMark Brown if (wm->mach_ops && wm->mach_ops->acc_enabled) 405febf1dffSMark Brown rc = wm->mach_ops->acc_pen_down(wm); 406febf1dffSMark Brown else 407febf1dffSMark Brown rc = wm->codec->poll_touch(wm, &data); 408febf1dffSMark Brown 409febf1dffSMark Brown if (rc & RC_PENUP) { 410febf1dffSMark Brown if (wm->pen_is_down) { 411febf1dffSMark Brown wm->pen_is_down = 0; 412febf1dffSMark Brown dev_dbg(wm->dev, "pen up\n"); 413febf1dffSMark Brown input_report_abs(wm->input_dev, ABS_PRESSURE, 0); 414febf1dffSMark Brown input_sync(wm->input_dev); 415febf1dffSMark Brown } else if (!(rc & RC_AGAIN)) { 416febf1dffSMark Brown /* We need high frequency updates only while 417febf1dffSMark Brown * pen is down, the user never will be able to 418febf1dffSMark Brown * touch screen faster than a few times per 419febf1dffSMark Brown * second... On the other hand, when the user 420febf1dffSMark Brown * is actively working with the touchscreen we 421febf1dffSMark Brown * don't want to lose the quick response. So we 422febf1dffSMark Brown * will slowly increase sleep time after the 423febf1dffSMark Brown * pen is up and quicky restore it to ~one task 424febf1dffSMark Brown * switch when pen is down again. 425febf1dffSMark Brown */ 426febf1dffSMark Brown if (wm->ts_reader_interval < HZ / 10) 427febf1dffSMark Brown wm->ts_reader_interval++; 428febf1dffSMark Brown } 429febf1dffSMark Brown 430febf1dffSMark Brown } else if (rc & RC_VALID) { 431febf1dffSMark Brown dev_dbg(wm->dev, 432febf1dffSMark Brown "pen down: x=%x:%d, y=%x:%d, pressure=%x:%d\n", 433febf1dffSMark Brown data.x >> 12, data.x & 0xfff, data.y >> 12, 434febf1dffSMark Brown data.y & 0xfff, data.p >> 12, data.p & 0xfff); 435febf1dffSMark Brown input_report_abs(wm->input_dev, ABS_X, data.x & 0xfff); 436febf1dffSMark Brown input_report_abs(wm->input_dev, ABS_Y, data.y & 0xfff); 437febf1dffSMark Brown input_report_abs(wm->input_dev, ABS_PRESSURE, data.p & 0xfff); 438febf1dffSMark Brown input_sync(wm->input_dev); 439febf1dffSMark Brown wm->pen_is_down = 1; 440febf1dffSMark Brown wm->ts_reader_interval = wm->ts_reader_min_interval; 441febf1dffSMark Brown } else if (rc & RC_PENDOWN) { 442febf1dffSMark Brown dev_dbg(wm->dev, "pen down\n"); 443febf1dffSMark Brown wm->pen_is_down = 1; 444febf1dffSMark Brown wm->ts_reader_interval = wm->ts_reader_min_interval; 445febf1dffSMark Brown } 446febf1dffSMark Brown 447febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 448febf1dffSMark Brown return rc; 449febf1dffSMark Brown } 450febf1dffSMark Brown 451febf1dffSMark Brown /* 452febf1dffSMark Brown * The touchscreen sample reader. 453febf1dffSMark Brown */ 454febf1dffSMark Brown static void wm97xx_ts_reader(struct work_struct *work) 455febf1dffSMark Brown { 456febf1dffSMark Brown int rc; 457febf1dffSMark Brown struct wm97xx *wm = container_of(work, struct wm97xx, ts_reader.work); 458febf1dffSMark Brown 459febf1dffSMark Brown BUG_ON(!wm->codec); 460febf1dffSMark Brown 461febf1dffSMark Brown do { 462febf1dffSMark Brown rc = wm97xx_read_samples(wm); 463febf1dffSMark Brown } while (rc & RC_AGAIN); 464febf1dffSMark Brown 465febf1dffSMark Brown if (wm->pen_is_down || !wm->pen_irq) 466febf1dffSMark Brown queue_delayed_work(wm->ts_workq, &wm->ts_reader, 467febf1dffSMark Brown wm->ts_reader_interval); 468febf1dffSMark Brown } 469febf1dffSMark Brown 470febf1dffSMark Brown /** 471febf1dffSMark Brown * wm97xx_ts_input_open - Open the touch screen input device. 472febf1dffSMark Brown * @idev: Input device to be opened. 473febf1dffSMark Brown * 474febf1dffSMark Brown * Called by the input sub system to open a wm97xx touchscreen device. 475febf1dffSMark Brown * Starts the touchscreen thread and touch digitiser. 476febf1dffSMark Brown */ 477febf1dffSMark Brown static int wm97xx_ts_input_open(struct input_dev *idev) 478febf1dffSMark Brown { 479febf1dffSMark Brown struct wm97xx *wm = input_get_drvdata(idev); 480febf1dffSMark Brown 481febf1dffSMark Brown wm->ts_workq = create_singlethread_workqueue("kwm97xx"); 482febf1dffSMark Brown if (wm->ts_workq == NULL) { 483febf1dffSMark Brown dev_err(wm->dev, 484febf1dffSMark Brown "Failed to create workqueue\n"); 485febf1dffSMark Brown return -EINVAL; 486febf1dffSMark Brown } 487febf1dffSMark Brown 488febf1dffSMark Brown /* start digitiser */ 489febf1dffSMark Brown if (wm->mach_ops && wm->mach_ops->acc_enabled) 490febf1dffSMark Brown wm->codec->acc_enable(wm, 1); 491febf1dffSMark Brown wm->codec->dig_enable(wm, 1); 492febf1dffSMark Brown 493febf1dffSMark Brown INIT_DELAYED_WORK(&wm->ts_reader, wm97xx_ts_reader); 494febf1dffSMark Brown INIT_WORK(&wm->pen_event_work, wm97xx_pen_irq_worker); 495febf1dffSMark Brown 496febf1dffSMark Brown wm->ts_reader_min_interval = HZ >= 100 ? HZ / 100 : 1; 497febf1dffSMark Brown if (wm->ts_reader_min_interval < 1) 498febf1dffSMark Brown wm->ts_reader_min_interval = 1; 499febf1dffSMark Brown wm->ts_reader_interval = wm->ts_reader_min_interval; 500febf1dffSMark Brown 501febf1dffSMark Brown wm->pen_is_down = 0; 502febf1dffSMark Brown if (wm->pen_irq) 503febf1dffSMark Brown wm97xx_init_pen_irq(wm); 504febf1dffSMark Brown else 505febf1dffSMark Brown dev_err(wm->dev, "No IRQ specified\n"); 506febf1dffSMark Brown 507febf1dffSMark Brown /* If we either don't have an interrupt for pen down events or 508febf1dffSMark Brown * failed to acquire it then we need to poll. 509febf1dffSMark Brown */ 510febf1dffSMark Brown if (wm->pen_irq == 0) 511febf1dffSMark Brown queue_delayed_work(wm->ts_workq, &wm->ts_reader, 512febf1dffSMark Brown wm->ts_reader_interval); 513febf1dffSMark Brown 514febf1dffSMark Brown return 0; 515febf1dffSMark Brown } 516febf1dffSMark Brown 517febf1dffSMark Brown /** 518febf1dffSMark Brown * wm97xx_ts_input_close - Close the touch screen input device. 519febf1dffSMark Brown * @idev: Input device to be closed. 520febf1dffSMark Brown * 521febf1dffSMark Brown * Called by the input sub system to close a wm97xx touchscreen 522febf1dffSMark Brown * device. Kills the touchscreen thread and stops the touch 523febf1dffSMark Brown * digitiser. 524febf1dffSMark Brown */ 525febf1dffSMark Brown 526febf1dffSMark Brown static void wm97xx_ts_input_close(struct input_dev *idev) 527febf1dffSMark Brown { 528febf1dffSMark Brown struct wm97xx *wm = input_get_drvdata(idev); 529febf1dffSMark Brown u16 reg; 530febf1dffSMark Brown 531febf1dffSMark Brown if (wm->pen_irq) { 532febf1dffSMark Brown /* Return the interrupt to GPIO usage (disabling it) */ 533febf1dffSMark Brown if (wm->id != WM9705_ID2) { 534febf1dffSMark Brown BUG_ON(!wm->mach_ops->irq_gpio); 535febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_MISC_AFE); 536febf1dffSMark Brown wm97xx_reg_write(wm, AC97_MISC_AFE, 537febf1dffSMark Brown reg | wm->mach_ops->irq_gpio); 538febf1dffSMark Brown } 539febf1dffSMark Brown 540febf1dffSMark Brown free_irq(wm->pen_irq, wm); 541febf1dffSMark Brown } 542febf1dffSMark Brown 543febf1dffSMark Brown wm->pen_is_down = 0; 544febf1dffSMark Brown 545febf1dffSMark Brown /* Balance out interrupt disables/enables */ 546febf1dffSMark Brown if (cancel_work_sync(&wm->pen_event_work)) 547febf1dffSMark Brown wm->mach_ops->irq_enable(wm, 1); 548febf1dffSMark Brown 549febf1dffSMark Brown /* ts_reader rearms itself so we need to explicitly stop it 550febf1dffSMark Brown * before we destroy the workqueue. 551febf1dffSMark Brown */ 552febf1dffSMark Brown cancel_delayed_work_sync(&wm->ts_reader); 553febf1dffSMark Brown 554febf1dffSMark Brown destroy_workqueue(wm->ts_workq); 555febf1dffSMark Brown 556febf1dffSMark Brown /* stop digitiser */ 557febf1dffSMark Brown wm->codec->dig_enable(wm, 0); 558febf1dffSMark Brown if (wm->mach_ops && wm->mach_ops->acc_enabled) 559febf1dffSMark Brown wm->codec->acc_enable(wm, 0); 560febf1dffSMark Brown } 561febf1dffSMark Brown 562febf1dffSMark Brown static int wm97xx_probe(struct device *dev) 563febf1dffSMark Brown { 564febf1dffSMark Brown struct wm97xx *wm; 565febf1dffSMark Brown int ret = 0, id = 0; 566febf1dffSMark Brown 567febf1dffSMark Brown wm = kzalloc(sizeof(struct wm97xx), GFP_KERNEL); 568febf1dffSMark Brown if (!wm) 569febf1dffSMark Brown return -ENOMEM; 570febf1dffSMark Brown mutex_init(&wm->codec_mutex); 571febf1dffSMark Brown 572febf1dffSMark Brown wm->dev = dev; 573febf1dffSMark Brown dev->driver_data = wm; 574febf1dffSMark Brown wm->ac97 = to_ac97_t(dev); 575febf1dffSMark Brown 576febf1dffSMark Brown /* check that we have a supported codec */ 577febf1dffSMark Brown id = wm97xx_reg_read(wm, AC97_VENDOR_ID1); 578febf1dffSMark Brown if (id != WM97XX_ID1) { 579febf1dffSMark Brown dev_err(dev, "Device with vendor %04x is not a wm97xx\n", id); 580febf1dffSMark Brown ret = -ENODEV; 581febf1dffSMark Brown goto alloc_err; 582febf1dffSMark Brown } 583febf1dffSMark Brown 584febf1dffSMark Brown wm->id = wm97xx_reg_read(wm, AC97_VENDOR_ID2); 585febf1dffSMark Brown 586febf1dffSMark Brown dev_info(wm->dev, "detected a wm97%02x codec\n", wm->id & 0xff); 587febf1dffSMark Brown 588febf1dffSMark Brown switch (wm->id & 0xff) { 589febf1dffSMark Brown #ifdef CONFIG_TOUCHSCREEN_WM9705 590febf1dffSMark Brown case 0x05: 591febf1dffSMark Brown wm->codec = &wm9705_codec; 592febf1dffSMark Brown break; 593febf1dffSMark Brown #endif 594febf1dffSMark Brown #ifdef CONFIG_TOUCHSCREEN_WM9712 595febf1dffSMark Brown case 0x12: 596febf1dffSMark Brown wm->codec = &wm9712_codec; 597febf1dffSMark Brown break; 598febf1dffSMark Brown #endif 599febf1dffSMark Brown #ifdef CONFIG_TOUCHSCREEN_WM9713 600febf1dffSMark Brown case 0x13: 601febf1dffSMark Brown wm->codec = &wm9713_codec; 602febf1dffSMark Brown break; 603febf1dffSMark Brown #endif 604febf1dffSMark Brown default: 605febf1dffSMark Brown dev_err(wm->dev, "Support for wm97%02x not compiled in.\n", 606febf1dffSMark Brown wm->id & 0xff); 607febf1dffSMark Brown ret = -ENODEV; 608febf1dffSMark Brown goto alloc_err; 609febf1dffSMark Brown } 610febf1dffSMark Brown 611*5de4cd43SMark Brown /* set up physical characteristics */ 612*5de4cd43SMark Brown wm->codec->phy_init(wm); 613*5de4cd43SMark Brown 614*5de4cd43SMark Brown /* load gpio cache */ 615*5de4cd43SMark Brown wm->gpio[0] = wm97xx_reg_read(wm, AC97_GPIO_CFG); 616*5de4cd43SMark Brown wm->gpio[1] = wm97xx_reg_read(wm, AC97_GPIO_POLARITY); 617*5de4cd43SMark Brown wm->gpio[2] = wm97xx_reg_read(wm, AC97_GPIO_STICKY); 618*5de4cd43SMark Brown wm->gpio[3] = wm97xx_reg_read(wm, AC97_GPIO_WAKEUP); 619*5de4cd43SMark Brown wm->gpio[4] = wm97xx_reg_read(wm, AC97_GPIO_STATUS); 620*5de4cd43SMark Brown wm->gpio[5] = wm97xx_reg_read(wm, AC97_MISC_AFE); 621*5de4cd43SMark Brown 622febf1dffSMark Brown wm->input_dev = input_allocate_device(); 623febf1dffSMark Brown if (wm->input_dev == NULL) { 624febf1dffSMark Brown ret = -ENOMEM; 625febf1dffSMark Brown goto alloc_err; 626febf1dffSMark Brown } 627febf1dffSMark Brown 628febf1dffSMark Brown /* set up touch configuration */ 629febf1dffSMark Brown wm->input_dev->name = "wm97xx touchscreen"; 6306b32ca39SMark Brown wm->input_dev->phys = "wm97xx"; 631febf1dffSMark Brown wm->input_dev->open = wm97xx_ts_input_open; 632febf1dffSMark Brown wm->input_dev->close = wm97xx_ts_input_close; 633febf1dffSMark Brown set_bit(EV_ABS, wm->input_dev->evbit); 634febf1dffSMark Brown set_bit(ABS_X, wm->input_dev->absbit); 635febf1dffSMark Brown set_bit(ABS_Y, wm->input_dev->absbit); 636febf1dffSMark Brown set_bit(ABS_PRESSURE, wm->input_dev->absbit); 637febf1dffSMark Brown input_set_abs_params(wm->input_dev, ABS_X, abs_x[0], abs_x[1], 638febf1dffSMark Brown abs_x[2], 0); 639febf1dffSMark Brown input_set_abs_params(wm->input_dev, ABS_Y, abs_y[0], abs_y[1], 640febf1dffSMark Brown abs_y[2], 0); 641febf1dffSMark Brown input_set_abs_params(wm->input_dev, ABS_PRESSURE, abs_p[0], abs_p[1], 642febf1dffSMark Brown abs_p[2], 0); 643febf1dffSMark Brown input_set_drvdata(wm->input_dev, wm); 644febf1dffSMark Brown wm->input_dev->dev.parent = dev; 645febf1dffSMark Brown ret = input_register_device(wm->input_dev); 646febf1dffSMark Brown if (ret < 0) 647febf1dffSMark Brown goto dev_alloc_err; 648febf1dffSMark Brown 649febf1dffSMark Brown /* register our battery device */ 650febf1dffSMark Brown wm->battery_dev = platform_device_alloc("wm97xx-battery", -1); 651febf1dffSMark Brown if (!wm->battery_dev) { 652febf1dffSMark Brown ret = -ENOMEM; 653febf1dffSMark Brown goto batt_err; 654febf1dffSMark Brown } 655febf1dffSMark Brown platform_set_drvdata(wm->battery_dev, wm); 656febf1dffSMark Brown wm->battery_dev->dev.parent = dev; 657febf1dffSMark Brown ret = platform_device_add(wm->battery_dev); 658febf1dffSMark Brown if (ret < 0) 659febf1dffSMark Brown goto batt_reg_err; 660febf1dffSMark Brown 661febf1dffSMark Brown /* register our extended touch device (for machine specific 662febf1dffSMark Brown * extensions) */ 663febf1dffSMark Brown wm->touch_dev = platform_device_alloc("wm97xx-touch", -1); 664febf1dffSMark Brown if (!wm->touch_dev) { 665febf1dffSMark Brown ret = -ENOMEM; 666febf1dffSMark Brown goto touch_err; 667febf1dffSMark Brown } 668febf1dffSMark Brown platform_set_drvdata(wm->touch_dev, wm); 669febf1dffSMark Brown wm->touch_dev->dev.parent = dev; 670febf1dffSMark Brown ret = platform_device_add(wm->touch_dev); 671febf1dffSMark Brown if (ret < 0) 672febf1dffSMark Brown goto touch_reg_err; 673febf1dffSMark Brown 674febf1dffSMark Brown return ret; 675febf1dffSMark Brown 676febf1dffSMark Brown touch_reg_err: 677febf1dffSMark Brown platform_device_put(wm->touch_dev); 678febf1dffSMark Brown touch_err: 679febf1dffSMark Brown platform_device_unregister(wm->battery_dev); 680febf1dffSMark Brown wm->battery_dev = NULL; 681febf1dffSMark Brown batt_reg_err: 682febf1dffSMark Brown platform_device_put(wm->battery_dev); 683febf1dffSMark Brown batt_err: 684febf1dffSMark Brown input_unregister_device(wm->input_dev); 685febf1dffSMark Brown wm->input_dev = NULL; 686febf1dffSMark Brown dev_alloc_err: 687febf1dffSMark Brown input_free_device(wm->input_dev); 688febf1dffSMark Brown alloc_err: 689febf1dffSMark Brown kfree(wm); 690febf1dffSMark Brown 691febf1dffSMark Brown return ret; 692febf1dffSMark Brown } 693febf1dffSMark Brown 694febf1dffSMark Brown static int wm97xx_remove(struct device *dev) 695febf1dffSMark Brown { 696febf1dffSMark Brown struct wm97xx *wm = dev_get_drvdata(dev); 697febf1dffSMark Brown 698febf1dffSMark Brown platform_device_unregister(wm->battery_dev); 699febf1dffSMark Brown platform_device_unregister(wm->touch_dev); 700febf1dffSMark Brown input_unregister_device(wm->input_dev); 701febf1dffSMark Brown kfree(wm); 702febf1dffSMark Brown 703febf1dffSMark Brown return 0; 704febf1dffSMark Brown } 705febf1dffSMark Brown 706febf1dffSMark Brown #ifdef CONFIG_PM 707febf1dffSMark Brown static int wm97xx_suspend(struct device *dev, pm_message_t state) 708febf1dffSMark Brown { 709febf1dffSMark Brown struct wm97xx *wm = dev_get_drvdata(dev); 71034d27853SMark Brown u16 reg; 71134d27853SMark Brown int suspend_mode; 71234d27853SMark Brown 71334d27853SMark Brown if (device_may_wakeup(&wm->input_dev->dev)) 71434d27853SMark Brown suspend_mode = wm->suspend_mode; 71534d27853SMark Brown else 71634d27853SMark Brown suspend_mode = 0; 717febf1dffSMark Brown 718febf1dffSMark Brown if (wm->input_dev->users) 719febf1dffSMark Brown cancel_delayed_work_sync(&wm->ts_reader); 720febf1dffSMark Brown 72134d27853SMark Brown /* Power down the digitiser (bypassing the cache for resume) */ 72234d27853SMark Brown reg = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER2); 72334d27853SMark Brown reg &= ~WM97XX_PRP_DET_DIG; 72434d27853SMark Brown if (wm->input_dev->users) 72534d27853SMark Brown reg |= suspend_mode; 72634d27853SMark Brown wm->ac97->bus->ops->write(wm->ac97, AC97_WM97XX_DIGITISER2, reg); 72734d27853SMark Brown 72834d27853SMark Brown /* WM9713 has an additional power bit - turn it off if there 72934d27853SMark Brown * are no users or if suspend mode is zero. */ 73034d27853SMark Brown if (wm->id == WM9713_ID2 && 73134d27853SMark Brown (!wm->input_dev->users || !suspend_mode)) { 73234d27853SMark Brown reg = wm97xx_reg_read(wm, AC97_EXTENDED_MID) | 0x8000; 73334d27853SMark Brown wm97xx_reg_write(wm, AC97_EXTENDED_MID, reg); 73434d27853SMark Brown } 73534d27853SMark Brown 736febf1dffSMark Brown return 0; 737febf1dffSMark Brown } 738febf1dffSMark Brown 739febf1dffSMark Brown static int wm97xx_resume(struct device *dev) 740febf1dffSMark Brown { 741febf1dffSMark Brown struct wm97xx *wm = dev_get_drvdata(dev); 742febf1dffSMark Brown 743febf1dffSMark Brown /* restore digitiser and gpios */ 744febf1dffSMark Brown if (wm->id == WM9713_ID2) { 745febf1dffSMark Brown wm97xx_reg_write(wm, AC97_WM9713_DIG1, wm->dig[0]); 746febf1dffSMark Brown wm97xx_reg_write(wm, 0x5a, wm->misc); 747febf1dffSMark Brown if (wm->input_dev->users) { 748febf1dffSMark Brown u16 reg; 749febf1dffSMark Brown reg = wm97xx_reg_read(wm, AC97_EXTENDED_MID) & 0x7fff; 750febf1dffSMark Brown wm97xx_reg_write(wm, AC97_EXTENDED_MID, reg); 751febf1dffSMark Brown } 752febf1dffSMark Brown } 753febf1dffSMark Brown 754febf1dffSMark Brown wm97xx_reg_write(wm, AC97_WM9713_DIG2, wm->dig[1]); 755febf1dffSMark Brown wm97xx_reg_write(wm, AC97_WM9713_DIG3, wm->dig[2]); 756febf1dffSMark Brown 757febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_CFG, wm->gpio[0]); 758febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_POLARITY, wm->gpio[1]); 759febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STICKY, wm->gpio[2]); 760febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_WAKEUP, wm->gpio[3]); 761febf1dffSMark Brown wm97xx_reg_write(wm, AC97_GPIO_STATUS, wm->gpio[4]); 762febf1dffSMark Brown wm97xx_reg_write(wm, AC97_MISC_AFE, wm->gpio[5]); 763febf1dffSMark Brown 764febf1dffSMark Brown if (wm->input_dev->users && !wm->pen_irq) { 765febf1dffSMark Brown wm->ts_reader_interval = wm->ts_reader_min_interval; 766febf1dffSMark Brown queue_delayed_work(wm->ts_workq, &wm->ts_reader, 767febf1dffSMark Brown wm->ts_reader_interval); 768febf1dffSMark Brown } 769febf1dffSMark Brown 770febf1dffSMark Brown return 0; 771febf1dffSMark Brown } 772febf1dffSMark Brown 773febf1dffSMark Brown #else 774febf1dffSMark Brown #define wm97xx_suspend NULL 775febf1dffSMark Brown #define wm97xx_resume NULL 776febf1dffSMark Brown #endif 777febf1dffSMark Brown 778febf1dffSMark Brown /* 779febf1dffSMark Brown * Machine specific operations 780febf1dffSMark Brown */ 781febf1dffSMark Brown int wm97xx_register_mach_ops(struct wm97xx *wm, 782febf1dffSMark Brown struct wm97xx_mach_ops *mach_ops) 783febf1dffSMark Brown { 784febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 785febf1dffSMark Brown if (wm->mach_ops) { 786febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 787febf1dffSMark Brown return -EINVAL; 788febf1dffSMark Brown } 789febf1dffSMark Brown wm->mach_ops = mach_ops; 790febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 791febf1dffSMark Brown 792febf1dffSMark Brown return 0; 793febf1dffSMark Brown } 794febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_register_mach_ops); 795febf1dffSMark Brown 796febf1dffSMark Brown void wm97xx_unregister_mach_ops(struct wm97xx *wm) 797febf1dffSMark Brown { 798febf1dffSMark Brown mutex_lock(&wm->codec_mutex); 799febf1dffSMark Brown wm->mach_ops = NULL; 800febf1dffSMark Brown mutex_unlock(&wm->codec_mutex); 801febf1dffSMark Brown } 802febf1dffSMark Brown EXPORT_SYMBOL_GPL(wm97xx_unregister_mach_ops); 803febf1dffSMark Brown 804febf1dffSMark Brown static struct device_driver wm97xx_driver = { 805ef9db492SMark Brown .name = "wm97xx-ts", 806febf1dffSMark Brown .bus = &ac97_bus_type, 807febf1dffSMark Brown .owner = THIS_MODULE, 808febf1dffSMark Brown .probe = wm97xx_probe, 809febf1dffSMark Brown .remove = wm97xx_remove, 810febf1dffSMark Brown .suspend = wm97xx_suspend, 811febf1dffSMark Brown .resume = wm97xx_resume, 812febf1dffSMark Brown }; 813febf1dffSMark Brown 814febf1dffSMark Brown static int __init wm97xx_init(void) 815febf1dffSMark Brown { 816febf1dffSMark Brown return driver_register(&wm97xx_driver); 817febf1dffSMark Brown } 818febf1dffSMark Brown 819febf1dffSMark Brown static void __exit wm97xx_exit(void) 820febf1dffSMark Brown { 821febf1dffSMark Brown driver_unregister(&wm97xx_driver); 822febf1dffSMark Brown } 823febf1dffSMark Brown 824febf1dffSMark Brown module_init(wm97xx_init); 825febf1dffSMark Brown module_exit(wm97xx_exit); 826febf1dffSMark Brown 827febf1dffSMark Brown /* Module information */ 828febf1dffSMark Brown MODULE_AUTHOR("Liam Girdwood <liam.girdwood@wolfsonmicro.com>"); 829febf1dffSMark Brown MODULE_DESCRIPTION("WM97xx Core - Touch Screen / AUX ADC / GPIO Driver"); 830febf1dffSMark Brown MODULE_LICENSE("GPL"); 831