Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 1 | /* |
| 2 | * twl6030-irq.c - TWL6030 irq support |
| 3 | * |
| 4 | * Copyright (C) 2005-2009 Texas Instruments, Inc. |
| 5 | * |
| 6 | * Modifications to defer interrupt handling to a kernel thread: |
| 7 | * Copyright (C) 2006 MontaVista Software, Inc. |
| 8 | * |
| 9 | * Based on tlv320aic23.c: |
| 10 | * Copyright (c) by Kai Svahn <kai.svahn@nokia.com> |
| 11 | * |
| 12 | * Code cleanup and modifications to IRQ handler. |
| 13 | * by syed khasim <x0khasim@ti.com> |
| 14 | * |
| 15 | * TWL6030 specific code and IRQ handling changes by |
| 16 | * Jagadeesh Bhaskar Pakaravoor <j-pakaravoor@ti.com> |
| 17 | * Balaji T K <balajitk@ti.com> |
| 18 | * |
| 19 | * This program is free software; you can redistribute it and/or modify |
| 20 | * it under the terms of the GNU General Public License as published by |
| 21 | * the Free Software Foundation; either version 2 of the License, or |
| 22 | * (at your option) any later version. |
| 23 | * |
| 24 | * This program is distributed in the hope that it will be useful, |
| 25 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 26 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 27 | * GNU General Public License for more details. |
| 28 | * |
| 29 | * You should have received a copy of the GNU General Public License |
| 30 | * along with this program; if not, write to the Free Software |
| 31 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 32 | */ |
| 33 | |
| 34 | #include <linux/init.h> |
Paul Gortmaker | 5d4a357 | 2011-07-10 12:41:10 -0400 | [diff] [blame] | 35 | #include <linux/export.h> |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 36 | #include <linux/interrupt.h> |
| 37 | #include <linux/irq.h> |
| 38 | #include <linux/kthread.h> |
| 39 | #include <linux/i2c/twl.h> |
kishore kadiyala | 72f2e2c | 2010-09-24 17:13:20 +0000 | [diff] [blame] | 40 | #include <linux/platform_device.h> |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 41 | #include <linux/suspend.h> |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 42 | |
G, Manjunath Kondaiah | b0b4a7c | 2010-10-19 11:02:48 +0200 | [diff] [blame] | 43 | #include "twl-core.h" |
| 44 | |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 45 | /* |
| 46 | * TWL6030 (unlike its predecessors, which had two level interrupt handling) |
| 47 | * three interrupt registers INT_STS_A, INT_STS_B and INT_STS_C. |
| 48 | * It exposes status bits saying who has raised an interrupt. There are |
| 49 | * three mask registers that corresponds to these status registers, that |
| 50 | * enables/disables these interrupts. |
| 51 | * |
| 52 | * We set up IRQs starting at a platform-specified base. An interrupt map table, |
| 53 | * specifies mapping between interrupt number and the associated module. |
| 54 | * |
| 55 | */ |
| 56 | |
| 57 | static int twl6030_interrupt_mapping[24] = { |
| 58 | PWR_INTR_OFFSET, /* Bit 0 PWRON */ |
| 59 | PWR_INTR_OFFSET, /* Bit 1 RPWRON */ |
| 60 | PWR_INTR_OFFSET, /* Bit 2 BAT_VLOW */ |
| 61 | RTC_INTR_OFFSET, /* Bit 3 RTC_ALARM */ |
| 62 | RTC_INTR_OFFSET, /* Bit 4 RTC_PERIOD */ |
| 63 | HOTDIE_INTR_OFFSET, /* Bit 5 HOT_DIE */ |
| 64 | SMPSLDO_INTR_OFFSET, /* Bit 6 VXXX_SHORT */ |
| 65 | SMPSLDO_INTR_OFFSET, /* Bit 7 VMMC_SHORT */ |
| 66 | |
| 67 | SMPSLDO_INTR_OFFSET, /* Bit 8 VUSIM_SHORT */ |
| 68 | BATDETECT_INTR_OFFSET, /* Bit 9 BAT */ |
| 69 | SIMDETECT_INTR_OFFSET, /* Bit 10 SIM */ |
| 70 | MMCDETECT_INTR_OFFSET, /* Bit 11 MMC */ |
| 71 | RSV_INTR_OFFSET, /* Bit 12 Reserved */ |
| 72 | MADC_INTR_OFFSET, /* Bit 13 GPADC_RT_EOC */ |
| 73 | MADC_INTR_OFFSET, /* Bit 14 GPADC_SW_EOC */ |
| 74 | GASGAUGE_INTR_OFFSET, /* Bit 15 CC_AUTOCAL */ |
| 75 | |
| 76 | USBOTG_INTR_OFFSET, /* Bit 16 ID_WKUP */ |
| 77 | USBOTG_INTR_OFFSET, /* Bit 17 VBUS_WKUP */ |
| 78 | USBOTG_INTR_OFFSET, /* Bit 18 ID */ |
Hema HK | 77b1d3f | 2010-12-10 17:55:37 +0530 | [diff] [blame] | 79 | USB_PRES_INTR_OFFSET, /* Bit 19 VBUS */ |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 80 | CHARGER_INTR_OFFSET, /* Bit 20 CHRG_CTRL */ |
Graeme Gregory | 6523b14 | 2011-05-12 14:27:56 +0100 | [diff] [blame] | 81 | CHARGERFAULT_INTR_OFFSET, /* Bit 21 EXT_CHRG */ |
| 82 | CHARGERFAULT_INTR_OFFSET, /* Bit 22 INT_CHRG */ |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 83 | RSV_INTR_OFFSET, /* Bit 23 Reserved */ |
| 84 | }; |
| 85 | /*----------------------------------------------------------------------*/ |
| 86 | |
| 87 | static unsigned twl6030_irq_base; |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 88 | static int twl_irq; |
| 89 | static bool twl_irq_wake_enabled; |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 90 | |
| 91 | static struct completion irq_event; |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 92 | static atomic_t twl6030_wakeirqs = ATOMIC_INIT(0); |
| 93 | |
| 94 | static int twl6030_irq_pm_notifier(struct notifier_block *notifier, |
| 95 | unsigned long pm_event, void *unused) |
| 96 | { |
| 97 | int chained_wakeups; |
| 98 | |
| 99 | switch (pm_event) { |
| 100 | case PM_SUSPEND_PREPARE: |
| 101 | chained_wakeups = atomic_read(&twl6030_wakeirqs); |
| 102 | |
| 103 | if (chained_wakeups && !twl_irq_wake_enabled) { |
| 104 | if (enable_irq_wake(twl_irq)) |
| 105 | pr_err("twl6030 IRQ wake enable failed\n"); |
| 106 | else |
| 107 | twl_irq_wake_enabled = true; |
| 108 | } else if (!chained_wakeups && twl_irq_wake_enabled) { |
| 109 | disable_irq_wake(twl_irq); |
| 110 | twl_irq_wake_enabled = false; |
| 111 | } |
| 112 | |
Todd Poynor | 782baa2 | 2011-09-26 16:44:24 -0700 | [diff] [blame] | 113 | disable_irq(twl_irq); |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 114 | break; |
Todd Poynor | 782baa2 | 2011-09-26 16:44:24 -0700 | [diff] [blame] | 115 | |
| 116 | case PM_POST_SUSPEND: |
| 117 | enable_irq(twl_irq); |
| 118 | break; |
| 119 | |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 120 | default: |
| 121 | break; |
| 122 | } |
| 123 | |
| 124 | return NOTIFY_DONE; |
| 125 | } |
| 126 | |
| 127 | static struct notifier_block twl6030_irq_pm_notifier_block = { |
| 128 | .notifier_call = twl6030_irq_pm_notifier, |
| 129 | }; |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 130 | |
| 131 | /* |
| 132 | * This thread processes interrupts reported by the Primary Interrupt Handler. |
| 133 | */ |
| 134 | static int twl6030_irq_thread(void *data) |
| 135 | { |
| 136 | long irq = (long)data; |
| 137 | static unsigned i2c_errors; |
| 138 | static const unsigned max_i2c_errors = 100; |
| 139 | int ret; |
| 140 | |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 141 | while (!kthread_should_stop()) { |
| 142 | int i; |
| 143 | union { |
| 144 | u8 bytes[4]; |
| 145 | u32 int_sts; |
| 146 | } sts; |
| 147 | |
| 148 | /* Wait for IRQ, then read PIH irq status (also blocking) */ |
| 149 | wait_for_completion_interruptible(&irq_event); |
| 150 | |
| 151 | /* read INT_STS_A, B and C in one shot using a burst read */ |
| 152 | ret = twl_i2c_read(TWL_MODULE_PIH, sts.bytes, |
| 153 | REG_INT_STS_A, 3); |
| 154 | if (ret) { |
| 155 | pr_warning("twl6030: I2C error %d reading PIH ISR\n", |
| 156 | ret); |
| 157 | if (++i2c_errors >= max_i2c_errors) { |
| 158 | printk(KERN_ERR "Maximum I2C error count" |
| 159 | " exceeded. Terminating %s.\n", |
| 160 | __func__); |
| 161 | break; |
| 162 | } |
| 163 | complete(&irq_event); |
| 164 | continue; |
| 165 | } |
| 166 | |
| 167 | |
| 168 | |
| 169 | sts.bytes[3] = 0; /* Only 24 bits are valid*/ |
| 170 | |
Hema HK | 77b1d3f | 2010-12-10 17:55:37 +0530 | [diff] [blame] | 171 | /* |
| 172 | * Since VBUS status bit is not reliable for VBUS disconnect |
| 173 | * use CHARGER VBUS detection status bit instead. |
| 174 | */ |
| 175 | if (sts.bytes[2] & 0x10) |
| 176 | sts.bytes[2] |= 0x08; |
| 177 | |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 178 | for (i = 0; sts.int_sts; sts.int_sts >>= 1, i++) { |
| 179 | local_irq_disable(); |
| 180 | if (sts.int_sts & 0x1) { |
| 181 | int module_irq = twl6030_irq_base + |
| 182 | twl6030_interrupt_mapping[i]; |
Thomas Gleixner | c22435a | 2011-03-25 11:12:31 +0000 | [diff] [blame] | 183 | generic_handle_irq(module_irq); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 184 | |
| 185 | } |
| 186 | local_irq_enable(); |
| 187 | } |
| 188 | ret = twl_i2c_write(TWL_MODULE_PIH, sts.bytes, |
| 189 | REG_INT_STS_A, 3); /* clear INT_STS_A */ |
| 190 | if (ret) |
| 191 | pr_warning("twl6030: I2C error in clearing PIH ISR\n"); |
| 192 | |
| 193 | enable_irq(irq); |
| 194 | } |
| 195 | |
| 196 | return 0; |
| 197 | } |
| 198 | |
| 199 | /* |
| 200 | * handle_twl6030_int() is the desc->handle method for the twl6030 interrupt. |
| 201 | * This is a chained interrupt, so there is no desc->action method for it. |
| 202 | * Now we need to query the interrupt controller in the twl6030 to determine |
| 203 | * which module is generating the interrupt request. However, we can't do i2c |
| 204 | * transactions in interrupt context, so we must defer that work to a kernel |
| 205 | * thread. All we do here is acknowledge and mask the interrupt and wakeup |
| 206 | * the kernel thread. |
| 207 | */ |
| 208 | static irqreturn_t handle_twl6030_pih(int irq, void *devid) |
| 209 | { |
| 210 | disable_irq_nosync(irq); |
| 211 | complete(devid); |
| 212 | return IRQ_HANDLED; |
| 213 | } |
| 214 | |
| 215 | /*----------------------------------------------------------------------*/ |
| 216 | |
| 217 | static inline void activate_irq(int irq) |
| 218 | { |
| 219 | #ifdef CONFIG_ARM |
| 220 | /* ARM requires an extra step to clear IRQ_NOREQUEST, which it |
| 221 | * sets on behalf of every irq_chip. Also sets IRQ_NOPROBE. |
| 222 | */ |
| 223 | set_irq_flags(irq, IRQF_VALID); |
| 224 | #else |
| 225 | /* same effect on other architectures */ |
Thomas Gleixner | d5bb122 | 2011-03-25 11:12:32 +0000 | [diff] [blame] | 226 | irq_set_noprobe(irq); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 227 | #endif |
| 228 | } |
| 229 | |
Santosh Shilimkar | 49dcd07 | 2011-09-06 21:29:30 +0530 | [diff] [blame] | 230 | int twl6030_irq_set_wake(struct irq_data *d, unsigned int on) |
| 231 | { |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 232 | if (on) |
| 233 | atomic_inc(&twl6030_wakeirqs); |
| 234 | else |
| 235 | atomic_dec(&twl6030_wakeirqs); |
Santosh Shilimkar | 49dcd07 | 2011-09-06 21:29:30 +0530 | [diff] [blame] | 236 | |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 237 | return 0; |
Santosh Shilimkar | 49dcd07 | 2011-09-06 21:29:30 +0530 | [diff] [blame] | 238 | } |
| 239 | |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 240 | /*----------------------------------------------------------------------*/ |
| 241 | |
| 242 | static unsigned twl6030_irq_next; |
| 243 | |
| 244 | /*----------------------------------------------------------------------*/ |
| 245 | int twl6030_interrupt_unmask(u8 bit_mask, u8 offset) |
| 246 | { |
| 247 | int ret; |
| 248 | u8 unmask_value; |
| 249 | ret = twl_i2c_read_u8(TWL_MODULE_PIH, &unmask_value, |
| 250 | REG_INT_STS_A + offset); |
| 251 | unmask_value &= (~(bit_mask)); |
| 252 | ret |= twl_i2c_write_u8(TWL_MODULE_PIH, unmask_value, |
| 253 | REG_INT_STS_A + offset); /* unmask INT_MSK_A/B/C */ |
| 254 | return ret; |
| 255 | } |
| 256 | EXPORT_SYMBOL(twl6030_interrupt_unmask); |
| 257 | |
| 258 | int twl6030_interrupt_mask(u8 bit_mask, u8 offset) |
| 259 | { |
| 260 | int ret; |
| 261 | u8 mask_value; |
| 262 | ret = twl_i2c_read_u8(TWL_MODULE_PIH, &mask_value, |
| 263 | REG_INT_STS_A + offset); |
| 264 | mask_value |= (bit_mask); |
| 265 | ret |= twl_i2c_write_u8(TWL_MODULE_PIH, mask_value, |
| 266 | REG_INT_STS_A + offset); /* mask INT_MSK_A/B/C */ |
| 267 | return ret; |
| 268 | } |
| 269 | EXPORT_SYMBOL(twl6030_interrupt_mask); |
| 270 | |
kishore kadiyala | 72f2e2c | 2010-09-24 17:13:20 +0000 | [diff] [blame] | 271 | int twl6030_mmc_card_detect_config(void) |
| 272 | { |
| 273 | int ret; |
| 274 | u8 reg_val = 0; |
| 275 | |
| 276 | /* Unmasking the Card detect Interrupt line for MMC1 from Phoenix */ |
| 277 | twl6030_interrupt_unmask(TWL6030_MMCDETECT_INT_MASK, |
| 278 | REG_INT_MSK_LINE_B); |
| 279 | twl6030_interrupt_unmask(TWL6030_MMCDETECT_INT_MASK, |
| 280 | REG_INT_MSK_STS_B); |
| 281 | /* |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 282 | * Initially Configuring MMC_CTRL for receiving interrupts & |
kishore kadiyala | 72f2e2c | 2010-09-24 17:13:20 +0000 | [diff] [blame] | 283 | * Card status on TWL6030 for MMC1 |
| 284 | */ |
| 285 | ret = twl_i2c_read_u8(TWL6030_MODULE_ID0, ®_val, TWL6030_MMCCTRL); |
| 286 | if (ret < 0) { |
| 287 | pr_err("twl6030: Failed to read MMCCTRL, error %d\n", ret); |
| 288 | return ret; |
| 289 | } |
| 290 | reg_val &= ~VMMC_AUTO_OFF; |
| 291 | reg_val |= SW_FC; |
| 292 | ret = twl_i2c_write_u8(TWL6030_MODULE_ID0, reg_val, TWL6030_MMCCTRL); |
| 293 | if (ret < 0) { |
| 294 | pr_err("twl6030: Failed to write MMCCTRL, error %d\n", ret); |
| 295 | return ret; |
| 296 | } |
| 297 | |
| 298 | /* Configuring PullUp-PullDown register */ |
| 299 | ret = twl_i2c_read_u8(TWL6030_MODULE_ID0, ®_val, |
| 300 | TWL6030_CFG_INPUT_PUPD3); |
| 301 | if (ret < 0) { |
| 302 | pr_err("twl6030: Failed to read CFG_INPUT_PUPD3, error %d\n", |
| 303 | ret); |
| 304 | return ret; |
| 305 | } |
| 306 | reg_val &= ~(MMC_PU | MMC_PD); |
| 307 | ret = twl_i2c_write_u8(TWL6030_MODULE_ID0, reg_val, |
| 308 | TWL6030_CFG_INPUT_PUPD3); |
| 309 | if (ret < 0) { |
| 310 | pr_err("twl6030: Failed to write CFG_INPUT_PUPD3, error %d\n", |
| 311 | ret); |
| 312 | return ret; |
| 313 | } |
| 314 | return 0; |
| 315 | } |
| 316 | EXPORT_SYMBOL(twl6030_mmc_card_detect_config); |
| 317 | |
| 318 | int twl6030_mmc_card_detect(struct device *dev, int slot) |
| 319 | { |
| 320 | int ret = -EIO; |
| 321 | u8 read_reg = 0; |
| 322 | struct platform_device *pdev = to_platform_device(dev); |
| 323 | |
| 324 | if (pdev->id) { |
| 325 | /* TWL6030 provide's Card detect support for |
| 326 | * only MMC1 controller. |
| 327 | */ |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 328 | pr_err("Unknown MMC controller %d in %s\n", pdev->id, __func__); |
kishore kadiyala | 72f2e2c | 2010-09-24 17:13:20 +0000 | [diff] [blame] | 329 | return ret; |
| 330 | } |
| 331 | /* |
| 332 | * BIT0 of MMC_CTRL on TWL6030 provides card status for MMC1 |
| 333 | * 0 - Card not present ,1 - Card present |
| 334 | */ |
| 335 | ret = twl_i2c_read_u8(TWL6030_MODULE_ID0, &read_reg, |
| 336 | TWL6030_MMCCTRL); |
| 337 | if (ret >= 0) |
| 338 | ret = read_reg & STS_MMC; |
| 339 | return ret; |
| 340 | } |
| 341 | EXPORT_SYMBOL(twl6030_mmc_card_detect); |
| 342 | |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 343 | int twl6030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end) |
| 344 | { |
| 345 | |
| 346 | int status = 0; |
| 347 | int i; |
| 348 | struct task_struct *task; |
| 349 | int ret; |
| 350 | u8 mask[4]; |
| 351 | |
| 352 | static struct irq_chip twl6030_irq_chip; |
| 353 | mask[1] = 0xFF; |
| 354 | mask[2] = 0xFF; |
| 355 | mask[3] = 0xFF; |
| 356 | ret = twl_i2c_write(TWL_MODULE_PIH, &mask[0], |
| 357 | REG_INT_MSK_LINE_A, 3); /* MASK ALL INT LINES */ |
| 358 | ret = twl_i2c_write(TWL_MODULE_PIH, &mask[0], |
| 359 | REG_INT_MSK_STS_A, 3); /* MASK ALL INT STS */ |
| 360 | ret = twl_i2c_write(TWL_MODULE_PIH, &mask[0], |
| 361 | REG_INT_STS_A, 3); /* clear INT_STS_A,B,C */ |
| 362 | |
| 363 | twl6030_irq_base = irq_base; |
| 364 | |
| 365 | /* install an irq handler for each of the modules; |
| 366 | * clone dummy irq_chip since PIH can't *do* anything |
| 367 | */ |
| 368 | twl6030_irq_chip = dummy_irq_chip; |
| 369 | twl6030_irq_chip.name = "twl6030"; |
Lennert Buytenhek | c45c685 | 2010-12-13 13:31:18 +0100 | [diff] [blame] | 370 | twl6030_irq_chip.irq_set_type = NULL; |
Santosh Shilimkar | 49dcd07 | 2011-09-06 21:29:30 +0530 | [diff] [blame] | 371 | twl6030_irq_chip.irq_set_wake = twl6030_irq_set_wake; |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 372 | |
| 373 | for (i = irq_base; i < irq_end; i++) { |
Thomas Gleixner | d5bb122 | 2011-03-25 11:12:32 +0000 | [diff] [blame] | 374 | irq_set_chip_and_handler(i, &twl6030_irq_chip, |
| 375 | handle_simple_irq); |
Santosh Shilimkar | 49dcd07 | 2011-09-06 21:29:30 +0530 | [diff] [blame] | 376 | irq_set_chip_data(i, (void *)irq_num); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 377 | activate_irq(i); |
| 378 | } |
| 379 | |
| 380 | twl6030_irq_next = i; |
| 381 | pr_info("twl6030: %s (irq %d) chaining IRQs %d..%d\n", "PIH", |
| 382 | irq_num, irq_base, twl6030_irq_next - 1); |
| 383 | |
| 384 | /* install an irq handler to demultiplex the TWL6030 interrupt */ |
| 385 | init_completion(&irq_event); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 386 | |
Yong Zhang | f742b96 | 2011-09-15 21:52:09 +0200 | [diff] [blame] | 387 | status = request_irq(irq_num, handle_twl6030_pih, 0, |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 388 | "TWL6030-PIH", &irq_event); |
| 389 | if (status < 0) { |
| 390 | pr_err("twl6030: could not claim irq%d: %d\n", irq_num, status); |
| 391 | goto fail_irq; |
| 392 | } |
Axel Lin | 862de70 | 2011-08-11 15:21:00 +0800 | [diff] [blame] | 393 | |
| 394 | task = kthread_run(twl6030_irq_thread, (void *)irq_num, "twl6030-irq"); |
| 395 | if (IS_ERR(task)) { |
| 396 | pr_err("twl6030: could not create irq %d thread!\n", irq_num); |
| 397 | status = PTR_ERR(task); |
| 398 | goto fail_kthread; |
| 399 | } |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 400 | |
| 401 | twl_irq = irq_num; |
| 402 | register_pm_notifier(&twl6030_irq_pm_notifier_block); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 403 | return status; |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 404 | |
| 405 | fail_kthread: |
Axel Lin | 862de70 | 2011-08-11 15:21:00 +0800 | [diff] [blame] | 406 | free_irq(irq_num, &irq_event); |
| 407 | |
| 408 | fail_irq: |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 409 | for (i = irq_base; i < irq_end; i++) |
Thomas Gleixner | d5bb122 | 2011-03-25 11:12:32 +0000 | [diff] [blame] | 410 | irq_set_chip_and_handler(i, NULL, NULL); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 411 | return status; |
| 412 | } |
| 413 | |
| 414 | int twl6030_exit_irq(void) |
| 415 | { |
Todd Poynor | ab2b926 | 2011-10-04 11:52:29 +0200 | [diff] [blame] | 416 | unregister_pm_notifier(&twl6030_irq_pm_notifier_block); |
Balaji T K | e8deb28 | 2009-12-14 00:25:31 +0100 | [diff] [blame] | 417 | |
| 418 | if (twl6030_irq_base) { |
| 419 | pr_err("twl6030: can't yet clean up IRQs?\n"); |
| 420 | return -ENOSYS; |
| 421 | } |
| 422 | return 0; |
| 423 | } |
| 424 | |