| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * linux/kernel/irq/manage.c | 
|  | 3 | * | 
| Ingo Molnar | a34db9b | 2006-06-29 02:24:50 -0700 | [diff] [blame] | 4 | * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar | 
|  | 5 | * Copyright (C) 2005-2006 Thomas Gleixner | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | * | 
|  | 7 | * This file contains driver APIs to the irq subsystem. | 
|  | 8 | */ | 
|  | 9 |  | 
|  | 10 | #include <linux/irq.h> | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 11 | #include <linux/kthread.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | #include <linux/module.h> | 
|  | 13 | #include <linux/random.h> | 
|  | 14 | #include <linux/interrupt.h> | 
| Robert P. J. Day | 1aeb272 | 2008-04-29 00:59:25 -0700 | [diff] [blame] | 15 | #include <linux/slab.h> | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 16 | #include <linux/sched.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 |  | 
|  | 18 | #include "internals.h" | 
|  | 19 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | /** | 
|  | 21 | *	synchronize_irq - wait for pending IRQ handlers (on other CPUs) | 
| Randy Dunlap | 1e5d533 | 2005-11-07 01:01:06 -0800 | [diff] [blame] | 22 | *	@irq: interrupt number to wait for | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | * | 
|  | 24 | *	This function waits for any pending IRQ handlers for this interrupt | 
|  | 25 | *	to complete before returning. If you use this function while | 
|  | 26 | *	holding a resource the IRQ handler may need you will deadlock. | 
|  | 27 | * | 
|  | 28 | *	This function may be called - with care - from IRQ context. | 
|  | 29 | */ | 
|  | 30 | void synchronize_irq(unsigned int irq) | 
|  | 31 | { | 
| Yinghai Lu | cb5bc83 | 2008-08-19 20:50:17 -0700 | [diff] [blame] | 32 | struct irq_desc *desc = irq_to_desc(irq); | 
| Herbert Xu | a98ce5c | 2007-10-23 11:26:25 +0800 | [diff] [blame] | 33 | unsigned int status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 35 | if (!desc) | 
| Matthew Wilcox | c2b5a25 | 2005-11-03 07:51:18 -0700 | [diff] [blame] | 36 | return; | 
|  | 37 |  | 
| Herbert Xu | a98ce5c | 2007-10-23 11:26:25 +0800 | [diff] [blame] | 38 | do { | 
|  | 39 | unsigned long flags; | 
|  | 40 |  | 
|  | 41 | /* | 
|  | 42 | * Wait until we're out of the critical section.  This might | 
|  | 43 | * give the wrong answer due to the lack of memory barriers. | 
|  | 44 | */ | 
|  | 45 | while (desc->status & IRQ_INPROGRESS) | 
|  | 46 | cpu_relax(); | 
|  | 47 |  | 
|  | 48 | /* Ok, that indicated we're done: double-check carefully. */ | 
|  | 49 | spin_lock_irqsave(&desc->lock, flags); | 
|  | 50 | status = desc->status; | 
|  | 51 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 52 |  | 
|  | 53 | /* Oops, that failed? */ | 
|  | 54 | } while (status & IRQ_INPROGRESS); | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 55 |  | 
|  | 56 | /* | 
|  | 57 | * We made sure that no hardirq handler is running. Now verify | 
|  | 58 | * that no threaded handlers are active. | 
|  | 59 | */ | 
|  | 60 | wait_event(desc->wait_for_threads, !atomic_read(&desc->threads_active)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | EXPORT_SYMBOL(synchronize_irq); | 
|  | 63 |  | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 64 | #ifdef CONFIG_SMP | 
|  | 65 | cpumask_var_t irq_default_affinity; | 
|  | 66 |  | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 67 | /** | 
|  | 68 | *	irq_can_set_affinity - Check if the affinity of a given irq can be set | 
|  | 69 | *	@irq:		Interrupt to check | 
|  | 70 | * | 
|  | 71 | */ | 
|  | 72 | int irq_can_set_affinity(unsigned int irq) | 
|  | 73 | { | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 74 | struct irq_desc *desc = irq_to_desc(irq); | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 75 |  | 
|  | 76 | if (CHECK_IRQ_PER_CPU(desc->status) || !desc->chip || | 
|  | 77 | !desc->chip->set_affinity) | 
|  | 78 | return 0; | 
|  | 79 |  | 
|  | 80 | return 1; | 
|  | 81 | } | 
|  | 82 |  | 
| Yinghai Lu | 57b150c | 2009-04-27 17:59:53 -0700 | [diff] [blame] | 83 | void | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 84 | irq_set_thread_affinity(struct irq_desc *desc, const struct cpumask *cpumask) | 
|  | 85 | { | 
|  | 86 | struct irqaction *action = desc->action; | 
|  | 87 |  | 
|  | 88 | while (action) { | 
|  | 89 | if (action->thread) | 
|  | 90 | set_cpus_allowed_ptr(action->thread, cpumask); | 
|  | 91 | action = action->next; | 
|  | 92 | } | 
|  | 93 | } | 
|  | 94 |  | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 95 | /** | 
|  | 96 | *	irq_set_affinity - Set the irq affinity of a given irq | 
|  | 97 | *	@irq:		Interrupt to set affinity | 
|  | 98 | *	@cpumask:	cpumask | 
|  | 99 | * | 
|  | 100 | */ | 
| Rusty Russell | 0de2652 | 2008-12-13 21:20:26 +1030 | [diff] [blame] | 101 | int irq_set_affinity(unsigned int irq, const struct cpumask *cpumask) | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 102 | { | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 103 | struct irq_desc *desc = irq_to_desc(irq); | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 104 | unsigned long flags; | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 105 |  | 
|  | 106 | if (!desc->chip->set_affinity) | 
|  | 107 | return -EINVAL; | 
|  | 108 |  | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 109 | spin_lock_irqsave(&desc->lock, flags); | 
|  | 110 |  | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 111 | #ifdef CONFIG_GENERIC_PENDING_IRQ | 
| Yinghai Lu | 57b150c | 2009-04-27 17:59:53 -0700 | [diff] [blame] | 112 | if (desc->status & IRQ_MOVE_PCNTXT) { | 
|  | 113 | if (!desc->chip->set_affinity(irq, cpumask)) { | 
|  | 114 | cpumask_copy(desc->affinity, cpumask); | 
|  | 115 | irq_set_thread_affinity(desc, cpumask); | 
|  | 116 | } | 
|  | 117 | } | 
| Pallipadi, Venkatesh | 6ec3cfe | 2009-04-13 15:20:58 -0700 | [diff] [blame] | 118 | else { | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 119 | desc->status |= IRQ_MOVE_PENDING; | 
| Mike Travis | 7f7ace0 | 2009-01-10 21:58:08 -0800 | [diff] [blame] | 120 | cpumask_copy(desc->pending_mask, cpumask); | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 121 | } | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 122 | #else | 
| Yinghai Lu | 57b150c | 2009-04-27 17:59:53 -0700 | [diff] [blame] | 123 | if (!desc->chip->set_affinity(irq, cpumask)) { | 
|  | 124 | cpumask_copy(desc->affinity, cpumask); | 
|  | 125 | irq_set_thread_affinity(desc, cpumask); | 
|  | 126 | } | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 127 | #endif | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 128 | desc->status |= IRQ_AFFINITY_SET; | 
|  | 129 | spin_unlock_irqrestore(&desc->lock, flags); | 
| Thomas Gleixner | 771ee3b | 2007-02-16 01:27:25 -0800 | [diff] [blame] | 130 | return 0; | 
|  | 131 | } | 
|  | 132 |  | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 133 | #ifndef CONFIG_AUTO_IRQ_AFFINITY | 
|  | 134 | /* | 
|  | 135 | * Generic version of the affinity autoselector. | 
|  | 136 | */ | 
| Hannes Eder | 548c893 | 2009-02-08 20:24:47 +0100 | [diff] [blame] | 137 | static int setup_affinity(unsigned int irq, struct irq_desc *desc) | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 138 | { | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 139 | if (!irq_can_set_affinity(irq)) | 
|  | 140 | return 0; | 
|  | 141 |  | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 142 | /* | 
|  | 143 | * Preserve an userspace affinity setup, but make sure that | 
|  | 144 | * one of the targets is online. | 
|  | 145 | */ | 
| Thomas Gleixner | 612e368 | 2008-11-07 13:58:46 +0100 | [diff] [blame] | 146 | if (desc->status & (IRQ_AFFINITY_SET | IRQ_NO_BALANCING)) { | 
| Mike Travis | 7f7ace0 | 2009-01-10 21:58:08 -0800 | [diff] [blame] | 147 | if (cpumask_any_and(desc->affinity, cpu_online_mask) | 
| Rusty Russell | 0de2652 | 2008-12-13 21:20:26 +1030 | [diff] [blame] | 148 | < nr_cpu_ids) | 
|  | 149 | goto set_affinity; | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 150 | else | 
|  | 151 | desc->status &= ~IRQ_AFFINITY_SET; | 
|  | 152 | } | 
|  | 153 |  | 
| Mike Travis | 7f7ace0 | 2009-01-10 21:58:08 -0800 | [diff] [blame] | 154 | cpumask_and(desc->affinity, cpu_online_mask, irq_default_affinity); | 
| Rusty Russell | 0de2652 | 2008-12-13 21:20:26 +1030 | [diff] [blame] | 155 | set_affinity: | 
| Mike Travis | 7f7ace0 | 2009-01-10 21:58:08 -0800 | [diff] [blame] | 156 | desc->chip->set_affinity(irq, desc->affinity); | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 157 |  | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 158 | return 0; | 
|  | 159 | } | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 160 | #else | 
| Hannes Eder | 548c893 | 2009-02-08 20:24:47 +0100 | [diff] [blame] | 161 | static inline int setup_affinity(unsigned int irq, struct irq_desc *d) | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 162 | { | 
|  | 163 | return irq_select_affinity(irq); | 
|  | 164 | } | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 165 | #endif | 
|  | 166 |  | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 167 | /* | 
|  | 168 | * Called when affinity is set via /proc/irq | 
|  | 169 | */ | 
|  | 170 | int irq_select_affinity_usr(unsigned int irq) | 
|  | 171 | { | 
|  | 172 | struct irq_desc *desc = irq_to_desc(irq); | 
|  | 173 | unsigned long flags; | 
|  | 174 | int ret; | 
|  | 175 |  | 
|  | 176 | spin_lock_irqsave(&desc->lock, flags); | 
| Hannes Eder | 548c893 | 2009-02-08 20:24:47 +0100 | [diff] [blame] | 177 | ret = setup_affinity(irq, desc); | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 178 | if (!ret) | 
|  | 179 | irq_set_thread_affinity(desc, desc->affinity); | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 180 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 181 |  | 
|  | 182 | return ret; | 
|  | 183 | } | 
|  | 184 |  | 
|  | 185 | #else | 
| Hannes Eder | 548c893 | 2009-02-08 20:24:47 +0100 | [diff] [blame] | 186 | static inline int setup_affinity(unsigned int irq, struct irq_desc *desc) | 
| Thomas Gleixner | f6d87f4 | 2008-11-07 13:18:30 +0100 | [diff] [blame] | 187 | { | 
|  | 188 | return 0; | 
|  | 189 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | #endif | 
|  | 191 |  | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 192 | void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend) | 
|  | 193 | { | 
|  | 194 | if (suspend) { | 
|  | 195 | if (!desc->action || (desc->action->flags & IRQF_TIMER)) | 
|  | 196 | return; | 
|  | 197 | desc->status |= IRQ_SUSPENDED; | 
|  | 198 | } | 
|  | 199 |  | 
|  | 200 | if (!desc->depth++) { | 
|  | 201 | desc->status |= IRQ_DISABLED; | 
|  | 202 | desc->chip->disable(irq); | 
|  | 203 | } | 
|  | 204 | } | 
|  | 205 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 | /** | 
|  | 207 | *	disable_irq_nosync - disable an irq without waiting | 
|  | 208 | *	@irq: Interrupt to disable | 
|  | 209 | * | 
|  | 210 | *	Disable the selected interrupt line.  Disables and Enables are | 
|  | 211 | *	nested. | 
|  | 212 | *	Unlike disable_irq(), this function does not ensure existing | 
|  | 213 | *	instances of the IRQ handler have completed before returning. | 
|  | 214 | * | 
|  | 215 | *	This function may be called from IRQ context. | 
|  | 216 | */ | 
|  | 217 | void disable_irq_nosync(unsigned int irq) | 
|  | 218 | { | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 219 | struct irq_desc *desc = irq_to_desc(irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 220 | unsigned long flags; | 
|  | 221 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 222 | if (!desc) | 
| Matthew Wilcox | c2b5a25 | 2005-11-03 07:51:18 -0700 | [diff] [blame] | 223 | return; | 
|  | 224 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 | spin_lock_irqsave(&desc->lock, flags); | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 226 | __disable_irq(desc, irq, false); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 228 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 | EXPORT_SYMBOL(disable_irq_nosync); | 
|  | 230 |  | 
|  | 231 | /** | 
|  | 232 | *	disable_irq - disable an irq and wait for completion | 
|  | 233 | *	@irq: Interrupt to disable | 
|  | 234 | * | 
|  | 235 | *	Disable the selected interrupt line.  Enables and Disables are | 
|  | 236 | *	nested. | 
|  | 237 | *	This function waits for any pending IRQ handlers for this interrupt | 
|  | 238 | *	to complete before returning. If you use this function while | 
|  | 239 | *	holding a resource the IRQ handler may need you will deadlock. | 
|  | 240 | * | 
|  | 241 | *	This function may be called - with care - from IRQ context. | 
|  | 242 | */ | 
|  | 243 | void disable_irq(unsigned int irq) | 
|  | 244 | { | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 245 | struct irq_desc *desc = irq_to_desc(irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 247 | if (!desc) | 
| Matthew Wilcox | c2b5a25 | 2005-11-03 07:51:18 -0700 | [diff] [blame] | 248 | return; | 
|  | 249 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 | disable_irq_nosync(irq); | 
|  | 251 | if (desc->action) | 
|  | 252 | synchronize_irq(irq); | 
|  | 253 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 | EXPORT_SYMBOL(disable_irq); | 
|  | 255 |  | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 256 | void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume) | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 257 | { | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 258 | if (resume) | 
|  | 259 | desc->status &= ~IRQ_SUSPENDED; | 
|  | 260 |  | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 261 | switch (desc->depth) { | 
|  | 262 | case 0: | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 263 | err_out: | 
| Arjan van de Ven | b8c512f | 2008-07-25 19:45:36 -0700 | [diff] [blame] | 264 | WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq); | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 265 | break; | 
|  | 266 | case 1: { | 
|  | 267 | unsigned int status = desc->status & ~IRQ_DISABLED; | 
|  | 268 |  | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 269 | if (desc->status & IRQ_SUSPENDED) | 
|  | 270 | goto err_out; | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 271 | /* Prevent probing on this irq: */ | 
|  | 272 | desc->status = status | IRQ_NOPROBE; | 
|  | 273 | check_irq_resend(desc, irq); | 
|  | 274 | /* fall-through */ | 
|  | 275 | } | 
|  | 276 | default: | 
|  | 277 | desc->depth--; | 
|  | 278 | } | 
|  | 279 | } | 
|  | 280 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 | /** | 
|  | 282 | *	enable_irq - enable handling of an irq | 
|  | 283 | *	@irq: Interrupt to enable | 
|  | 284 | * | 
|  | 285 | *	Undoes the effect of one call to disable_irq().  If this | 
|  | 286 | *	matches the last disable, processing of interrupts on this | 
|  | 287 | *	IRQ line is re-enabled. | 
|  | 288 | * | 
|  | 289 | *	This function may be called from IRQ context. | 
|  | 290 | */ | 
|  | 291 | void enable_irq(unsigned int irq) | 
|  | 292 | { | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 293 | struct irq_desc *desc = irq_to_desc(irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | unsigned long flags; | 
|  | 295 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 296 | if (!desc) | 
| Matthew Wilcox | c2b5a25 | 2005-11-03 07:51:18 -0700 | [diff] [blame] | 297 | return; | 
|  | 298 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 299 | spin_lock_irqsave(&desc->lock, flags); | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 300 | __enable_irq(desc, irq, false); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 302 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 303 | EXPORT_SYMBOL(enable_irq); | 
|  | 304 |  | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 305 | static int set_irq_wake_real(unsigned int irq, unsigned int on) | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 306 | { | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 307 | struct irq_desc *desc = irq_to_desc(irq); | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 308 | int ret = -ENXIO; | 
|  | 309 |  | 
|  | 310 | if (desc->chip->set_wake) | 
|  | 311 | ret = desc->chip->set_wake(irq, on); | 
|  | 312 |  | 
|  | 313 | return ret; | 
|  | 314 | } | 
|  | 315 |  | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 316 | /** | 
|  | 317 | *	set_irq_wake - control irq power management wakeup | 
|  | 318 | *	@irq:	interrupt to control | 
|  | 319 | *	@on:	enable/disable power management wakeup | 
|  | 320 | * | 
| David Brownell | 15a647e | 2006-07-30 03:03:08 -0700 | [diff] [blame] | 321 | *	Enable/disable power management wakeup mode, which is | 
|  | 322 | *	disabled by default.  Enables and disables must match, | 
|  | 323 | *	just as they match for non-wakeup mode support. | 
|  | 324 | * | 
|  | 325 | *	Wakeup mode lets this IRQ wake the system from sleep | 
|  | 326 | *	states like "suspend to RAM". | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 327 | */ | 
|  | 328 | int set_irq_wake(unsigned int irq, unsigned int on) | 
|  | 329 | { | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 330 | struct irq_desc *desc = irq_to_desc(irq); | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 331 | unsigned long flags; | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 332 | int ret = 0; | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 333 |  | 
| David Brownell | 15a647e | 2006-07-30 03:03:08 -0700 | [diff] [blame] | 334 | /* wakeup-capable irqs can be shared between drivers that | 
|  | 335 | * don't need to have the same sleep mode behaviors. | 
|  | 336 | */ | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 337 | spin_lock_irqsave(&desc->lock, flags); | 
| David Brownell | 15a647e | 2006-07-30 03:03:08 -0700 | [diff] [blame] | 338 | if (on) { | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 339 | if (desc->wake_depth++ == 0) { | 
|  | 340 | ret = set_irq_wake_real(irq, on); | 
|  | 341 | if (ret) | 
|  | 342 | desc->wake_depth = 0; | 
|  | 343 | else | 
|  | 344 | desc->status |= IRQ_WAKEUP; | 
|  | 345 | } | 
| David Brownell | 15a647e | 2006-07-30 03:03:08 -0700 | [diff] [blame] | 346 | } else { | 
|  | 347 | if (desc->wake_depth == 0) { | 
| Arjan van de Ven | 7a2c477 | 2008-07-25 01:45:54 -0700 | [diff] [blame] | 348 | WARN(1, "Unbalanced IRQ %d wake disable\n", irq); | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 349 | } else if (--desc->wake_depth == 0) { | 
|  | 350 | ret = set_irq_wake_real(irq, on); | 
|  | 351 | if (ret) | 
|  | 352 | desc->wake_depth = 1; | 
|  | 353 | else | 
|  | 354 | desc->status &= ~IRQ_WAKEUP; | 
|  | 355 | } | 
| David Brownell | 15a647e | 2006-07-30 03:03:08 -0700 | [diff] [blame] | 356 | } | 
| Uwe Kleine-König | 2db8732 | 2008-07-23 14:42:25 +0200 | [diff] [blame] | 357 |  | 
| Thomas Gleixner | ba9a233 | 2006-06-29 02:24:55 -0700 | [diff] [blame] | 358 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 359 | return ret; | 
|  | 360 | } | 
|  | 361 | EXPORT_SYMBOL(set_irq_wake); | 
|  | 362 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | /* | 
|  | 364 | * Internal function that tells the architecture code whether a | 
|  | 365 | * particular irq has been exclusively allocated or is available | 
|  | 366 | * for driver use. | 
|  | 367 | */ | 
|  | 368 | int can_request_irq(unsigned int irq, unsigned long irqflags) | 
|  | 369 | { | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 370 | struct irq_desc *desc = irq_to_desc(irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 371 | struct irqaction *action; | 
|  | 372 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 373 | if (!desc) | 
|  | 374 | return 0; | 
|  | 375 |  | 
|  | 376 | if (desc->status & IRQ_NOREQUEST) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 377 | return 0; | 
|  | 378 |  | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 379 | action = desc->action; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 380 | if (action) | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 381 | if (irqflags & action->flags & IRQF_SHARED) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | action = NULL; | 
|  | 383 |  | 
|  | 384 | return !action; | 
|  | 385 | } | 
|  | 386 |  | 
| Thomas Gleixner | 6a6de9e | 2006-06-29 02:24:51 -0700 | [diff] [blame] | 387 | void compat_irq_chip_set_default_handler(struct irq_desc *desc) | 
|  | 388 | { | 
|  | 389 | /* | 
|  | 390 | * If the architecture still has not overriden | 
|  | 391 | * the flow handler then zap the default. This | 
|  | 392 | * should catch incorrect flow-type setting. | 
|  | 393 | */ | 
|  | 394 | if (desc->handle_irq == &handle_bad_irq) | 
|  | 395 | desc->handle_irq = NULL; | 
|  | 396 | } | 
|  | 397 |  | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 398 | int __irq_set_trigger(struct irq_desc *desc, unsigned int irq, | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 399 | unsigned long flags) | 
|  | 400 | { | 
|  | 401 | int ret; | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 402 | struct irq_chip *chip = desc->chip; | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 403 |  | 
|  | 404 | if (!chip || !chip->set_type) { | 
|  | 405 | /* | 
|  | 406 | * IRQF_TRIGGER_* but the PIC does not support multiple | 
|  | 407 | * flow-types? | 
|  | 408 | */ | 
| Mark Nelson | 3ff68a6 | 2008-11-13 21:37:41 +1100 | [diff] [blame] | 409 | pr_debug("No set_type function for IRQ %d (%s)\n", irq, | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 410 | chip ? (chip->name ? : "unknown") : "unknown"); | 
|  | 411 | return 0; | 
|  | 412 | } | 
|  | 413 |  | 
| David Brownell | f2b662d | 2008-12-01 14:31:38 -0800 | [diff] [blame] | 414 | /* caller masked out all except trigger mode flags */ | 
|  | 415 | ret = chip->set_type(irq, flags); | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 416 |  | 
|  | 417 | if (ret) | 
| David Brownell | c69ad71 | 2008-08-05 13:01:14 -0700 | [diff] [blame] | 418 | pr_err("setting trigger mode %d for irq %u failed (%pF)\n", | 
| David Brownell | f2b662d | 2008-12-01 14:31:38 -0800 | [diff] [blame] | 419 | (int)flags, irq, chip->set_type); | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 420 | else { | 
| David Brownell | f2b662d | 2008-12-01 14:31:38 -0800 | [diff] [blame] | 421 | if (flags & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH)) | 
|  | 422 | flags |= IRQ_LEVEL; | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 423 | /* note that IRQF_TRIGGER_MASK == IRQ_TYPE_SENSE_MASK */ | 
| David Brownell | f2b662d | 2008-12-01 14:31:38 -0800 | [diff] [blame] | 424 | desc->status &= ~(IRQ_LEVEL | IRQ_TYPE_SENSE_MASK); | 
|  | 425 | desc->status |= flags; | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 426 | } | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 427 |  | 
|  | 428 | return ret; | 
|  | 429 | } | 
|  | 430 |  | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 431 | static int irq_wait_for_interrupt(struct irqaction *action) | 
|  | 432 | { | 
|  | 433 | while (!kthread_should_stop()) { | 
|  | 434 | set_current_state(TASK_INTERRUPTIBLE); | 
| Thomas Gleixner | f48fe81 | 2009-03-24 11:46:22 +0100 | [diff] [blame] | 435 |  | 
|  | 436 | if (test_and_clear_bit(IRQTF_RUNTHREAD, | 
|  | 437 | &action->thread_flags)) { | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 438 | __set_current_state(TASK_RUNNING); | 
|  | 439 | return 0; | 
| Thomas Gleixner | f48fe81 | 2009-03-24 11:46:22 +0100 | [diff] [blame] | 440 | } | 
|  | 441 | schedule(); | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 442 | } | 
|  | 443 | return -1; | 
|  | 444 | } | 
|  | 445 |  | 
|  | 446 | /* | 
|  | 447 | * Interrupt handler thread | 
|  | 448 | */ | 
|  | 449 | static int irq_thread(void *data) | 
|  | 450 | { | 
|  | 451 | struct sched_param param = { .sched_priority = MAX_USER_RT_PRIO/2, }; | 
|  | 452 | struct irqaction *action = data; | 
|  | 453 | struct irq_desc *desc = irq_to_desc(action->irq); | 
|  | 454 | int wake; | 
|  | 455 |  | 
|  | 456 | sched_setscheduler(current, SCHED_FIFO, ¶m); | 
|  | 457 | current->irqaction = action; | 
|  | 458 |  | 
|  | 459 | while (!irq_wait_for_interrupt(action)) { | 
|  | 460 |  | 
|  | 461 | atomic_inc(&desc->threads_active); | 
|  | 462 |  | 
|  | 463 | spin_lock_irq(&desc->lock); | 
|  | 464 | if (unlikely(desc->status & IRQ_DISABLED)) { | 
|  | 465 | /* | 
|  | 466 | * CHECKME: We might need a dedicated | 
|  | 467 | * IRQ_THREAD_PENDING flag here, which | 
|  | 468 | * retriggers the thread in check_irq_resend() | 
|  | 469 | * but AFAICT IRQ_PENDING should be fine as it | 
|  | 470 | * retriggers the interrupt itself --- tglx | 
|  | 471 | */ | 
|  | 472 | desc->status |= IRQ_PENDING; | 
|  | 473 | spin_unlock_irq(&desc->lock); | 
|  | 474 | } else { | 
|  | 475 | spin_unlock_irq(&desc->lock); | 
|  | 476 |  | 
|  | 477 | action->thread_fn(action->irq, action->dev_id); | 
|  | 478 | } | 
|  | 479 |  | 
|  | 480 | wake = atomic_dec_and_test(&desc->threads_active); | 
|  | 481 |  | 
|  | 482 | if (wake && waitqueue_active(&desc->wait_for_threads)) | 
|  | 483 | wake_up(&desc->wait_for_threads); | 
|  | 484 | } | 
|  | 485 |  | 
|  | 486 | /* | 
|  | 487 | * Clear irqaction. Otherwise exit_irq_thread() would make | 
|  | 488 | * fuzz about an active irq thread going into nirvana. | 
|  | 489 | */ | 
|  | 490 | current->irqaction = NULL; | 
|  | 491 | return 0; | 
|  | 492 | } | 
|  | 493 |  | 
|  | 494 | /* | 
|  | 495 | * Called from do_exit() | 
|  | 496 | */ | 
|  | 497 | void exit_irq_thread(void) | 
|  | 498 | { | 
|  | 499 | struct task_struct *tsk = current; | 
|  | 500 |  | 
|  | 501 | if (!tsk->irqaction) | 
|  | 502 | return; | 
|  | 503 |  | 
|  | 504 | printk(KERN_ERR | 
|  | 505 | "exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n", | 
|  | 506 | tsk->comm ? tsk->comm : "", tsk->pid, tsk->irqaction->irq); | 
|  | 507 |  | 
|  | 508 | /* | 
|  | 509 | * Set the THREAD DIED flag to prevent further wakeups of the | 
|  | 510 | * soon to be gone threaded handler. | 
|  | 511 | */ | 
|  | 512 | set_bit(IRQTF_DIED, &tsk->irqaction->flags); | 
|  | 513 | } | 
|  | 514 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 515 | /* | 
|  | 516 | * Internal function to register an irqaction - typically used to | 
|  | 517 | * allocate special interrupts that are part of the architecture. | 
|  | 518 | */ | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 519 | static int | 
| Ingo Molnar | 327ec56 | 2009-02-15 11:21:37 +0100 | [diff] [blame] | 520 | __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 521 | { | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 522 | struct irqaction *old, **old_ptr; | 
| Andrew Morton | 8b126b7 | 2006-11-14 02:03:23 -0800 | [diff] [blame] | 523 | const char *old_name = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | unsigned long flags; | 
|  | 525 | int shared = 0; | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 526 | int ret; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 528 | if (!desc) | 
| Matthew Wilcox | c2b5a25 | 2005-11-03 07:51:18 -0700 | [diff] [blame] | 529 | return -EINVAL; | 
|  | 530 |  | 
| Ingo Molnar | f1c2662 | 2006-06-29 02:24:57 -0700 | [diff] [blame] | 531 | if (desc->chip == &no_irq_chip) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 532 | return -ENOSYS; | 
|  | 533 | /* | 
|  | 534 | * Some drivers like serial.c use request_irq() heavily, | 
|  | 535 | * so we have to be careful not to interfere with a | 
|  | 536 | * running system. | 
|  | 537 | */ | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 538 | if (new->flags & IRQF_SAMPLE_RANDOM) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 539 | /* | 
|  | 540 | * This function might sleep, we want to call it first, | 
|  | 541 | * outside of the atomic block. | 
|  | 542 | * Yes, this might clear the entropy pool if the wrong | 
|  | 543 | * driver is attempted to be loaded, without actually | 
|  | 544 | * installing a new handler, but is this really a problem, | 
|  | 545 | * only the sysadmin is able to do this. | 
|  | 546 | */ | 
|  | 547 | rand_initialize_irq(irq); | 
|  | 548 | } | 
|  | 549 |  | 
|  | 550 | /* | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 551 | * Threaded handler ? | 
|  | 552 | */ | 
|  | 553 | if (new->thread_fn) { | 
|  | 554 | struct task_struct *t; | 
|  | 555 |  | 
|  | 556 | t = kthread_create(irq_thread, new, "irq/%d-%s", irq, | 
|  | 557 | new->name); | 
|  | 558 | if (IS_ERR(t)) | 
|  | 559 | return PTR_ERR(t); | 
|  | 560 | /* | 
|  | 561 | * We keep the reference to the task struct even if | 
|  | 562 | * the thread dies to avoid that the interrupt code | 
|  | 563 | * references an already freed task_struct. | 
|  | 564 | */ | 
|  | 565 | get_task_struct(t); | 
|  | 566 | new->thread = t; | 
|  | 567 | wake_up_process(t); | 
|  | 568 | } | 
|  | 569 |  | 
|  | 570 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 571 | * The following block of code has to be executed atomically | 
|  | 572 | */ | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 573 | spin_lock_irqsave(&desc->lock, flags); | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 574 | old_ptr = &desc->action; | 
|  | 575 | old = *old_ptr; | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 576 | if (old) { | 
| Thomas Gleixner | e76de9f | 2006-06-29 02:24:56 -0700 | [diff] [blame] | 577 | /* | 
|  | 578 | * Can't share interrupts unless both agree to and are | 
|  | 579 | * the same type (level, edge, polarity). So both flag | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 580 | * fields must have IRQF_SHARED set and the bits which | 
| Thomas Gleixner | e76de9f | 2006-06-29 02:24:56 -0700 | [diff] [blame] | 581 | * set the trigger type must match. | 
|  | 582 | */ | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 583 | if (!((old->flags & new->flags) & IRQF_SHARED) || | 
| Andrew Morton | 8b126b7 | 2006-11-14 02:03:23 -0800 | [diff] [blame] | 584 | ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK)) { | 
|  | 585 | old_name = old->name; | 
| Dimitri Sivanich | f516342 | 2006-03-25 03:08:23 -0800 | [diff] [blame] | 586 | goto mismatch; | 
| Andrew Morton | 8b126b7 | 2006-11-14 02:03:23 -0800 | [diff] [blame] | 587 | } | 
| Dimitri Sivanich | f516342 | 2006-03-25 03:08:23 -0800 | [diff] [blame] | 588 |  | 
| Thomas Gleixner | 284c668 | 2006-07-03 02:20:32 +0200 | [diff] [blame] | 589 | #if defined(CONFIG_IRQ_PER_CPU) | 
| Dimitri Sivanich | f516342 | 2006-03-25 03:08:23 -0800 | [diff] [blame] | 590 | /* All handlers must agree on per-cpuness */ | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 591 | if ((old->flags & IRQF_PERCPU) != | 
|  | 592 | (new->flags & IRQF_PERCPU)) | 
| Dimitri Sivanich | f516342 | 2006-03-25 03:08:23 -0800 | [diff] [blame] | 593 | goto mismatch; | 
|  | 594 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 595 |  | 
|  | 596 | /* add new interrupt at end of irq queue */ | 
|  | 597 | do { | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 598 | old_ptr = &old->next; | 
|  | 599 | old = *old_ptr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | } while (old); | 
|  | 601 | shared = 1; | 
|  | 602 | } | 
|  | 603 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 604 | if (!shared) { | 
| Thomas Gleixner | 6a6de9e | 2006-06-29 02:24:51 -0700 | [diff] [blame] | 605 | irq_chip_set_defaults(desc->chip); | 
| Thomas Gleixner | e76de9f | 2006-06-29 02:24:56 -0700 | [diff] [blame] | 606 |  | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 607 | init_waitqueue_head(&desc->wait_for_threads); | 
|  | 608 |  | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 609 | /* Setup the type (level, edge polarity) if configured: */ | 
|  | 610 | if (new->flags & IRQF_TRIGGER_MASK) { | 
| David Brownell | f2b662d | 2008-12-01 14:31:38 -0800 | [diff] [blame] | 611 | ret = __irq_set_trigger(desc, irq, | 
|  | 612 | new->flags & IRQF_TRIGGER_MASK); | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 613 |  | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 614 | if (ret) | 
|  | 615 | goto out_thread; | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 616 | } else | 
|  | 617 | compat_irq_chip_set_default_handler(desc); | 
| Ahmed S. Darwish | f75d222 | 2007-05-08 00:27:55 -0700 | [diff] [blame] | 618 | #if defined(CONFIG_IRQ_PER_CPU) | 
|  | 619 | if (new->flags & IRQF_PERCPU) | 
|  | 620 | desc->status |= IRQ_PER_CPU; | 
|  | 621 | #endif | 
|  | 622 |  | 
| Thomas Gleixner | 94d39e1 | 2006-06-29 02:24:50 -0700 | [diff] [blame] | 623 | desc->status &= ~(IRQ_AUTODETECT | IRQ_WAITING | | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 624 | IRQ_INPROGRESS | IRQ_SPURIOUS_DISABLED); | 
| Thomas Gleixner | 94d39e1 | 2006-06-29 02:24:50 -0700 | [diff] [blame] | 625 |  | 
|  | 626 | if (!(desc->status & IRQ_NOAUTOEN)) { | 
|  | 627 | desc->depth = 0; | 
|  | 628 | desc->status &= ~IRQ_DISABLED; | 
| Pawel MOLL | 7e6e178 | 2008-09-01 10:12:11 +0100 | [diff] [blame] | 629 | desc->chip->startup(irq); | 
| Thomas Gleixner | e76de9f | 2006-06-29 02:24:56 -0700 | [diff] [blame] | 630 | } else | 
|  | 631 | /* Undo nested disables: */ | 
|  | 632 | desc->depth = 1; | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 633 |  | 
| Thomas Gleixner | 612e368 | 2008-11-07 13:58:46 +0100 | [diff] [blame] | 634 | /* Exclude IRQ from balancing if requested */ | 
|  | 635 | if (new->flags & IRQF_NOBALANCING) | 
|  | 636 | desc->status |= IRQ_NO_BALANCING; | 
|  | 637 |  | 
| Max Krasnyansky | 1840475 | 2008-05-29 11:02:52 -0700 | [diff] [blame] | 638 | /* Set default affinity mask once everything is setup */ | 
| Hannes Eder | 548c893 | 2009-02-08 20:24:47 +0100 | [diff] [blame] | 639 | setup_affinity(irq, desc); | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 640 |  | 
|  | 641 | } else if ((new->flags & IRQF_TRIGGER_MASK) | 
|  | 642 | && (new->flags & IRQF_TRIGGER_MASK) | 
|  | 643 | != (desc->status & IRQ_TYPE_SENSE_MASK)) { | 
|  | 644 | /* hope the handler works with the actual trigger mode... */ | 
|  | 645 | pr_warning("IRQ %d uses trigger mode %d; requested %d\n", | 
|  | 646 | irq, (int)(desc->status & IRQ_TYPE_SENSE_MASK), | 
|  | 647 | (int)(new->flags & IRQF_TRIGGER_MASK)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 | } | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 649 |  | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 650 | *old_ptr = new; | 
| Uwe Kleine-König | 82736f4 | 2008-07-23 21:28:54 -0700 | [diff] [blame] | 651 |  | 
| Linus Torvalds | 8528b0f | 2007-01-23 14:16:31 -0800 | [diff] [blame] | 652 | /* Reset broken irq detection when installing new handler */ | 
|  | 653 | desc->irq_count = 0; | 
|  | 654 | desc->irqs_unhandled = 0; | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 655 |  | 
|  | 656 | /* | 
|  | 657 | * Check whether we disabled the irq via the spurious handler | 
|  | 658 | * before. Reenable it and give it another chance. | 
|  | 659 | */ | 
|  | 660 | if (shared && (desc->status & IRQ_SPURIOUS_DISABLED)) { | 
|  | 661 | desc->status &= ~IRQ_SPURIOUS_DISABLED; | 
| Rafael J. Wysocki | 0a0c516 | 2009-03-16 22:33:49 +0100 | [diff] [blame] | 662 | __enable_irq(desc, irq, false); | 
| Thomas Gleixner | 1adb085 | 2008-04-28 17:01:56 +0200 | [diff] [blame] | 663 | } | 
|  | 664 |  | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 665 | spin_unlock_irqrestore(&desc->lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 666 |  | 
|  | 667 | new->irq = irq; | 
| Yinghai Lu | 2c6927a | 2008-08-19 20:50:11 -0700 | [diff] [blame] | 668 | register_irq_proc(irq, desc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 669 | new->dir = NULL; | 
|  | 670 | register_handler_proc(irq, new); | 
|  | 671 |  | 
|  | 672 | return 0; | 
| Dimitri Sivanich | f516342 | 2006-03-25 03:08:23 -0800 | [diff] [blame] | 673 |  | 
|  | 674 | mismatch: | 
| Alan Cox | 3f05044 | 2007-02-12 00:52:04 -0800 | [diff] [blame] | 675 | #ifdef CONFIG_DEBUG_SHIRQ | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 676 | if (!(new->flags & IRQF_PROBE_SHARED)) { | 
| Bjorn Helgaas | e8c4b9d | 2006-07-01 04:35:45 -0700 | [diff] [blame] | 677 | printk(KERN_ERR "IRQ handler type mismatch for IRQ %d\n", irq); | 
| Andrew Morton | 8b126b7 | 2006-11-14 02:03:23 -0800 | [diff] [blame] | 678 | if (old_name) | 
|  | 679 | printk(KERN_ERR "current handler: %s\n", old_name); | 
| Andrew Morton | 13e87ec | 2006-04-27 18:39:18 -0700 | [diff] [blame] | 680 | dump_stack(); | 
|  | 681 | } | 
| Alan Cox | 3f05044 | 2007-02-12 00:52:04 -0800 | [diff] [blame] | 682 | #endif | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 683 | ret = -EBUSY; | 
|  | 684 |  | 
|  | 685 | out_thread: | 
| Andrew Morton | 8b126b7 | 2006-11-14 02:03:23 -0800 | [diff] [blame] | 686 | spin_unlock_irqrestore(&desc->lock, flags); | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 687 | if (new->thread) { | 
|  | 688 | struct task_struct *t = new->thread; | 
|  | 689 |  | 
|  | 690 | new->thread = NULL; | 
|  | 691 | if (likely(!test_bit(IRQTF_DIED, &new->thread_flags))) | 
|  | 692 | kthread_stop(t); | 
|  | 693 | put_task_struct(t); | 
|  | 694 | } | 
|  | 695 | return ret; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 696 | } | 
|  | 697 |  | 
|  | 698 | /** | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 699 | *	setup_irq - setup an interrupt | 
|  | 700 | *	@irq: Interrupt line to setup | 
|  | 701 | *	@act: irqaction for the interrupt | 
|  | 702 | * | 
|  | 703 | * Used to statically setup interrupts in the early boot process. | 
|  | 704 | */ | 
|  | 705 | int setup_irq(unsigned int irq, struct irqaction *act) | 
|  | 706 | { | 
|  | 707 | struct irq_desc *desc = irq_to_desc(irq); | 
|  | 708 |  | 
|  | 709 | return __setup_irq(irq, desc, act); | 
|  | 710 | } | 
| Magnus Damm | eb53b4e | 2009-03-12 21:05:59 +0900 | [diff] [blame] | 711 | EXPORT_SYMBOL_GPL(setup_irq); | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 712 |  | 
| Magnus Damm | cbf94f0 | 2009-03-12 21:05:51 +0900 | [diff] [blame] | 713 | /* | 
|  | 714 | * Internal function to unregister an irqaction - used to free | 
|  | 715 | * regular and special interrupts that are part of the architecture. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | */ | 
| Magnus Damm | cbf94f0 | 2009-03-12 21:05:51 +0900 | [diff] [blame] | 717 | static struct irqaction *__free_irq(unsigned int irq, void *dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | { | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 719 | struct irq_desc *desc = irq_to_desc(irq); | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 720 | struct irqaction *action, **action_ptr; | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 721 | struct task_struct *irqthread; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 | unsigned long flags; | 
|  | 723 |  | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 724 | WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq); | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 725 |  | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 726 | if (!desc) | 
| Magnus Damm | f21cfb2 | 2009-03-12 21:05:42 +0900 | [diff] [blame] | 727 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 728 |  | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 729 | spin_lock_irqsave(&desc->lock, flags); | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 730 |  | 
|  | 731 | /* | 
|  | 732 | * There can be multiple actions per IRQ descriptor, find the right | 
|  | 733 | * one based on the dev_id: | 
|  | 734 | */ | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 735 | action_ptr = &desc->action; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 736 | for (;;) { | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 737 | action = *action_ptr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 738 |  | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 739 | if (!action) { | 
|  | 740 | WARN(1, "Trying to free already-free IRQ %d\n", irq); | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 741 | spin_unlock_irqrestore(&desc->lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 742 |  | 
| Magnus Damm | f21cfb2 | 2009-03-12 21:05:42 +0900 | [diff] [blame] | 743 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | } | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 745 |  | 
| Ingo Molnar | 8316e38 | 2009-02-17 20:28:29 +0100 | [diff] [blame] | 746 | if (action->dev_id == dev_id) | 
|  | 747 | break; | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 748 | action_ptr = &action->next; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 749 | } | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 750 |  | 
|  | 751 | /* Found it - now remove it from the list of entries: */ | 
| Ingo Molnar | f17c754 | 2009-02-17 20:43:37 +0100 | [diff] [blame] | 752 | *action_ptr = action->next; | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 753 |  | 
|  | 754 | /* Currently used only by UML, might disappear one day: */ | 
|  | 755 | #ifdef CONFIG_IRQ_RELEASE_METHOD | 
|  | 756 | if (desc->chip->release) | 
|  | 757 | desc->chip->release(irq, dev_id); | 
|  | 758 | #endif | 
|  | 759 |  | 
|  | 760 | /* If this was the last handler, shut down the IRQ line: */ | 
|  | 761 | if (!desc->action) { | 
|  | 762 | desc->status |= IRQ_DISABLED; | 
|  | 763 | if (desc->chip->shutdown) | 
|  | 764 | desc->chip->shutdown(irq); | 
|  | 765 | else | 
|  | 766 | desc->chip->disable(irq); | 
|  | 767 | } | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 768 |  | 
|  | 769 | irqthread = action->thread; | 
|  | 770 | action->thread = NULL; | 
|  | 771 |  | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 772 | spin_unlock_irqrestore(&desc->lock, flags); | 
|  | 773 |  | 
|  | 774 | unregister_handler_proc(irq, action); | 
|  | 775 |  | 
|  | 776 | /* Make sure it's not being used on another CPU: */ | 
|  | 777 | synchronize_irq(irq); | 
|  | 778 |  | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 779 | if (irqthread) { | 
|  | 780 | if (!test_bit(IRQTF_DIED, &action->thread_flags)) | 
|  | 781 | kthread_stop(irqthread); | 
|  | 782 | put_task_struct(irqthread); | 
|  | 783 | } | 
|  | 784 |  | 
| Ingo Molnar | ae88a23 | 2009-02-15 11:29:50 +0100 | [diff] [blame] | 785 | #ifdef CONFIG_DEBUG_SHIRQ | 
|  | 786 | /* | 
|  | 787 | * It's a shared IRQ -- the driver ought to be prepared for an IRQ | 
|  | 788 | * event to happen even now it's being freed, so let's make sure that | 
|  | 789 | * is so by doing an extra call to the handler .... | 
|  | 790 | * | 
|  | 791 | * ( We do this after actually deregistering it, to make sure that a | 
|  | 792 | *   'real' IRQ doesn't run in * parallel with our fake. ) | 
|  | 793 | */ | 
|  | 794 | if (action->flags & IRQF_SHARED) { | 
|  | 795 | local_irq_save(flags); | 
|  | 796 | action->handler(irq, dev_id); | 
|  | 797 | local_irq_restore(flags); | 
|  | 798 | } | 
|  | 799 | #endif | 
| Magnus Damm | f21cfb2 | 2009-03-12 21:05:42 +0900 | [diff] [blame] | 800 | return action; | 
|  | 801 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 802 |  | 
|  | 803 | /** | 
| Magnus Damm | cbf94f0 | 2009-03-12 21:05:51 +0900 | [diff] [blame] | 804 | *	remove_irq - free an interrupt | 
|  | 805 | *	@irq: Interrupt line to free | 
|  | 806 | *	@act: irqaction for the interrupt | 
|  | 807 | * | 
|  | 808 | * Used to remove interrupts statically setup by the early boot process. | 
|  | 809 | */ | 
|  | 810 | void remove_irq(unsigned int irq, struct irqaction *act) | 
|  | 811 | { | 
|  | 812 | __free_irq(irq, act->dev_id); | 
|  | 813 | } | 
| Magnus Damm | eb53b4e | 2009-03-12 21:05:59 +0900 | [diff] [blame] | 814 | EXPORT_SYMBOL_GPL(remove_irq); | 
| Magnus Damm | cbf94f0 | 2009-03-12 21:05:51 +0900 | [diff] [blame] | 815 |  | 
|  | 816 | /** | 
| Magnus Damm | f21cfb2 | 2009-03-12 21:05:42 +0900 | [diff] [blame] | 817 | *	free_irq - free an interrupt allocated with request_irq | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 818 | *	@irq: Interrupt line to free | 
|  | 819 | *	@dev_id: Device identity to free | 
|  | 820 | * | 
|  | 821 | *	Remove an interrupt handler. The handler is removed and if the | 
|  | 822 | *	interrupt line is no longer in use by any driver it is disabled. | 
|  | 823 | *	On a shared IRQ the caller must ensure the interrupt is disabled | 
|  | 824 | *	on the card it drives before calling this function. The function | 
|  | 825 | *	does not return until any executing interrupts for this IRQ | 
|  | 826 | *	have completed. | 
|  | 827 | * | 
|  | 828 | *	This function must not be called from interrupt context. | 
|  | 829 | */ | 
|  | 830 | void free_irq(unsigned int irq, void *dev_id) | 
|  | 831 | { | 
| Magnus Damm | cbf94f0 | 2009-03-12 21:05:51 +0900 | [diff] [blame] | 832 | kfree(__free_irq(irq, dev_id)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 833 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 834 | EXPORT_SYMBOL(free_irq); | 
|  | 835 |  | 
|  | 836 | /** | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 837 | *	request_threaded_irq - allocate an interrupt line | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 838 | *	@irq: Interrupt line to allocate | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 839 | *	@handler: Function to be called when the IRQ occurs. | 
|  | 840 | *		  Primary handler for threaded interrupts | 
| Thomas Gleixner | f48fe81 | 2009-03-24 11:46:22 +0100 | [diff] [blame] | 841 | *	@thread_fn: Function called from the irq handler thread | 
|  | 842 | *		    If NULL, no irq thread is created | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 843 | *	@irqflags: Interrupt type flags | 
|  | 844 | *	@devname: An ascii name for the claiming device | 
|  | 845 | *	@dev_id: A cookie passed back to the handler function | 
|  | 846 | * | 
|  | 847 | *	This call allocates interrupt resources and enables the | 
|  | 848 | *	interrupt line and IRQ handling. From the point this | 
|  | 849 | *	call is made your handler function may be invoked. Since | 
|  | 850 | *	your handler function must clear any interrupt the board | 
|  | 851 | *	raises, you must take care both to initialise your hardware | 
|  | 852 | *	and to set up the interrupt handler in the right order. | 
|  | 853 | * | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 854 | *	If you want to set up a threaded irq handler for your device | 
|  | 855 | *	then you need to supply @handler and @thread_fn. @handler ist | 
|  | 856 | *	still called in hard interrupt context and has to check | 
|  | 857 | *	whether the interrupt originates from the device. If yes it | 
|  | 858 | *	needs to disable the interrupt on the device and return | 
| Steven Rostedt | 39a2edd | 2009-05-12 14:35:54 -0400 | [diff] [blame] | 859 | *	IRQ_WAKE_THREAD which will wake up the handler thread and run | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 860 | *	@thread_fn. This split handler design is necessary to support | 
|  | 861 | *	shared interrupts. | 
|  | 862 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 863 | *	Dev_id must be globally unique. Normally the address of the | 
|  | 864 | *	device data structure is used as the cookie. Since the handler | 
|  | 865 | *	receives this value it makes sense to use it. | 
|  | 866 | * | 
|  | 867 | *	If your interrupt is shared you must pass a non NULL dev_id | 
|  | 868 | *	as this is required when freeing the interrupt. | 
|  | 869 | * | 
|  | 870 | *	Flags: | 
|  | 871 | * | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 872 | *	IRQF_SHARED		Interrupt is shared | 
|  | 873 | *	IRQF_DISABLED	Disable local interrupts while processing | 
|  | 874 | *	IRQF_SAMPLE_RANDOM	The interrupt can be used for entropy | 
| David Brownell | 0c5d1eb | 2008-10-01 14:46:18 -0700 | [diff] [blame] | 875 | *	IRQF_TRIGGER_*		Specify active edge(s) or level | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 876 | * | 
|  | 877 | */ | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 878 | int request_threaded_irq(unsigned int irq, irq_handler_t handler, | 
|  | 879 | irq_handler_t thread_fn, unsigned long irqflags, | 
|  | 880 | const char *devname, void *dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 881 | { | 
| Ingo Molnar | 06fcb0c | 2006-06-29 02:24:40 -0700 | [diff] [blame] | 882 | struct irqaction *action; | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 883 | struct irq_desc *desc; | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 884 | int retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 885 |  | 
| David Brownell | 470c662 | 2008-12-01 14:31:37 -0800 | [diff] [blame] | 886 | /* | 
|  | 887 | * handle_IRQ_event() always ignores IRQF_DISABLED except for | 
|  | 888 | * the _first_ irqaction (sigh).  That can cause oopsing, but | 
|  | 889 | * the behavior is classified as "will not fix" so we need to | 
|  | 890 | * start nudging drivers away from using that idiom. | 
|  | 891 | */ | 
| Ingo Molnar | 327ec56 | 2009-02-15 11:21:37 +0100 | [diff] [blame] | 892 | if ((irqflags & (IRQF_SHARED|IRQF_DISABLED)) == | 
|  | 893 | (IRQF_SHARED|IRQF_DISABLED)) { | 
|  | 894 | pr_warning( | 
|  | 895 | "IRQ %d/%s: IRQF_DISABLED is not guaranteed on shared IRQs\n", | 
|  | 896 | irq, devname); | 
|  | 897 | } | 
| David Brownell | 470c662 | 2008-12-01 14:31:37 -0800 | [diff] [blame] | 898 |  | 
| Ingo Molnar | fbb9ce9 | 2006-07-03 00:24:50 -0700 | [diff] [blame] | 899 | #ifdef CONFIG_LOCKDEP | 
|  | 900 | /* | 
|  | 901 | * Lockdep wants atomic interrupt handlers: | 
|  | 902 | */ | 
| Thomas Gleixner | 38515e9 | 2007-02-14 00:33:16 -0800 | [diff] [blame] | 903 | irqflags |= IRQF_DISABLED; | 
| Ingo Molnar | fbb9ce9 | 2006-07-03 00:24:50 -0700 | [diff] [blame] | 904 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 905 | /* | 
|  | 906 | * Sanity-check: shared interrupts must pass in a real dev-ID, | 
|  | 907 | * otherwise we'll have trouble later trying to figure out | 
|  | 908 | * which interrupt is which (messes up the interrupt freeing | 
|  | 909 | * logic etc). | 
|  | 910 | */ | 
| Thomas Gleixner | 3cca53b | 2006-07-01 19:29:31 -0700 | [diff] [blame] | 911 | if ((irqflags & IRQF_SHARED) && !dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 912 | return -EINVAL; | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 913 |  | 
| Yinghai Lu | cb5bc83 | 2008-08-19 20:50:17 -0700 | [diff] [blame] | 914 | desc = irq_to_desc(irq); | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 915 | if (!desc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 916 | return -EINVAL; | 
| Yinghai Lu | 7d94f7c | 2008-08-19 20:50:14 -0700 | [diff] [blame] | 917 |  | 
| Yinghai Lu | 08678b0 | 2008-08-19 20:50:05 -0700 | [diff] [blame] | 918 | if (desc->status & IRQ_NOREQUEST) | 
| Thomas Gleixner | 6550c77 | 2006-06-29 02:24:49 -0700 | [diff] [blame] | 919 | return -EINVAL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 920 | if (!handler) | 
|  | 921 | return -EINVAL; | 
|  | 922 |  | 
| Thomas Gleixner | 4553573 | 2009-02-22 23:00:32 +0100 | [diff] [blame] | 923 | action = kzalloc(sizeof(struct irqaction), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 924 | if (!action) | 
|  | 925 | return -ENOMEM; | 
|  | 926 |  | 
|  | 927 | action->handler = handler; | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 928 | action->thread_fn = thread_fn; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 929 | action->flags = irqflags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 930 | action->name = devname; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 931 | action->dev_id = dev_id; | 
|  | 932 |  | 
| Thomas Gleixner | d3c6004 | 2008-10-16 09:55:00 +0200 | [diff] [blame] | 933 | retval = __setup_irq(irq, desc, action); | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 934 | if (retval) | 
|  | 935 | kfree(action); | 
|  | 936 |  | 
| David Woodhouse | a304e1b | 2007-02-12 00:52:00 -0800 | [diff] [blame] | 937 | #ifdef CONFIG_DEBUG_SHIRQ | 
|  | 938 | if (irqflags & IRQF_SHARED) { | 
|  | 939 | /* | 
|  | 940 | * It's a shared IRQ -- the driver ought to be prepared for it | 
|  | 941 | * to happen immediately, so let's make sure.... | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 942 | * We disable the irq to make sure that a 'real' IRQ doesn't | 
|  | 943 | * run in parallel with our fake. | 
| David Woodhouse | a304e1b | 2007-02-12 00:52:00 -0800 | [diff] [blame] | 944 | */ | 
| Jarek Poplawski | 59845b1 | 2007-08-30 23:56:34 -0700 | [diff] [blame] | 945 | unsigned long flags; | 
| David Woodhouse | a304e1b | 2007-02-12 00:52:00 -0800 | [diff] [blame] | 946 |  | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 947 | disable_irq(irq); | 
| Jarek Poplawski | 59845b1 | 2007-08-30 23:56:34 -0700 | [diff] [blame] | 948 | local_irq_save(flags); | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 949 |  | 
| Jarek Poplawski | 59845b1 | 2007-08-30 23:56:34 -0700 | [diff] [blame] | 950 | handler(irq, dev_id); | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 951 |  | 
| Jarek Poplawski | 59845b1 | 2007-08-30 23:56:34 -0700 | [diff] [blame] | 952 | local_irq_restore(flags); | 
| Anton Vorontsov | 377bf1e | 2008-08-21 22:58:28 +0400 | [diff] [blame] | 953 | enable_irq(irq); | 
| David Woodhouse | a304e1b | 2007-02-12 00:52:00 -0800 | [diff] [blame] | 954 | } | 
|  | 955 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 956 | return retval; | 
|  | 957 | } | 
| Thomas Gleixner | 3aa551c | 2009-03-23 18:28:15 +0100 | [diff] [blame] | 958 | EXPORT_SYMBOL(request_threaded_irq); |