blob: 814c9ef6bba14d7e212d082c659fe83f0f361ce8 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/kernel/irq/manage.c
3 *
Ingo Molnara34db9b2006-06-29 02:24:50 -07004 * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
5 * Copyright (C) 2005-2006 Thomas Gleixner
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 *
7 * This file contains driver APIs to the irq subsystem.
8 */
9
Andrew Morton97fd75b2012-05-31 16:26:07 -070010#define pr_fmt(fmt) "genirq: " fmt
11
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <linux/irq.h>
Thomas Gleixner3aa551c2009-03-23 18:28:15 +010013#include <linux/kthread.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <linux/module.h>
15#include <linux/random.h>
16#include <linux/interrupt.h>
Robert P. J. Day1aeb2722008-04-29 00:59:25 -070017#include <linux/slab.h>
Thomas Gleixner3aa551c2009-03-23 18:28:15 +010018#include <linux/sched.h>
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +100019#include <linux/task_work.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070020
21#include "internals.h"
22
Thomas Gleixner8d32a302011-02-23 23:52:23 +000023#ifdef CONFIG_IRQ_FORCED_THREADING
24__read_mostly bool force_irqthreads;
25
26static int __init setup_forced_irqthreads(char *arg)
27{
28 force_irqthreads = true;
29 return 0;
30}
31early_param("threadirqs", setup_forced_irqthreads);
32#endif
33
Linus Torvalds1da177e2005-04-16 15:20:36 -070034/**
35 * synchronize_irq - wait for pending IRQ handlers (on other CPUs)
Randy Dunlap1e5d5332005-11-07 01:01:06 -080036 * @irq: interrupt number to wait for
Linus Torvalds1da177e2005-04-16 15:20:36 -070037 *
38 * This function waits for any pending IRQ handlers for this interrupt
39 * to complete before returning. If you use this function while
40 * holding a resource the IRQ handler may need you will deadlock.
41 *
42 * This function may be called - with care - from IRQ context.
43 */
44void synchronize_irq(unsigned int irq)
45{
Yinghai Lucb5bc832008-08-19 20:50:17 -070046 struct irq_desc *desc = irq_to_desc(irq);
Thomas Gleixner32f41252011-03-28 14:10:52 +020047 bool inprogress;
Linus Torvalds1da177e2005-04-16 15:20:36 -070048
Yinghai Lu7d94f7c2008-08-19 20:50:14 -070049 if (!desc)
Matthew Wilcoxc2b5a252005-11-03 07:51:18 -070050 return;
51
Herbert Xua98ce5c2007-10-23 11:26:25 +080052 do {
53 unsigned long flags;
54
55 /*
56 * Wait until we're out of the critical section. This might
57 * give the wrong answer due to the lack of memory barriers.
58 */
Thomas Gleixner32f41252011-03-28 14:10:52 +020059 while (irqd_irq_inprogress(&desc->irq_data))
Herbert Xua98ce5c2007-10-23 11:26:25 +080060 cpu_relax();
61
62 /* Ok, that indicated we're done: double-check carefully. */
Thomas Gleixner239007b2009-11-17 16:46:45 +010063 raw_spin_lock_irqsave(&desc->lock, flags);
Thomas Gleixner32f41252011-03-28 14:10:52 +020064 inprogress = irqd_irq_inprogress(&desc->irq_data);
Thomas Gleixner239007b2009-11-17 16:46:45 +010065 raw_spin_unlock_irqrestore(&desc->lock, flags);
Herbert Xua98ce5c2007-10-23 11:26:25 +080066
67 /* Oops, that failed? */
Thomas Gleixner32f41252011-03-28 14:10:52 +020068 } while (inprogress);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +010069
70 /*
71 * We made sure that no hardirq handler is running. Now verify
72 * that no threaded handlers are active.
73 */
74 wait_event(desc->wait_for_threads, !atomic_read(&desc->threads_active));
Linus Torvalds1da177e2005-04-16 15:20:36 -070075}
Linus Torvalds1da177e2005-04-16 15:20:36 -070076EXPORT_SYMBOL(synchronize_irq);
77
Thomas Gleixner3aa551c2009-03-23 18:28:15 +010078#ifdef CONFIG_SMP
79cpumask_var_t irq_default_affinity;
80
Thomas Gleixner771ee3b2007-02-16 01:27:25 -080081/**
82 * irq_can_set_affinity - Check if the affinity of a given irq can be set
83 * @irq: Interrupt to check
84 *
85 */
86int irq_can_set_affinity(unsigned int irq)
87{
Yinghai Lu08678b02008-08-19 20:50:05 -070088 struct irq_desc *desc = irq_to_desc(irq);
Thomas Gleixner771ee3b2007-02-16 01:27:25 -080089
Thomas Gleixnerbce43032011-02-10 22:37:41 +010090 if (!desc || !irqd_can_balance(&desc->irq_data) ||
91 !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
Thomas Gleixner771ee3b2007-02-16 01:27:25 -080092 return 0;
93
94 return 1;
95}
96
Thomas Gleixner591d2fb2009-07-21 11:09:39 +020097/**
98 * irq_set_thread_affinity - Notify irq threads to adjust affinity
99 * @desc: irq descriptor which has affitnity changed
100 *
101 * We just set IRQTF_AFFINITY and delegate the affinity setting
102 * to the interrupt thread itself. We can not call
103 * set_cpus_allowed_ptr() here as we hold desc->lock and this
104 * code can be called from hard interrupt context.
105 */
106void irq_set_thread_affinity(struct irq_desc *desc)
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100107{
108 struct irqaction *action = desc->action;
109
110 while (action) {
111 if (action->thread)
Thomas Gleixner591d2fb2009-07-21 11:09:39 +0200112 set_bit(IRQTF_AFFINITY, &action->thread_flags);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100113 action = action->next;
114 }
115}
116
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100117#ifdef CONFIG_GENERIC_PENDING_IRQ
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200118static inline bool irq_can_move_pcntxt(struct irq_data *data)
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100119{
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200120 return irqd_can_move_in_process_context(data);
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100121}
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200122static inline bool irq_move_pending(struct irq_data *data)
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100123{
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200124 return irqd_is_setaffinity_pending(data);
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100125}
126static inline void
127irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
128{
129 cpumask_copy(desc->pending_mask, mask);
130}
131static inline void
132irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
133{
134 cpumask_copy(mask, desc->pending_mask);
135}
136#else
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200137static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
Thomas Gleixnercd22c0e2011-03-29 11:36:05 +0200138static inline bool irq_move_pending(struct irq_data *data) { return false; }
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100139static inline void
140irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
141static inline void
142irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
143#endif
144
Jiang Liu818b0f32012-03-30 23:11:34 +0800145int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
146 bool force)
147{
148 struct irq_desc *desc = irq_data_to_desc(data);
149 struct irq_chip *chip = irq_data_get_irq_chip(data);
150 int ret;
151
152 ret = chip->irq_set_affinity(data, mask, false);
153 switch (ret) {
154 case IRQ_SET_MASK_OK:
155 cpumask_copy(data->affinity, mask);
156 case IRQ_SET_MASK_OK_NOCOPY:
157 irq_set_thread_affinity(desc);
158 ret = 0;
159 }
160
161 return ret;
162}
163
David Daneyc2d0c552011-03-25 12:38:50 -0700164int __irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask)
165{
166 struct irq_chip *chip = irq_data_get_irq_chip(data);
167 struct irq_desc *desc = irq_data_to_desc(data);
168 int ret = 0;
169
170 if (!chip || !chip->irq_set_affinity)
171 return -EINVAL;
172
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200173 if (irq_can_move_pcntxt(data)) {
Jiang Liu818b0f32012-03-30 23:11:34 +0800174 ret = irq_do_set_affinity(data, mask, false);
David Daneyc2d0c552011-03-25 12:38:50 -0700175 } else {
176 irqd_set_move_pending(data);
177 irq_copy_pending(desc, mask);
178 }
179
180 if (desc->affinity_notify) {
181 kref_get(&desc->affinity_notify->kref);
182 schedule_work(&desc->affinity_notify->work);
183 }
David Daneyc2d0c552011-03-25 12:38:50 -0700184 irqd_set(data, IRQD_AFFINITY_SET);
185
186 return ret;
187}
188
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800189/**
190 * irq_set_affinity - Set the irq affinity of a given irq
191 * @irq: Interrupt to set affinity
Randy Dunlap30398bf2011-03-18 09:33:56 -0700192 * @mask: cpumask
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800193 *
194 */
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100195int irq_set_affinity(unsigned int irq, const struct cpumask *mask)
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800196{
Yinghai Lu08678b02008-08-19 20:50:05 -0700197 struct irq_desc *desc = irq_to_desc(irq);
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100198 unsigned long flags;
David Daneyc2d0c552011-03-25 12:38:50 -0700199 int ret;
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800200
David Daneyc2d0c552011-03-25 12:38:50 -0700201 if (!desc)
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800202 return -EINVAL;
203
Thomas Gleixner239007b2009-11-17 16:46:45 +0100204 raw_spin_lock_irqsave(&desc->lock, flags);
David Daneyc2d0c552011-03-25 12:38:50 -0700205 ret = __irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask);
Thomas Gleixner239007b2009-11-17 16:46:45 +0100206 raw_spin_unlock_irqrestore(&desc->lock, flags);
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100207 return ret;
Thomas Gleixner771ee3b2007-02-16 01:27:25 -0800208}
209
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -0700210int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
211{
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -0700212 unsigned long flags;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +0100213 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -0700214
215 if (!desc)
216 return -EINVAL;
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -0700217 desc->affinity_hint = m;
Thomas Gleixner02725e72011-02-12 10:37:36 +0100218 irq_put_desc_unlock(desc, flags);
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -0700219 return 0;
220}
221EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
222
Ben Hutchingscd7eab42011-01-19 21:01:44 +0000223static void irq_affinity_notify(struct work_struct *work)
224{
225 struct irq_affinity_notify *notify =
226 container_of(work, struct irq_affinity_notify, work);
227 struct irq_desc *desc = irq_to_desc(notify->irq);
228 cpumask_var_t cpumask;
229 unsigned long flags;
230
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100231 if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
Ben Hutchingscd7eab42011-01-19 21:01:44 +0000232 goto out;
233
234 raw_spin_lock_irqsave(&desc->lock, flags);
Thomas Gleixner0ef5ca12011-03-28 21:59:37 +0200235 if (irq_move_pending(&desc->irq_data))
Thomas Gleixner1fa46f12011-02-07 16:46:58 +0100236 irq_get_pending(cpumask, desc);
Ben Hutchingscd7eab42011-01-19 21:01:44 +0000237 else
Thomas Gleixner1fb0ef32011-01-31 08:57:41 +0100238 cpumask_copy(cpumask, desc->irq_data.affinity);
Ben Hutchingscd7eab42011-01-19 21:01:44 +0000239 raw_spin_unlock_irqrestore(&desc->lock, flags);
240
241 notify->notify(notify, cpumask);
242
243 free_cpumask_var(cpumask);
244out:
245 kref_put(&notify->kref, notify->release);
246}
247
248/**
249 * irq_set_affinity_notifier - control notification of IRQ affinity changes
250 * @irq: Interrupt for which to enable/disable notification
251 * @notify: Context for notification, or %NULL to disable
252 * notification. Function pointers must be initialised;
253 * the other fields will be initialised by this function.
254 *
255 * Must be called in process context. Notification may only be enabled
256 * after the IRQ is allocated and must be disabled before the IRQ is
257 * freed using free_irq().
258 */
259int
260irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
261{
262 struct irq_desc *desc = irq_to_desc(irq);
263 struct irq_affinity_notify *old_notify;
264 unsigned long flags;
265
266 /* The release function is promised process context */
267 might_sleep();
268
269 if (!desc)
270 return -EINVAL;
271
272 /* Complete initialisation of *notify */
273 if (notify) {
274 notify->irq = irq;
275 kref_init(&notify->kref);
276 INIT_WORK(&notify->work, irq_affinity_notify);
277 }
278
279 raw_spin_lock_irqsave(&desc->lock, flags);
280 old_notify = desc->affinity_notify;
281 desc->affinity_notify = notify;
282 raw_spin_unlock_irqrestore(&desc->lock, flags);
283
284 if (old_notify)
285 kref_put(&old_notify->kref, old_notify->release);
286
287 return 0;
288}
289EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
290
Max Krasnyansky18404752008-05-29 11:02:52 -0700291#ifndef CONFIG_AUTO_IRQ_AFFINITY
292/*
293 * Generic version of the affinity autoselector.
294 */
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100295static int
296setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
Max Krasnyansky18404752008-05-29 11:02:52 -0700297{
Thomas Gleixner569bda82011-02-07 17:05:08 +0100298 struct cpumask *set = irq_default_affinity;
Jiang Liu818b0f32012-03-30 23:11:34 +0800299 int node = desc->irq_data.node;
Thomas Gleixner569bda82011-02-07 17:05:08 +0100300
Thomas Gleixnerb0082072011-02-07 17:30:50 +0100301 /* Excludes PER_CPU and NO_BALANCE interrupts */
Max Krasnyansky18404752008-05-29 11:02:52 -0700302 if (!irq_can_set_affinity(irq))
303 return 0;
304
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100305 /*
306 * Preserve an userspace affinity setup, but make sure that
307 * one of the targets is online.
308 */
Thomas Gleixner2bdd1052011-02-08 17:22:00 +0100309 if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
Thomas Gleixner569bda82011-02-07 17:05:08 +0100310 if (cpumask_intersects(desc->irq_data.affinity,
311 cpu_online_mask))
312 set = desc->irq_data.affinity;
Thomas Gleixner0c6f8a82011-03-28 13:32:20 +0200313 else
Thomas Gleixner2bdd1052011-02-08 17:22:00 +0100314 irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100315 }
Max Krasnyansky18404752008-05-29 11:02:52 -0700316
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100317 cpumask_and(mask, cpu_online_mask, set);
Prarit Bhargava241fc642012-03-26 15:02:18 -0400318 if (node != NUMA_NO_NODE) {
319 const struct cpumask *nodemask = cpumask_of_node(node);
320
321 /* make sure at least one of the cpus in nodemask is online */
322 if (cpumask_intersects(mask, nodemask))
323 cpumask_and(mask, mask, nodemask);
324 }
Jiang Liu818b0f32012-03-30 23:11:34 +0800325 irq_do_set_affinity(&desc->irq_data, mask, false);
Max Krasnyansky18404752008-05-29 11:02:52 -0700326 return 0;
327}
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100328#else
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100329static inline int
330setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100331{
332 return irq_select_affinity(irq);
333}
Max Krasnyansky18404752008-05-29 11:02:52 -0700334#endif
335
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100336/*
337 * Called when affinity is set via /proc/irq
338 */
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100339int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100340{
341 struct irq_desc *desc = irq_to_desc(irq);
342 unsigned long flags;
343 int ret;
344
Thomas Gleixner239007b2009-11-17 16:46:45 +0100345 raw_spin_lock_irqsave(&desc->lock, flags);
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100346 ret = setup_affinity(irq, desc, mask);
Thomas Gleixner239007b2009-11-17 16:46:45 +0100347 raw_spin_unlock_irqrestore(&desc->lock, flags);
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100348 return ret;
349}
350
351#else
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100352static inline int
353setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
Thomas Gleixnerf6d87f42008-11-07 13:18:30 +0100354{
355 return 0;
356}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357#endif
358
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100359void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend)
360{
361 if (suspend) {
Ian Campbell685fd0b2010-07-29 11:16:32 +0100362 if (!desc->action || (desc->action->flags & IRQF_NO_SUSPEND))
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100363 return;
Thomas Gleixnerc531e832011-02-08 12:44:58 +0100364 desc->istate |= IRQS_SUSPENDED;
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100365 }
366
Thomas Gleixner3aae9942011-02-04 10:17:52 +0100367 if (!desc->depth++)
Thomas Gleixner87923472011-02-03 12:27:44 +0100368 irq_disable(desc);
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100369}
370
Thomas Gleixner02725e72011-02-12 10:37:36 +0100371static int __disable_irq_nosync(unsigned int irq)
372{
373 unsigned long flags;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +0100374 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
Thomas Gleixner02725e72011-02-12 10:37:36 +0100375
376 if (!desc)
377 return -EINVAL;
378 __disable_irq(desc, irq, false);
379 irq_put_desc_busunlock(desc, flags);
380 return 0;
381}
382
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383/**
384 * disable_irq_nosync - disable an irq without waiting
385 * @irq: Interrupt to disable
386 *
387 * Disable the selected interrupt line. Disables and Enables are
388 * nested.
389 * Unlike disable_irq(), this function does not ensure existing
390 * instances of the IRQ handler have completed before returning.
391 *
392 * This function may be called from IRQ context.
393 */
394void disable_irq_nosync(unsigned int irq)
395{
Thomas Gleixner02725e72011-02-12 10:37:36 +0100396 __disable_irq_nosync(irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398EXPORT_SYMBOL(disable_irq_nosync);
399
400/**
401 * disable_irq - disable an irq and wait for completion
402 * @irq: Interrupt to disable
403 *
404 * Disable the selected interrupt line. Enables and Disables are
405 * nested.
406 * This function waits for any pending IRQ handlers for this interrupt
407 * to complete before returning. If you use this function while
408 * holding a resource the IRQ handler may need you will deadlock.
409 *
410 * This function may be called - with care - from IRQ context.
411 */
412void disable_irq(unsigned int irq)
413{
Thomas Gleixner02725e72011-02-12 10:37:36 +0100414 if (!__disable_irq_nosync(irq))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 synchronize_irq(irq);
416}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417EXPORT_SYMBOL(disable_irq);
418
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100419void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume)
Thomas Gleixner1adb0852008-04-28 17:01:56 +0200420{
Thomas Gleixnerdc5f2192011-02-04 13:19:20 +0100421 if (resume) {
Thomas Gleixnerc531e832011-02-08 12:44:58 +0100422 if (!(desc->istate & IRQS_SUSPENDED)) {
Thomas Gleixnerdc5f2192011-02-04 13:19:20 +0100423 if (!desc->action)
424 return;
425 if (!(desc->action->flags & IRQF_FORCE_RESUME))
426 return;
427 /* Pretend that it got disabled ! */
428 desc->depth++;
429 }
Thomas Gleixnerc531e832011-02-08 12:44:58 +0100430 desc->istate &= ~IRQS_SUSPENDED;
Thomas Gleixnerdc5f2192011-02-04 13:19:20 +0100431 }
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100432
Thomas Gleixner1adb0852008-04-28 17:01:56 +0200433 switch (desc->depth) {
434 case 0:
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100435 err_out:
Arjan van de Venb8c512f2008-07-25 19:45:36 -0700436 WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
Thomas Gleixner1adb0852008-04-28 17:01:56 +0200437 break;
438 case 1: {
Thomas Gleixnerc531e832011-02-08 12:44:58 +0100439 if (desc->istate & IRQS_SUSPENDED)
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100440 goto err_out;
Thomas Gleixner1adb0852008-04-28 17:01:56 +0200441 /* Prevent probing on this irq: */
Thomas Gleixner1ccb4e62011-02-09 14:44:17 +0100442 irq_settings_set_noprobe(desc);
Thomas Gleixner3aae9942011-02-04 10:17:52 +0100443 irq_enable(desc);
Thomas Gleixner1adb0852008-04-28 17:01:56 +0200444 check_irq_resend(desc, irq);
445 /* fall-through */
446 }
447 default:
448 desc->depth--;
449 }
450}
451
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452/**
453 * enable_irq - enable handling of an irq
454 * @irq: Interrupt to enable
455 *
456 * Undoes the effect of one call to disable_irq(). If this
457 * matches the last disable, processing of interrupts on this
458 * IRQ line is re-enabled.
459 *
Thomas Gleixner70aedd22009-08-13 12:17:48 +0200460 * This function may be called from IRQ context only when
Thomas Gleixner6b8ff312010-10-01 12:58:38 +0200461 * desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
Linus Torvalds1da177e2005-04-16 15:20:36 -0700462 */
463void enable_irq(unsigned int irq)
464{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 unsigned long flags;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +0100466 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467
Yinghai Lu7d94f7c2008-08-19 20:50:14 -0700468 if (!desc)
Matthew Wilcoxc2b5a252005-11-03 07:51:18 -0700469 return;
Thomas Gleixner50f7c032011-02-03 13:23:54 +0100470 if (WARN(!desc->irq_data.chip,
471 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
Thomas Gleixner02725e72011-02-12 10:37:36 +0100472 goto out;
Thomas Gleixner2656c362010-10-22 14:47:57 +0200473
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +0100474 __enable_irq(desc, irq, false);
Thomas Gleixner02725e72011-02-12 10:37:36 +0100475out:
476 irq_put_desc_busunlock(desc, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478EXPORT_SYMBOL(enable_irq);
479
David Brownell0c5d1eb2008-10-01 14:46:18 -0700480static int set_irq_wake_real(unsigned int irq, unsigned int on)
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200481{
Yinghai Lu08678b02008-08-19 20:50:05 -0700482 struct irq_desc *desc = irq_to_desc(irq);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200483 int ret = -ENXIO;
484
Santosh Shilimkar60f96b42011-09-09 13:59:35 +0530485 if (irq_desc_get_chip(desc)->flags & IRQCHIP_SKIP_SET_WAKE)
486 return 0;
487
Thomas Gleixner2f7e99b2010-09-27 12:45:50 +0000488 if (desc->irq_data.chip->irq_set_wake)
489 ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200490
491 return ret;
492}
493
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700494/**
Thomas Gleixnera0cd9ca2011-02-10 11:36:33 +0100495 * irq_set_irq_wake - control irq power management wakeup
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700496 * @irq: interrupt to control
497 * @on: enable/disable power management wakeup
498 *
David Brownell15a647e2006-07-30 03:03:08 -0700499 * Enable/disable power management wakeup mode, which is
500 * disabled by default. Enables and disables must match,
501 * just as they match for non-wakeup mode support.
502 *
503 * Wakeup mode lets this IRQ wake the system from sleep
504 * states like "suspend to RAM".
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700505 */
Thomas Gleixnera0cd9ca2011-02-10 11:36:33 +0100506int irq_set_irq_wake(unsigned int irq, unsigned int on)
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700507{
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700508 unsigned long flags;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +0100509 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200510 int ret = 0;
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700511
Jesper Juhl13863a62011-06-09 23:14:58 +0200512 if (!desc)
513 return -EINVAL;
514
David Brownell15a647e2006-07-30 03:03:08 -0700515 /* wakeup-capable irqs can be shared between drivers that
516 * don't need to have the same sleep mode behaviors.
517 */
David Brownell15a647e2006-07-30 03:03:08 -0700518 if (on) {
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200519 if (desc->wake_depth++ == 0) {
520 ret = set_irq_wake_real(irq, on);
521 if (ret)
522 desc->wake_depth = 0;
523 else
Thomas Gleixner7f942262011-02-10 19:46:26 +0100524 irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200525 }
David Brownell15a647e2006-07-30 03:03:08 -0700526 } else {
527 if (desc->wake_depth == 0) {
Arjan van de Ven7a2c4772008-07-25 01:45:54 -0700528 WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200529 } else if (--desc->wake_depth == 0) {
530 ret = set_irq_wake_real(irq, on);
531 if (ret)
532 desc->wake_depth = 1;
533 else
Thomas Gleixner7f942262011-02-10 19:46:26 +0100534 irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
Uwe Kleine-König2db87322008-07-23 14:42:25 +0200535 }
David Brownell15a647e2006-07-30 03:03:08 -0700536 }
Thomas Gleixner02725e72011-02-12 10:37:36 +0100537 irq_put_desc_busunlock(desc, flags);
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700538 return ret;
539}
Thomas Gleixnera0cd9ca2011-02-10 11:36:33 +0100540EXPORT_SYMBOL(irq_set_irq_wake);
Thomas Gleixnerba9a2332006-06-29 02:24:55 -0700541
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542/*
543 * Internal function that tells the architecture code whether a
544 * particular irq has been exclusively allocated or is available
545 * for driver use.
546 */
547int can_request_irq(unsigned int irq, unsigned long irqflags)
548{
Thomas Gleixnercc8c3b72010-03-23 22:40:53 +0100549 unsigned long flags;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +0100550 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
Thomas Gleixner02725e72011-02-12 10:37:36 +0100551 int canrequest = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552
Yinghai Lu7d94f7c2008-08-19 20:50:14 -0700553 if (!desc)
554 return 0;
555
Thomas Gleixner02725e72011-02-12 10:37:36 +0100556 if (irq_settings_can_request(desc)) {
557 if (desc->action)
558 if (irqflags & desc->action->flags & IRQF_SHARED)
559 canrequest =1;
560 }
561 irq_put_desc_unlock(desc, flags);
562 return canrequest;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563}
564
David Brownell0c5d1eb2008-10-01 14:46:18 -0700565int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
Thomas Gleixnerb2ba2c32010-09-27 12:45:47 +0000566 unsigned long flags)
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700567{
Thomas Gleixner6b8ff312010-10-01 12:58:38 +0200568 struct irq_chip *chip = desc->irq_data.chip;
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100569 int ret, unmask = 0;
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700570
Thomas Gleixnerb2ba2c32010-09-27 12:45:47 +0000571 if (!chip || !chip->irq_set_type) {
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700572 /*
573 * IRQF_TRIGGER_* but the PIC does not support multiple
574 * flow-types?
575 */
Andrew Morton97fd75b2012-05-31 16:26:07 -0700576 pr_debug("No set_type function for IRQ %d (%s)\n", irq,
Thomas Gleixnerf5d89472012-04-19 12:06:13 +0200577 chip ? (chip->name ? : "unknown") : "unknown");
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700578 return 0;
579 }
580
Thomas Gleixner876dbd42011-02-08 17:28:12 +0100581 flags &= IRQ_TYPE_SENSE_MASK;
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100582
583 if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
Thomas Gleixner32f41252011-03-28 14:10:52 +0200584 if (!irqd_irq_masked(&desc->irq_data))
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100585 mask_irq(desc);
Thomas Gleixner32f41252011-03-28 14:10:52 +0200586 if (!irqd_irq_disabled(&desc->irq_data))
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100587 unmask = 1;
588 }
589
David Brownellf2b662d2008-12-01 14:31:38 -0800590 /* caller masked out all except trigger mode flags */
Thomas Gleixnerb2ba2c32010-09-27 12:45:47 +0000591 ret = chip->irq_set_type(&desc->irq_data, flags);
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700592
Thomas Gleixner876dbd42011-02-08 17:28:12 +0100593 switch (ret) {
594 case IRQ_SET_MASK_OK:
595 irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
596 irqd_set(&desc->irq_data, flags);
597
598 case IRQ_SET_MASK_OK_NOCOPY:
599 flags = irqd_get_trigger_type(&desc->irq_data);
600 irq_settings_set_trigger_mask(desc, flags);
601 irqd_clear(&desc->irq_data, IRQD_LEVEL);
602 irq_settings_clr_level(desc);
603 if (flags & IRQ_TYPE_LEVEL_MASK) {
604 irq_settings_set_level(desc);
605 irqd_set(&desc->irq_data, IRQD_LEVEL);
606 }
Thomas Gleixner46732472010-06-07 17:53:51 +0200607
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100608 ret = 0;
Thomas Gleixner8fff39e2011-02-21 14:19:42 +0100609 break;
Thomas Gleixner876dbd42011-02-08 17:28:12 +0100610 default:
Andrew Morton97fd75b2012-05-31 16:26:07 -0700611 pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
Thomas Gleixner876dbd42011-02-08 17:28:12 +0100612 flags, irq, chip->irq_set_type);
David Brownell0c5d1eb2008-10-01 14:46:18 -0700613 }
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100614 if (unmask)
615 unmask_irq(desc);
Uwe Kleine-König82736f42008-07-23 21:28:54 -0700616 return ret;
617}
618
Thomas Gleixnerb25c3402009-08-13 12:17:22 +0200619/*
620 * Default primary interrupt handler for threaded interrupts. Is
621 * assigned as primary handler when request_threaded_irq is called
622 * with handler == NULL. Useful for oneshot interrupts.
623 */
624static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
625{
626 return IRQ_WAKE_THREAD;
627}
628
Thomas Gleixner399b5da2009-08-13 13:21:38 +0200629/*
630 * Primary handler for nested threaded interrupts. Should never be
631 * called.
632 */
633static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
634{
635 WARN(1, "Primary handler called for nested irq %d\n", irq);
636 return IRQ_NONE;
637}
638
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100639static int irq_wait_for_interrupt(struct irqaction *action)
640{
Ido Yariv550acb12011-12-01 13:55:08 +0200641 set_current_state(TASK_INTERRUPTIBLE);
642
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100643 while (!kthread_should_stop()) {
Thomas Gleixnerf48fe812009-03-24 11:46:22 +0100644
645 if (test_and_clear_bit(IRQTF_RUNTHREAD,
646 &action->thread_flags)) {
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100647 __set_current_state(TASK_RUNNING);
648 return 0;
Thomas Gleixnerf48fe812009-03-24 11:46:22 +0100649 }
650 schedule();
Ido Yariv550acb12011-12-01 13:55:08 +0200651 set_current_state(TASK_INTERRUPTIBLE);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100652 }
Ido Yariv550acb12011-12-01 13:55:08 +0200653 __set_current_state(TASK_RUNNING);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100654 return -1;
655}
656
Thomas Gleixnerb25c3402009-08-13 12:17:22 +0200657/*
658 * Oneshot interrupts keep the irq line masked until the threaded
659 * handler finished. unmask if the interrupt has not been disabled and
660 * is marked MASKED.
661 */
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000662static void irq_finalize_oneshot(struct irq_desc *desc,
Alexander Gordeevf3f79e32012-03-21 17:22:35 +0100663 struct irqaction *action)
Thomas Gleixnerb25c3402009-08-13 12:17:22 +0200664{
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000665 if (!(desc->istate & IRQS_ONESHOT))
666 return;
Thomas Gleixner0b1adaa2010-03-09 19:45:54 +0100667again:
Thomas Gleixner3876ec92010-09-27 12:44:35 +0000668 chip_bus_lock(desc);
Thomas Gleixner239007b2009-11-17 16:46:45 +0100669 raw_spin_lock_irq(&desc->lock);
Thomas Gleixner0b1adaa2010-03-09 19:45:54 +0100670
671 /*
672 * Implausible though it may be we need to protect us against
673 * the following scenario:
674 *
675 * The thread is faster done than the hard interrupt handler
676 * on the other CPU. If we unmask the irq line then the
677 * interrupt can come in again and masks the line, leaves due
Thomas Gleixner009b4c32011-02-07 21:48:49 +0100678 * to IRQS_INPROGRESS and the irq line is masked forever.
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000679 *
680 * This also serializes the state of shared oneshot handlers
681 * versus "desc->threads_onehsot |= action->thread_mask;" in
682 * irq_wake_thread(). See the comment there which explains the
683 * serialization.
Thomas Gleixner0b1adaa2010-03-09 19:45:54 +0100684 */
Thomas Gleixner32f41252011-03-28 14:10:52 +0200685 if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
Thomas Gleixner0b1adaa2010-03-09 19:45:54 +0100686 raw_spin_unlock_irq(&desc->lock);
Thomas Gleixner3876ec92010-09-27 12:44:35 +0000687 chip_bus_sync_unlock(desc);
Thomas Gleixner0b1adaa2010-03-09 19:45:54 +0100688 cpu_relax();
689 goto again;
690 }
691
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000692 /*
693 * Now check again, whether the thread should run. Otherwise
694 * we would clear the threads_oneshot bit of this thread which
695 * was just set.
696 */
Alexander Gordeevf3f79e32012-03-21 17:22:35 +0100697 if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000698 goto out_unlock;
699
700 desc->threads_oneshot &= ~action->thread_mask;
701
Thomas Gleixner32f41252011-03-28 14:10:52 +0200702 if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
703 irqd_irq_masked(&desc->irq_data))
704 unmask_irq(desc);
705
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000706out_unlock:
Thomas Gleixner239007b2009-11-17 16:46:45 +0100707 raw_spin_unlock_irq(&desc->lock);
Thomas Gleixner3876ec92010-09-27 12:44:35 +0000708 chip_bus_sync_unlock(desc);
Thomas Gleixnerb25c3402009-08-13 12:17:22 +0200709}
710
Bruno Premont61f38262009-07-22 22:22:32 +0200711#ifdef CONFIG_SMP
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100712/*
Thomas Gleixnerd4d5e082011-02-10 13:16:14 +0100713 * Check whether we need to chasnge the affinity of the interrupt thread.
Thomas Gleixner591d2fb2009-07-21 11:09:39 +0200714 */
715static void
716irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
717{
718 cpumask_var_t mask;
719
720 if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
721 return;
722
723 /*
724 * In case we are out of memory we set IRQTF_AFFINITY again and
725 * try again next time
726 */
727 if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
728 set_bit(IRQTF_AFFINITY, &action->thread_flags);
729 return;
730 }
731
Thomas Gleixner239007b2009-11-17 16:46:45 +0100732 raw_spin_lock_irq(&desc->lock);
Thomas Gleixner6b8ff312010-10-01 12:58:38 +0200733 cpumask_copy(mask, desc->irq_data.affinity);
Thomas Gleixner239007b2009-11-17 16:46:45 +0100734 raw_spin_unlock_irq(&desc->lock);
Thomas Gleixner591d2fb2009-07-21 11:09:39 +0200735
736 set_cpus_allowed_ptr(current, mask);
737 free_cpumask_var(mask);
738}
Bruno Premont61f38262009-07-22 22:22:32 +0200739#else
740static inline void
741irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
742#endif
Thomas Gleixner591d2fb2009-07-21 11:09:39 +0200743
744/*
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000745 * Interrupts which are not explicitely requested as threaded
746 * interrupts rely on the implicit bh/preempt disable of the hard irq
747 * context. So we need to disable bh here to avoid deadlocks and other
748 * side effects.
749 */
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200750static irqreturn_t
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000751irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
752{
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200753 irqreturn_t ret;
754
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000755 local_bh_disable();
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200756 ret = action->thread_fn(action->irq, action->dev_id);
Alexander Gordeevf3f79e32012-03-21 17:22:35 +0100757 irq_finalize_oneshot(desc, action);
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000758 local_bh_enable();
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200759 return ret;
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000760}
761
762/*
763 * Interrupts explicitely requested as threaded interupts want to be
764 * preemtible - many of them need to sleep and wait for slow busses to
765 * complete.
766 */
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200767static irqreturn_t irq_thread_fn(struct irq_desc *desc,
768 struct irqaction *action)
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000769{
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200770 irqreturn_t ret;
771
772 ret = action->thread_fn(action->irq, action->dev_id);
Alexander Gordeevf3f79e32012-03-21 17:22:35 +0100773 irq_finalize_oneshot(desc, action);
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200774 return ret;
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000775}
776
Ido Yariv7140ea12011-12-02 18:24:12 +0200777static void wake_threads_waitq(struct irq_desc *desc)
778{
779 if (atomic_dec_and_test(&desc->threads_active) &&
780 waitqueue_active(&desc->wait_for_threads))
781 wake_up(&desc->wait_for_threads);
782}
783
Al Viro67d12142012-06-27 11:07:19 +0400784static void irq_thread_dtor(struct callback_head *unused)
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +1000785{
786 struct task_struct *tsk = current;
787 struct irq_desc *desc;
788 struct irqaction *action;
789
790 if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
791 return;
792
793 action = kthread_data(tsk);
794
Linus Torvaldsfb21aff2012-05-31 18:47:30 -0700795 pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +1000796 tsk->comm ? tsk->comm : "", tsk->pid, action->irq);
797
798
799 desc = irq_to_desc(action->irq);
800 /*
801 * If IRQTF_RUNTHREAD is set, we need to decrement
802 * desc->threads_active and wake possible waiters.
803 */
804 if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
805 wake_threads_waitq(desc);
806
807 /* Prevent a stale desc->threads_oneshot */
808 irq_finalize_oneshot(desc, action);
809}
810
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000811/*
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100812 * Interrupt handler thread
813 */
814static int irq_thread(void *data)
815{
Al Viro67d12142012-06-27 11:07:19 +0400816 struct callback_head on_exit_work;
Peter Zijlstrac9b5f502011-01-07 13:41:40 +0100817 static const struct sched_param param = {
KOSAKI Motohirofe7de492010-10-20 16:01:12 -0700818 .sched_priority = MAX_USER_RT_PRIO/2,
819 };
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100820 struct irqaction *action = data;
821 struct irq_desc *desc = irq_to_desc(action->irq);
Sebastian Andrzej Siewior3a43e052011-05-31 08:56:11 +0200822 irqreturn_t (*handler_fn)(struct irq_desc *desc,
823 struct irqaction *action);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100824
Alexander Gordeev540b60e2012-03-09 14:59:13 +0100825 if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000826 &action->thread_flags))
827 handler_fn = irq_forced_thread_fn;
828 else
829 handler_fn = irq_thread_fn;
830
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100831 sched_setscheduler(current, SCHED_FIFO, &param);
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +1000832
Al Viro41f9d292012-06-26 22:10:04 +0400833 init_task_work(&on_exit_work, irq_thread_dtor);
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +1000834 task_work_add(current, &on_exit_work, false);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100835
836 while (!irq_wait_for_interrupt(action)) {
Ido Yariv7140ea12011-12-02 18:24:12 +0200837 irqreturn_t action_ret;
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100838
Thomas Gleixner591d2fb2009-07-21 11:09:39 +0200839 irq_thread_check_affinity(desc, action);
840
Ido Yariv7140ea12011-12-02 18:24:12 +0200841 action_ret = handler_fn(desc, action);
842 if (!noirqdebug)
843 note_interrupt(action->irq, desc, action_ret);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100844
Ido Yariv7140ea12011-12-02 18:24:12 +0200845 wake_threads_waitq(desc);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100846 }
847
Ido Yariv7140ea12011-12-02 18:24:12 +0200848 /*
849 * This is the regular exit path. __free_irq() is stopping the
850 * thread via kthread_stop() after calling
851 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
Thomas Gleixnere04268b2012-03-15 22:55:21 +0100852 * oneshot mask bit can be set. We cannot verify that as we
853 * cannot touch the oneshot mask at this point anymore as
854 * __setup_irq() might have given out currents thread_mask
855 * again.
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100856 */
Oleg Nesterov4d1d61a2012-05-11 10:59:08 +1000857 task_work_cancel(current, irq_thread_dtor);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100858 return 0;
859}
860
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000861static void irq_setup_forced_threading(struct irqaction *new)
862{
863 if (!force_irqthreads)
864 return;
865 if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
866 return;
867
868 new->flags |= IRQF_ONESHOT;
869
870 if (!new->thread_fn) {
871 set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
872 new->thread_fn = new->handler;
873 new->handler = irq_default_primary_handler;
874 }
875}
876
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877/*
878 * Internal function to register an irqaction - typically used to
879 * allocate special interrupts that are part of the architecture.
880 */
Thomas Gleixnerd3c60042008-10-16 09:55:00 +0200881static int
Ingo Molnar327ec562009-02-15 11:21:37 +0100882__setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700883{
Ingo Molnarf17c7542009-02-17 20:43:37 +0100884 struct irqaction *old, **old_ptr;
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000885 unsigned long flags, thread_mask = 0;
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100886 int ret, nested, shared = 0;
887 cpumask_var_t mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888
Yinghai Lu7d94f7c2008-08-19 20:50:14 -0700889 if (!desc)
Matthew Wilcoxc2b5a252005-11-03 07:51:18 -0700890 return -EINVAL;
891
Thomas Gleixner6b8ff312010-10-01 12:58:38 +0200892 if (desc->irq_data.chip == &no_irq_chip)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893 return -ENOSYS;
Sebastian Andrzej Siewiorb6873802011-07-11 12:17:31 +0200894 if (!try_module_get(desc->owner))
895 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896 /*
897 * Some drivers like serial.c use request_irq() heavily,
898 * so we have to be careful not to interfere with a
899 * running system.
900 */
Thomas Gleixner3cca53b2006-07-01 19:29:31 -0700901 if (new->flags & IRQF_SAMPLE_RANDOM) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902 /*
903 * This function might sleep, we want to call it first,
904 * outside of the atomic block.
905 * Yes, this might clear the entropy pool if the wrong
906 * driver is attempted to be loaded, without actually
907 * installing a new handler, but is this really a problem,
908 * only the sysadmin is able to do this.
909 */
910 rand_initialize_irq(irq);
911 }
912
913 /*
Thomas Gleixner399b5da2009-08-13 13:21:38 +0200914 * Check whether the interrupt nests into another interrupt
915 * thread.
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100916 */
Thomas Gleixner1ccb4e62011-02-09 14:44:17 +0100917 nested = irq_settings_is_nested_thread(desc);
Thomas Gleixner399b5da2009-08-13 13:21:38 +0200918 if (nested) {
Sebastian Andrzej Siewiorb6873802011-07-11 12:17:31 +0200919 if (!new->thread_fn) {
920 ret = -EINVAL;
921 goto out_mput;
922 }
Thomas Gleixner399b5da2009-08-13 13:21:38 +0200923 /*
924 * Replace the primary handler which was provided from
925 * the driver for non nested interrupt handling by the
926 * dummy function which warns when called.
927 */
928 new->handler = irq_nested_primary_handler;
Thomas Gleixner8d32a302011-02-23 23:52:23 +0000929 } else {
Paul Mundt7f1b1242011-04-07 06:01:44 +0900930 if (irq_settings_can_thread(desc))
931 irq_setup_forced_threading(new);
Thomas Gleixner399b5da2009-08-13 13:21:38 +0200932 }
933
934 /*
935 * Create a handler thread when a thread function is supplied
936 * and the interrupt does not nest into another interrupt
937 * thread.
938 */
939 if (new->thread_fn && !nested) {
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100940 struct task_struct *t;
941
942 t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
943 new->name);
Sebastian Andrzej Siewiorb6873802011-07-11 12:17:31 +0200944 if (IS_ERR(t)) {
945 ret = PTR_ERR(t);
946 goto out_mput;
947 }
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100948 /*
949 * We keep the reference to the task struct even if
950 * the thread dies to avoid that the interrupt code
951 * references an already freed task_struct.
952 */
953 get_task_struct(t);
954 new->thread = t;
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100955 }
956
Thomas Gleixner3b8249e2011-02-07 16:02:20 +0100957 if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
958 ret = -ENOMEM;
959 goto out_thread;
960 }
961
Thomas Gleixner3aa551c2009-03-23 18:28:15 +0100962 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963 * The following block of code has to be executed atomically
964 */
Thomas Gleixner239007b2009-11-17 16:46:45 +0100965 raw_spin_lock_irqsave(&desc->lock, flags);
Ingo Molnarf17c7542009-02-17 20:43:37 +0100966 old_ptr = &desc->action;
967 old = *old_ptr;
Ingo Molnar06fcb0c2006-06-29 02:24:40 -0700968 if (old) {
Thomas Gleixnere76de9f2006-06-29 02:24:56 -0700969 /*
970 * Can't share interrupts unless both agree to and are
971 * the same type (level, edge, polarity). So both flag
Thomas Gleixner3cca53b2006-07-01 19:29:31 -0700972 * fields must have IRQF_SHARED set and the bits which
Thomas Gleixner9d591ed2011-02-23 23:52:16 +0000973 * set the trigger type must match. Also all must
974 * agree on ONESHOT.
Thomas Gleixnere76de9f2006-06-29 02:24:56 -0700975 */
Thomas Gleixner3cca53b2006-07-01 19:29:31 -0700976 if (!((old->flags & new->flags) & IRQF_SHARED) ||
Thomas Gleixner9d591ed2011-02-23 23:52:16 +0000977 ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
Thomas Gleixnerf5d89472012-04-19 12:06:13 +0200978 ((old->flags ^ new->flags) & IRQF_ONESHOT))
Dimitri Sivanichf5163422006-03-25 03:08:23 -0800979 goto mismatch;
980
Dimitri Sivanichf5163422006-03-25 03:08:23 -0800981 /* All handlers must agree on per-cpuness */
Thomas Gleixner3cca53b2006-07-01 19:29:31 -0700982 if ((old->flags & IRQF_PERCPU) !=
983 (new->flags & IRQF_PERCPU))
Dimitri Sivanichf5163422006-03-25 03:08:23 -0800984 goto mismatch;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700985
986 /* add new interrupt at end of irq queue */
987 do {
Thomas Gleixner52abb702012-03-06 23:18:54 +0100988 /*
989 * Or all existing action->thread_mask bits,
990 * so we can find the next zero bit for this
991 * new action.
992 */
Thomas Gleixnerb5faba22011-02-23 23:52:13 +0000993 thread_mask |= old->thread_mask;
Ingo Molnarf17c7542009-02-17 20:43:37 +0100994 old_ptr = &old->next;
995 old = *old_ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996 } while (old);
997 shared = 1;
998 }
999
Thomas Gleixnerb5faba22011-02-23 23:52:13 +00001000 /*
Thomas Gleixner52abb702012-03-06 23:18:54 +01001001 * Setup the thread mask for this irqaction for ONESHOT. For
1002 * !ONESHOT irqs the thread mask is 0 so we can avoid a
1003 * conditional in irq_wake_thread().
Thomas Gleixnerb5faba22011-02-23 23:52:13 +00001004 */
Thomas Gleixner52abb702012-03-06 23:18:54 +01001005 if (new->flags & IRQF_ONESHOT) {
1006 /*
1007 * Unlikely to have 32 resp 64 irqs sharing one line,
1008 * but who knows.
1009 */
1010 if (thread_mask == ~0UL) {
1011 ret = -EBUSY;
1012 goto out_mask;
1013 }
1014 /*
1015 * The thread_mask for the action is or'ed to
1016 * desc->thread_active to indicate that the
1017 * IRQF_ONESHOT thread handler has been woken, but not
1018 * yet finished. The bit is cleared when a thread
1019 * completes. When all threads of a shared interrupt
1020 * line have completed desc->threads_active becomes
1021 * zero and the interrupt line is unmasked. See
1022 * handle.c:irq_wake_thread() for further information.
1023 *
1024 * If no thread is woken by primary (hard irq context)
1025 * interrupt handlers, then desc->threads_active is
1026 * also checked for zero to unmask the irq line in the
1027 * affected hard irq flow handlers
1028 * (handle_[fasteoi|level]_irq).
1029 *
1030 * The new action gets the first zero bit of
1031 * thread_mask assigned. See the loop above which or's
1032 * all existing action->thread_mask bits.
1033 */
1034 new->thread_mask = 1 << ffz(thread_mask);
Thomas Gleixner1c6c6952012-04-19 10:35:17 +02001035
1036 } else if (new->handler == irq_default_primary_handler) {
1037 /*
1038 * The interrupt was requested with handler = NULL, so
1039 * we use the default primary handler for it. But it
1040 * does not have the oneshot flag set. In combination
1041 * with level interrupts this is deadly, because the
1042 * default primary handler just wakes the thread, then
1043 * the irq lines is reenabled, but the device still
1044 * has the level irq asserted. Rinse and repeat....
1045 *
1046 * While this works for edge type interrupts, we play
1047 * it safe and reject unconditionally because we can't
1048 * say for sure which type this interrupt really
1049 * has. The type flags are unreliable as the
1050 * underlying chip implementation can override them.
1051 */
Andrew Morton97fd75b2012-05-31 16:26:07 -07001052 pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
Thomas Gleixner1c6c6952012-04-19 10:35:17 +02001053 irq);
1054 ret = -EINVAL;
1055 goto out_mask;
Thomas Gleixnerb5faba22011-02-23 23:52:13 +00001056 }
Thomas Gleixnerb5faba22011-02-23 23:52:13 +00001057
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 if (!shared) {
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001059 init_waitqueue_head(&desc->wait_for_threads);
1060
Uwe Kleine-König82736f42008-07-23 21:28:54 -07001061 /* Setup the type (level, edge polarity) if configured: */
1062 if (new->flags & IRQF_TRIGGER_MASK) {
David Brownellf2b662d2008-12-01 14:31:38 -08001063 ret = __irq_set_trigger(desc, irq,
1064 new->flags & IRQF_TRIGGER_MASK);
Uwe Kleine-König82736f42008-07-23 21:28:54 -07001065
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001066 if (ret)
Thomas Gleixner3b8249e2011-02-07 16:02:20 +01001067 goto out_mask;
Thomas Gleixner091738a2011-02-14 20:16:43 +01001068 }
Ahmed S. Darwishf75d2222007-05-08 00:27:55 -07001069
Thomas Gleixner009b4c32011-02-07 21:48:49 +01001070 desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
Thomas Gleixner32f41252011-03-28 14:10:52 +02001071 IRQS_ONESHOT | IRQS_WAITING);
1072 irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
Thomas Gleixner94d39e12006-06-29 02:24:50 -07001073
Thomas Gleixnera0056772011-02-08 17:11:03 +01001074 if (new->flags & IRQF_PERCPU) {
1075 irqd_set(&desc->irq_data, IRQD_PER_CPU);
1076 irq_settings_set_per_cpu(desc);
1077 }
Thomas Gleixner6a58fb32011-02-08 15:40:05 +01001078
Thomas Gleixnerb25c3402009-08-13 12:17:22 +02001079 if (new->flags & IRQF_ONESHOT)
Thomas Gleixner3d67bae2011-02-07 21:02:10 +01001080 desc->istate |= IRQS_ONESHOT;
Thomas Gleixnerb25c3402009-08-13 12:17:22 +02001081
Thomas Gleixner1ccb4e62011-02-09 14:44:17 +01001082 if (irq_settings_can_autoenable(desc))
Thomas Gleixnerb4bc7242012-02-08 11:57:52 +01001083 irq_startup(desc, true);
Thomas Gleixner46999232011-02-02 21:41:14 +00001084 else
Thomas Gleixnere76de9f2006-06-29 02:24:56 -07001085 /* Undo nested disables: */
1086 desc->depth = 1;
Max Krasnyansky18404752008-05-29 11:02:52 -07001087
Thomas Gleixner612e3682008-11-07 13:58:46 +01001088 /* Exclude IRQ from balancing if requested */
Thomas Gleixnera0056772011-02-08 17:11:03 +01001089 if (new->flags & IRQF_NOBALANCING) {
1090 irq_settings_set_no_balancing(desc);
1091 irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1092 }
Thomas Gleixner612e3682008-11-07 13:58:46 +01001093
Max Krasnyansky18404752008-05-29 11:02:52 -07001094 /* Set default affinity mask once everything is setup */
Thomas Gleixner3b8249e2011-02-07 16:02:20 +01001095 setup_affinity(irq, desc, mask);
David Brownell0c5d1eb2008-10-01 14:46:18 -07001096
Thomas Gleixner876dbd42011-02-08 17:28:12 +01001097 } else if (new->flags & IRQF_TRIGGER_MASK) {
1098 unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
1099 unsigned int omsk = irq_settings_get_trigger_mask(desc);
1100
1101 if (nmsk != omsk)
1102 /* hope the handler works with current trigger mode */
Andrew Morton97fd75b2012-05-31 16:26:07 -07001103 pr_warning("irq %d uses trigger mode %u; requested %u\n",
Thomas Gleixner876dbd42011-02-08 17:28:12 +01001104 irq, nmsk, omsk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001105 }
Uwe Kleine-König82736f42008-07-23 21:28:54 -07001106
Thomas Gleixner69ab8492009-08-17 14:07:16 +02001107 new->irq = irq;
Ingo Molnarf17c7542009-02-17 20:43:37 +01001108 *old_ptr = new;
Uwe Kleine-König82736f42008-07-23 21:28:54 -07001109
Linus Torvalds8528b0f2007-01-23 14:16:31 -08001110 /* Reset broken irq detection when installing new handler */
1111 desc->irq_count = 0;
1112 desc->irqs_unhandled = 0;
Thomas Gleixner1adb0852008-04-28 17:01:56 +02001113
1114 /*
1115 * Check whether we disabled the irq via the spurious handler
1116 * before. Reenable it and give it another chance.
1117 */
Thomas Gleixner7acdd532011-02-07 20:40:54 +01001118 if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
1119 desc->istate &= ~IRQS_SPURIOUS_DISABLED;
Rafael J. Wysocki0a0c5162009-03-16 22:33:49 +01001120 __enable_irq(desc, irq, false);
Thomas Gleixner1adb0852008-04-28 17:01:56 +02001121 }
1122
Thomas Gleixner239007b2009-11-17 16:46:45 +01001123 raw_spin_unlock_irqrestore(&desc->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124
Thomas Gleixner69ab8492009-08-17 14:07:16 +02001125 /*
1126 * Strictly no need to wake it up, but hung_task complains
1127 * when no hard interrupt wakes the thread up.
1128 */
1129 if (new->thread)
1130 wake_up_process(new->thread);
1131
Yinghai Lu2c6927a2008-08-19 20:50:11 -07001132 register_irq_proc(irq, desc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 new->dir = NULL;
1134 register_handler_proc(irq, new);
Xiaotian Feng4f5058c2011-04-02 19:39:35 +08001135 free_cpumask_var(mask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136
1137 return 0;
Dimitri Sivanichf5163422006-03-25 03:08:23 -08001138
1139mismatch:
Thomas Gleixner3cca53b2006-07-01 19:29:31 -07001140 if (!(new->flags & IRQF_PROBE_SHARED)) {
Andrew Morton97fd75b2012-05-31 16:26:07 -07001141 pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
Thomas Gleixnerf5d89472012-04-19 12:06:13 +02001142 irq, new->flags, new->name, old->flags, old->name);
1143#ifdef CONFIG_DEBUG_SHIRQ
Andrew Morton13e87ec2006-04-27 18:39:18 -07001144 dump_stack();
Alan Cox3f050442007-02-12 00:52:04 -08001145#endif
Thomas Gleixnerf5d89472012-04-19 12:06:13 +02001146 }
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001147 ret = -EBUSY;
1148
Thomas Gleixner3b8249e2011-02-07 16:02:20 +01001149out_mask:
Dan Carpenter1c389792011-03-17 14:43:07 +03001150 raw_spin_unlock_irqrestore(&desc->lock, flags);
Thomas Gleixner3b8249e2011-02-07 16:02:20 +01001151 free_cpumask_var(mask);
1152
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001153out_thread:
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001154 if (new->thread) {
1155 struct task_struct *t = new->thread;
1156
1157 new->thread = NULL;
Alexander Gordeev05d74ef2012-03-09 14:59:40 +01001158 kthread_stop(t);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001159 put_task_struct(t);
1160 }
Sebastian Andrzej Siewiorb6873802011-07-11 12:17:31 +02001161out_mput:
1162 module_put(desc->owner);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001163 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001164}
1165
1166/**
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001167 * setup_irq - setup an interrupt
1168 * @irq: Interrupt line to setup
1169 * @act: irqaction for the interrupt
1170 *
1171 * Used to statically setup interrupts in the early boot process.
1172 */
1173int setup_irq(unsigned int irq, struct irqaction *act)
1174{
David Daney986c0112011-02-09 16:04:25 -08001175 int retval;
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001176 struct irq_desc *desc = irq_to_desc(irq);
1177
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001178 if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1179 return -EINVAL;
David Daney986c0112011-02-09 16:04:25 -08001180 chip_bus_lock(desc);
1181 retval = __setup_irq(irq, desc, act);
1182 chip_bus_sync_unlock(desc);
1183
1184 return retval;
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001185}
Magnus Dammeb53b4e2009-03-12 21:05:59 +09001186EXPORT_SYMBOL_GPL(setup_irq);
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001187
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001188/*
Magnus Dammcbf94f02009-03-12 21:05:51 +09001189 * Internal function to unregister an irqaction - used to free
1190 * regular and special interrupts that are part of the architecture.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001191 */
Magnus Dammcbf94f02009-03-12 21:05:51 +09001192static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001193{
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001194 struct irq_desc *desc = irq_to_desc(irq);
Ingo Molnarf17c7542009-02-17 20:43:37 +01001195 struct irqaction *action, **action_ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001196 unsigned long flags;
1197
Ingo Molnarae88a232009-02-15 11:29:50 +01001198 WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
Yinghai Lu7d94f7c2008-08-19 20:50:14 -07001199
Yinghai Lu7d94f7c2008-08-19 20:50:14 -07001200 if (!desc)
Magnus Dammf21cfb22009-03-12 21:05:42 +09001201 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001202
Thomas Gleixner239007b2009-11-17 16:46:45 +01001203 raw_spin_lock_irqsave(&desc->lock, flags);
Ingo Molnarae88a232009-02-15 11:29:50 +01001204
1205 /*
1206 * There can be multiple actions per IRQ descriptor, find the right
1207 * one based on the dev_id:
1208 */
Ingo Molnarf17c7542009-02-17 20:43:37 +01001209 action_ptr = &desc->action;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001210 for (;;) {
Ingo Molnarf17c7542009-02-17 20:43:37 +01001211 action = *action_ptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212
Ingo Molnarae88a232009-02-15 11:29:50 +01001213 if (!action) {
1214 WARN(1, "Trying to free already-free IRQ %d\n", irq);
Thomas Gleixner239007b2009-11-17 16:46:45 +01001215 raw_spin_unlock_irqrestore(&desc->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216
Magnus Dammf21cfb22009-03-12 21:05:42 +09001217 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 }
Ingo Molnarae88a232009-02-15 11:29:50 +01001219
Ingo Molnar8316e382009-02-17 20:28:29 +01001220 if (action->dev_id == dev_id)
1221 break;
Ingo Molnarf17c7542009-02-17 20:43:37 +01001222 action_ptr = &action->next;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001223 }
Ingo Molnarae88a232009-02-15 11:29:50 +01001224
1225 /* Found it - now remove it from the list of entries: */
Ingo Molnarf17c7542009-02-17 20:43:37 +01001226 *action_ptr = action->next;
Ingo Molnarae88a232009-02-15 11:29:50 +01001227
Ingo Molnarae88a232009-02-15 11:29:50 +01001228 /* If this was the last handler, shut down the IRQ line: */
Thomas Gleixner46999232011-02-02 21:41:14 +00001229 if (!desc->action)
1230 irq_shutdown(desc);
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001231
Peter P Waskiewicz Jre7a297b2010-04-30 14:44:50 -07001232#ifdef CONFIG_SMP
1233 /* make sure affinity_hint is cleaned up */
1234 if (WARN_ON_ONCE(desc->affinity_hint))
1235 desc->affinity_hint = NULL;
1236#endif
1237
Thomas Gleixner239007b2009-11-17 16:46:45 +01001238 raw_spin_unlock_irqrestore(&desc->lock, flags);
Ingo Molnarae88a232009-02-15 11:29:50 +01001239
1240 unregister_handler_proc(irq, action);
1241
1242 /* Make sure it's not being used on another CPU: */
1243 synchronize_irq(irq);
1244
1245#ifdef CONFIG_DEBUG_SHIRQ
1246 /*
1247 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1248 * event to happen even now it's being freed, so let's make sure that
1249 * is so by doing an extra call to the handler ....
1250 *
1251 * ( We do this after actually deregistering it, to make sure that a
1252 * 'real' IRQ doesn't run in * parallel with our fake. )
1253 */
1254 if (action->flags & IRQF_SHARED) {
1255 local_irq_save(flags);
1256 action->handler(irq, dev_id);
1257 local_irq_restore(flags);
1258 }
1259#endif
Linus Torvalds2d860ad2009-08-13 13:05:10 -07001260
1261 if (action->thread) {
Alexander Gordeev05d74ef2012-03-09 14:59:40 +01001262 kthread_stop(action->thread);
Linus Torvalds2d860ad2009-08-13 13:05:10 -07001263 put_task_struct(action->thread);
1264 }
1265
Sebastian Andrzej Siewiorb6873802011-07-11 12:17:31 +02001266 module_put(desc->owner);
Magnus Dammf21cfb22009-03-12 21:05:42 +09001267 return action;
1268}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001269
1270/**
Magnus Dammcbf94f02009-03-12 21:05:51 +09001271 * remove_irq - free an interrupt
1272 * @irq: Interrupt line to free
1273 * @act: irqaction for the interrupt
1274 *
1275 * Used to remove interrupts statically setup by the early boot process.
1276 */
1277void remove_irq(unsigned int irq, struct irqaction *act)
1278{
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001279 struct irq_desc *desc = irq_to_desc(irq);
1280
1281 if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1282 __free_irq(irq, act->dev_id);
Magnus Dammcbf94f02009-03-12 21:05:51 +09001283}
Magnus Dammeb53b4e2009-03-12 21:05:59 +09001284EXPORT_SYMBOL_GPL(remove_irq);
Magnus Dammcbf94f02009-03-12 21:05:51 +09001285
1286/**
Magnus Dammf21cfb22009-03-12 21:05:42 +09001287 * free_irq - free an interrupt allocated with request_irq
Linus Torvalds1da177e2005-04-16 15:20:36 -07001288 * @irq: Interrupt line to free
1289 * @dev_id: Device identity to free
1290 *
1291 * Remove an interrupt handler. The handler is removed and if the
1292 * interrupt line is no longer in use by any driver it is disabled.
1293 * On a shared IRQ the caller must ensure the interrupt is disabled
1294 * on the card it drives before calling this function. The function
1295 * does not return until any executing interrupts for this IRQ
1296 * have completed.
1297 *
1298 * This function must not be called from interrupt context.
1299 */
1300void free_irq(unsigned int irq, void *dev_id)
1301{
Thomas Gleixner70aedd22009-08-13 12:17:48 +02001302 struct irq_desc *desc = irq_to_desc(irq);
1303
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001304 if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
Thomas Gleixner70aedd22009-08-13 12:17:48 +02001305 return;
1306
Ben Hutchingscd7eab42011-01-19 21:01:44 +00001307#ifdef CONFIG_SMP
1308 if (WARN_ON(desc->affinity_notify))
1309 desc->affinity_notify = NULL;
1310#endif
1311
Thomas Gleixner3876ec92010-09-27 12:44:35 +00001312 chip_bus_lock(desc);
Magnus Dammcbf94f02009-03-12 21:05:51 +09001313 kfree(__free_irq(irq, dev_id));
Thomas Gleixner3876ec92010-09-27 12:44:35 +00001314 chip_bus_sync_unlock(desc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001316EXPORT_SYMBOL(free_irq);
1317
1318/**
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001319 * request_threaded_irq - allocate an interrupt line
Linus Torvalds1da177e2005-04-16 15:20:36 -07001320 * @irq: Interrupt line to allocate
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001321 * @handler: Function to be called when the IRQ occurs.
1322 * Primary handler for threaded interrupts
Thomas Gleixnerb25c3402009-08-13 12:17:22 +02001323 * If NULL and thread_fn != NULL the default
1324 * primary handler is installed
Thomas Gleixnerf48fe812009-03-24 11:46:22 +01001325 * @thread_fn: Function called from the irq handler thread
1326 * If NULL, no irq thread is created
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327 * @irqflags: Interrupt type flags
1328 * @devname: An ascii name for the claiming device
1329 * @dev_id: A cookie passed back to the handler function
1330 *
1331 * This call allocates interrupt resources and enables the
1332 * interrupt line and IRQ handling. From the point this
1333 * call is made your handler function may be invoked. Since
1334 * your handler function must clear any interrupt the board
1335 * raises, you must take care both to initialise your hardware
1336 * and to set up the interrupt handler in the right order.
1337 *
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001338 * If you want to set up a threaded irq handler for your device
Javi Merino6d21af42011-10-26 10:16:11 +01001339 * then you need to supply @handler and @thread_fn. @handler is
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001340 * still called in hard interrupt context and has to check
1341 * whether the interrupt originates from the device. If yes it
1342 * needs to disable the interrupt on the device and return
Steven Rostedt39a2edd2009-05-12 14:35:54 -04001343 * IRQ_WAKE_THREAD which will wake up the handler thread and run
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001344 * @thread_fn. This split handler design is necessary to support
1345 * shared interrupts.
1346 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07001347 * Dev_id must be globally unique. Normally the address of the
1348 * device data structure is used as the cookie. Since the handler
1349 * receives this value it makes sense to use it.
1350 *
1351 * If your interrupt is shared you must pass a non NULL dev_id
1352 * as this is required when freeing the interrupt.
1353 *
1354 * Flags:
1355 *
Thomas Gleixner3cca53b2006-07-01 19:29:31 -07001356 * IRQF_SHARED Interrupt is shared
Thomas Gleixner3cca53b2006-07-01 19:29:31 -07001357 * IRQF_SAMPLE_RANDOM The interrupt can be used for entropy
David Brownell0c5d1eb2008-10-01 14:46:18 -07001358 * IRQF_TRIGGER_* Specify active edge(s) or level
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359 *
1360 */
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001361int request_threaded_irq(unsigned int irq, irq_handler_t handler,
1362 irq_handler_t thread_fn, unsigned long irqflags,
1363 const char *devname, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364{
Ingo Molnar06fcb0c2006-06-29 02:24:40 -07001365 struct irqaction *action;
Yinghai Lu08678b02008-08-19 20:50:05 -07001366 struct irq_desc *desc;
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001367 int retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368
David Brownell470c6622008-12-01 14:31:37 -08001369 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370 * Sanity-check: shared interrupts must pass in a real dev-ID,
1371 * otherwise we'll have trouble later trying to figure out
1372 * which interrupt is which (messes up the interrupt freeing
1373 * logic etc).
1374 */
Thomas Gleixner3cca53b2006-07-01 19:29:31 -07001375 if ((irqflags & IRQF_SHARED) && !dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001376 return -EINVAL;
Yinghai Lu7d94f7c2008-08-19 20:50:14 -07001377
Yinghai Lucb5bc832008-08-19 20:50:17 -07001378 desc = irq_to_desc(irq);
Yinghai Lu7d94f7c2008-08-19 20:50:14 -07001379 if (!desc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380 return -EINVAL;
Yinghai Lu7d94f7c2008-08-19 20:50:14 -07001381
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001382 if (!irq_settings_can_request(desc) ||
1383 WARN_ON(irq_settings_is_per_cpu_devid(desc)))
Thomas Gleixner6550c772006-06-29 02:24:49 -07001384 return -EINVAL;
Thomas Gleixnerb25c3402009-08-13 12:17:22 +02001385
1386 if (!handler) {
1387 if (!thread_fn)
1388 return -EINVAL;
1389 handler = irq_default_primary_handler;
1390 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391
Thomas Gleixner45535732009-02-22 23:00:32 +01001392 action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001393 if (!action)
1394 return -ENOMEM;
1395
1396 action->handler = handler;
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001397 action->thread_fn = thread_fn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001398 action->flags = irqflags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001399 action->name = devname;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001400 action->dev_id = dev_id;
1401
Thomas Gleixner3876ec92010-09-27 12:44:35 +00001402 chip_bus_lock(desc);
Thomas Gleixnerd3c60042008-10-16 09:55:00 +02001403 retval = __setup_irq(irq, desc, action);
Thomas Gleixner3876ec92010-09-27 12:44:35 +00001404 chip_bus_sync_unlock(desc);
Thomas Gleixner70aedd22009-08-13 12:17:48 +02001405
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001406 if (retval)
1407 kfree(action);
1408
Thomas Gleixner6d83f942011-02-18 23:27:23 +01001409#ifdef CONFIG_DEBUG_SHIRQ_FIXME
Luis Henriques6ce51c42009-04-01 18:06:35 +01001410 if (!retval && (irqflags & IRQF_SHARED)) {
David Woodhousea304e1b2007-02-12 00:52:00 -08001411 /*
1412 * It's a shared IRQ -- the driver ought to be prepared for it
1413 * to happen immediately, so let's make sure....
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001414 * We disable the irq to make sure that a 'real' IRQ doesn't
1415 * run in parallel with our fake.
David Woodhousea304e1b2007-02-12 00:52:00 -08001416 */
Jarek Poplawski59845b12007-08-30 23:56:34 -07001417 unsigned long flags;
David Woodhousea304e1b2007-02-12 00:52:00 -08001418
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001419 disable_irq(irq);
Jarek Poplawski59845b12007-08-30 23:56:34 -07001420 local_irq_save(flags);
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001421
Jarek Poplawski59845b12007-08-30 23:56:34 -07001422 handler(irq, dev_id);
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001423
Jarek Poplawski59845b12007-08-30 23:56:34 -07001424 local_irq_restore(flags);
Anton Vorontsov377bf1e2008-08-21 22:58:28 +04001425 enable_irq(irq);
David Woodhousea304e1b2007-02-12 00:52:00 -08001426 }
1427#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428 return retval;
1429}
Thomas Gleixner3aa551c2009-03-23 18:28:15 +01001430EXPORT_SYMBOL(request_threaded_irq);
Marc Zyngierae731f82010-03-15 22:56:33 +00001431
1432/**
1433 * request_any_context_irq - allocate an interrupt line
1434 * @irq: Interrupt line to allocate
1435 * @handler: Function to be called when the IRQ occurs.
1436 * Threaded handler for threaded interrupts.
1437 * @flags: Interrupt type flags
1438 * @name: An ascii name for the claiming device
1439 * @dev_id: A cookie passed back to the handler function
1440 *
1441 * This call allocates interrupt resources and enables the
1442 * interrupt line and IRQ handling. It selects either a
1443 * hardirq or threaded handling method depending on the
1444 * context.
1445 *
1446 * On failure, it returns a negative value. On success,
1447 * it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1448 */
1449int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1450 unsigned long flags, const char *name, void *dev_id)
1451{
1452 struct irq_desc *desc = irq_to_desc(irq);
1453 int ret;
1454
1455 if (!desc)
1456 return -EINVAL;
1457
Thomas Gleixner1ccb4e62011-02-09 14:44:17 +01001458 if (irq_settings_is_nested_thread(desc)) {
Marc Zyngierae731f82010-03-15 22:56:33 +00001459 ret = request_threaded_irq(irq, NULL, handler,
1460 flags, name, dev_id);
1461 return !ret ? IRQC_IS_NESTED : ret;
1462 }
1463
1464 ret = request_irq(irq, handler, flags, name, dev_id);
1465 return !ret ? IRQC_IS_HARDIRQ : ret;
1466}
1467EXPORT_SYMBOL_GPL(request_any_context_irq);
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001468
Marc Zyngier1e7c5fd2011-09-30 10:48:47 +01001469void enable_percpu_irq(unsigned int irq, unsigned int type)
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001470{
1471 unsigned int cpu = smp_processor_id();
1472 unsigned long flags;
1473 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1474
1475 if (!desc)
1476 return;
1477
Marc Zyngier1e7c5fd2011-09-30 10:48:47 +01001478 type &= IRQ_TYPE_SENSE_MASK;
1479 if (type != IRQ_TYPE_NONE) {
1480 int ret;
1481
1482 ret = __irq_set_trigger(desc, irq, type);
1483
1484 if (ret) {
Thomas Gleixner32cffdd2011-10-04 18:43:57 +02001485 WARN(1, "failed to set type for IRQ%d\n", irq);
Marc Zyngier1e7c5fd2011-09-30 10:48:47 +01001486 goto out;
1487 }
1488 }
1489
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001490 irq_percpu_enable(desc, cpu);
Marc Zyngier1e7c5fd2011-09-30 10:48:47 +01001491out:
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001492 irq_put_desc_unlock(desc, flags);
1493}
1494
1495void disable_percpu_irq(unsigned int irq)
1496{
1497 unsigned int cpu = smp_processor_id();
1498 unsigned long flags;
1499 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1500
1501 if (!desc)
1502 return;
1503
1504 irq_percpu_disable(desc, cpu);
1505 irq_put_desc_unlock(desc, flags);
1506}
1507
1508/*
1509 * Internal function to unregister a percpu irqaction.
1510 */
1511static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
1512{
1513 struct irq_desc *desc = irq_to_desc(irq);
1514 struct irqaction *action;
1515 unsigned long flags;
1516
1517 WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
1518
1519 if (!desc)
1520 return NULL;
1521
1522 raw_spin_lock_irqsave(&desc->lock, flags);
1523
1524 action = desc->action;
1525 if (!action || action->percpu_dev_id != dev_id) {
1526 WARN(1, "Trying to free already-free IRQ %d\n", irq);
1527 goto bad;
1528 }
1529
1530 if (!cpumask_empty(desc->percpu_enabled)) {
1531 WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
1532 irq, cpumask_first(desc->percpu_enabled));
1533 goto bad;
1534 }
1535
1536 /* Found it - now remove it from the list of entries: */
1537 desc->action = NULL;
1538
1539 raw_spin_unlock_irqrestore(&desc->lock, flags);
1540
1541 unregister_handler_proc(irq, action);
1542
1543 module_put(desc->owner);
1544 return action;
1545
1546bad:
1547 raw_spin_unlock_irqrestore(&desc->lock, flags);
1548 return NULL;
1549}
1550
1551/**
1552 * remove_percpu_irq - free a per-cpu interrupt
1553 * @irq: Interrupt line to free
1554 * @act: irqaction for the interrupt
1555 *
1556 * Used to remove interrupts statically setup by the early boot process.
1557 */
1558void remove_percpu_irq(unsigned int irq, struct irqaction *act)
1559{
1560 struct irq_desc *desc = irq_to_desc(irq);
1561
1562 if (desc && irq_settings_is_per_cpu_devid(desc))
1563 __free_percpu_irq(irq, act->percpu_dev_id);
1564}
1565
1566/**
1567 * free_percpu_irq - free an interrupt allocated with request_percpu_irq
1568 * @irq: Interrupt line to free
1569 * @dev_id: Device identity to free
1570 *
1571 * Remove a percpu interrupt handler. The handler is removed, but
1572 * the interrupt line is not disabled. This must be done on each
1573 * CPU before calling this function. The function does not return
1574 * until any executing interrupts for this IRQ have completed.
1575 *
1576 * This function must not be called from interrupt context.
1577 */
1578void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
1579{
1580 struct irq_desc *desc = irq_to_desc(irq);
1581
1582 if (!desc || !irq_settings_is_per_cpu_devid(desc))
1583 return;
1584
1585 chip_bus_lock(desc);
1586 kfree(__free_percpu_irq(irq, dev_id));
1587 chip_bus_sync_unlock(desc);
1588}
1589
1590/**
1591 * setup_percpu_irq - setup a per-cpu interrupt
1592 * @irq: Interrupt line to setup
1593 * @act: irqaction for the interrupt
1594 *
1595 * Used to statically setup per-cpu interrupts in the early boot process.
1596 */
1597int setup_percpu_irq(unsigned int irq, struct irqaction *act)
1598{
1599 struct irq_desc *desc = irq_to_desc(irq);
1600 int retval;
1601
1602 if (!desc || !irq_settings_is_per_cpu_devid(desc))
1603 return -EINVAL;
1604 chip_bus_lock(desc);
1605 retval = __setup_irq(irq, desc, act);
1606 chip_bus_sync_unlock(desc);
1607
1608 return retval;
1609}
1610
1611/**
1612 * request_percpu_irq - allocate a percpu interrupt line
1613 * @irq: Interrupt line to allocate
1614 * @handler: Function to be called when the IRQ occurs.
1615 * @devname: An ascii name for the claiming device
1616 * @dev_id: A percpu cookie passed back to the handler function
1617 *
1618 * This call allocates interrupt resources, but doesn't
1619 * automatically enable the interrupt. It has to be done on each
1620 * CPU using enable_percpu_irq().
1621 *
1622 * Dev_id must be globally unique. It is a per-cpu variable, and
1623 * the handler gets called with the interrupted CPU's instance of
1624 * that variable.
1625 */
1626int request_percpu_irq(unsigned int irq, irq_handler_t handler,
1627 const char *devname, void __percpu *dev_id)
1628{
1629 struct irqaction *action;
1630 struct irq_desc *desc;
1631 int retval;
1632
1633 if (!dev_id)
1634 return -EINVAL;
1635
1636 desc = irq_to_desc(irq);
1637 if (!desc || !irq_settings_can_request(desc) ||
1638 !irq_settings_is_per_cpu_devid(desc))
1639 return -EINVAL;
1640
1641 action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
1642 if (!action)
1643 return -ENOMEM;
1644
1645 action->handler = handler;
Marc Zyngier2ed0e642011-11-16 12:27:39 +00001646 action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
Marc Zyngier31d9d9b2011-09-23 17:03:06 +01001647 action->name = devname;
1648 action->percpu_dev_id = dev_id;
1649
1650 chip_bus_lock(desc);
1651 retval = __setup_irq(irq, desc, action);
1652 chip_bus_sync_unlock(desc);
1653
1654 if (retval)
1655 kfree(action);
1656
1657 return retval;
1658}