xref: /openbmc/linux/kernel/irq/manage.c (revision ce932d0c5589e9766e089c22c66890dfc48fbd94)
1 /*
2  * linux/kernel/irq/manage.c
3  *
4  * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
5  * Copyright (C) 2005-2006 Thomas Gleixner
6  *
7  * This file contains driver APIs to the irq subsystem.
8  */
9 
10 #include <linux/irq.h>
11 #include <linux/kthread.h>
12 #include <linux/module.h>
13 #include <linux/random.h>
14 #include <linux/interrupt.h>
15 #include <linux/slab.h>
16 #include <linux/sched.h>
17 
18 #include "internals.h"
19 
20 #ifdef CONFIG_IRQ_FORCED_THREADING
21 __read_mostly bool force_irqthreads;
22 
23 static int __init setup_forced_irqthreads(char *arg)
24 {
25 	force_irqthreads = true;
26 	return 0;
27 }
28 early_param("threadirqs", setup_forced_irqthreads);
29 #endif
30 
31 /**
32  *	synchronize_irq - wait for pending IRQ handlers (on other CPUs)
33  *	@irq: interrupt number to wait for
34  *
35  *	This function waits for any pending IRQ handlers for this interrupt
36  *	to complete before returning. If you use this function while
37  *	holding a resource the IRQ handler may need you will deadlock.
38  *
39  *	This function may be called - with care - from IRQ context.
40  */
41 void synchronize_irq(unsigned int irq)
42 {
43 	struct irq_desc *desc = irq_to_desc(irq);
44 	bool inprogress;
45 
46 	if (!desc)
47 		return;
48 
49 	do {
50 		unsigned long flags;
51 
52 		/*
53 		 * Wait until we're out of the critical section.  This might
54 		 * give the wrong answer due to the lack of memory barriers.
55 		 */
56 		while (irqd_irq_inprogress(&desc->irq_data))
57 			cpu_relax();
58 
59 		/* Ok, that indicated we're done: double-check carefully. */
60 		raw_spin_lock_irqsave(&desc->lock, flags);
61 		inprogress = irqd_irq_inprogress(&desc->irq_data);
62 		raw_spin_unlock_irqrestore(&desc->lock, flags);
63 
64 		/* Oops, that failed? */
65 	} while (inprogress);
66 
67 	/*
68 	 * We made sure that no hardirq handler is running. Now verify
69 	 * that no threaded handlers are active.
70 	 */
71 	wait_event(desc->wait_for_threads, !atomic_read(&desc->threads_active));
72 }
73 EXPORT_SYMBOL(synchronize_irq);
74 
75 #ifdef CONFIG_SMP
76 cpumask_var_t irq_default_affinity;
77 
78 /**
79  *	irq_can_set_affinity - Check if the affinity of a given irq can be set
80  *	@irq:		Interrupt to check
81  *
82  */
83 int irq_can_set_affinity(unsigned int irq)
84 {
85 	struct irq_desc *desc = irq_to_desc(irq);
86 
87 	if (!desc || !irqd_can_balance(&desc->irq_data) ||
88 	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
89 		return 0;
90 
91 	return 1;
92 }
93 
94 /**
95  *	irq_set_thread_affinity - Notify irq threads to adjust affinity
96  *	@desc:		irq descriptor which has affitnity changed
97  *
98  *	We just set IRQTF_AFFINITY and delegate the affinity setting
99  *	to the interrupt thread itself. We can not call
100  *	set_cpus_allowed_ptr() here as we hold desc->lock and this
101  *	code can be called from hard interrupt context.
102  */
103 void irq_set_thread_affinity(struct irq_desc *desc)
104 {
105 	struct irqaction *action = desc->action;
106 
107 	while (action) {
108 		if (action->thread)
109 			set_bit(IRQTF_AFFINITY, &action->thread_flags);
110 		action = action->next;
111 	}
112 }
113 
114 #ifdef CONFIG_GENERIC_PENDING_IRQ
115 static inline bool irq_can_move_pcntxt(struct irq_data *data)
116 {
117 	return irqd_can_move_in_process_context(data);
118 }
119 static inline bool irq_move_pending(struct irq_data *data)
120 {
121 	return irqd_is_setaffinity_pending(data);
122 }
123 static inline void
124 irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
125 {
126 	cpumask_copy(desc->pending_mask, mask);
127 }
128 static inline void
129 irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
130 {
131 	cpumask_copy(mask, desc->pending_mask);
132 }
133 #else
134 static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
135 static inline bool irq_move_pending(struct irq_data *data) { return false; }
136 static inline void
137 irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
138 static inline void
139 irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
140 #endif
141 
142 int __irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask)
143 {
144 	struct irq_chip *chip = irq_data_get_irq_chip(data);
145 	struct irq_desc *desc = irq_data_to_desc(data);
146 	int ret = 0;
147 
148 	if (!chip || !chip->irq_set_affinity)
149 		return -EINVAL;
150 
151 	if (irq_can_move_pcntxt(data)) {
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 	} else {
161 		irqd_set_move_pending(data);
162 		irq_copy_pending(desc, mask);
163 	}
164 
165 	if (desc->affinity_notify) {
166 		kref_get(&desc->affinity_notify->kref);
167 		schedule_work(&desc->affinity_notify->work);
168 	}
169 	irqd_set(data, IRQD_AFFINITY_SET);
170 
171 	return ret;
172 }
173 
174 /**
175  *	irq_set_affinity - Set the irq affinity of a given irq
176  *	@irq:		Interrupt to set affinity
177  *	@mask:		cpumask
178  *
179  */
180 int irq_set_affinity(unsigned int irq, const struct cpumask *mask)
181 {
182 	struct irq_desc *desc = irq_to_desc(irq);
183 	unsigned long flags;
184 	int ret;
185 
186 	if (!desc)
187 		return -EINVAL;
188 
189 	raw_spin_lock_irqsave(&desc->lock, flags);
190 	ret =  __irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask);
191 	raw_spin_unlock_irqrestore(&desc->lock, flags);
192 	return ret;
193 }
194 
195 int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
196 {
197 	unsigned long flags;
198 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
199 
200 	if (!desc)
201 		return -EINVAL;
202 	desc->affinity_hint = m;
203 	irq_put_desc_unlock(desc, flags);
204 	return 0;
205 }
206 EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
207 
208 static void irq_affinity_notify(struct work_struct *work)
209 {
210 	struct irq_affinity_notify *notify =
211 		container_of(work, struct irq_affinity_notify, work);
212 	struct irq_desc *desc = irq_to_desc(notify->irq);
213 	cpumask_var_t cpumask;
214 	unsigned long flags;
215 
216 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
217 		goto out;
218 
219 	raw_spin_lock_irqsave(&desc->lock, flags);
220 	if (irq_move_pending(&desc->irq_data))
221 		irq_get_pending(cpumask, desc);
222 	else
223 		cpumask_copy(cpumask, desc->irq_data.affinity);
224 	raw_spin_unlock_irqrestore(&desc->lock, flags);
225 
226 	notify->notify(notify, cpumask);
227 
228 	free_cpumask_var(cpumask);
229 out:
230 	kref_put(&notify->kref, notify->release);
231 }
232 
233 /**
234  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
235  *	@irq:		Interrupt for which to enable/disable notification
236  *	@notify:	Context for notification, or %NULL to disable
237  *			notification.  Function pointers must be initialised;
238  *			the other fields will be initialised by this function.
239  *
240  *	Must be called in process context.  Notification may only be enabled
241  *	after the IRQ is allocated and must be disabled before the IRQ is
242  *	freed using free_irq().
243  */
244 int
245 irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
246 {
247 	struct irq_desc *desc = irq_to_desc(irq);
248 	struct irq_affinity_notify *old_notify;
249 	unsigned long flags;
250 
251 	/* The release function is promised process context */
252 	might_sleep();
253 
254 	if (!desc)
255 		return -EINVAL;
256 
257 	/* Complete initialisation of *notify */
258 	if (notify) {
259 		notify->irq = irq;
260 		kref_init(&notify->kref);
261 		INIT_WORK(&notify->work, irq_affinity_notify);
262 	}
263 
264 	raw_spin_lock_irqsave(&desc->lock, flags);
265 	old_notify = desc->affinity_notify;
266 	desc->affinity_notify = notify;
267 	raw_spin_unlock_irqrestore(&desc->lock, flags);
268 
269 	if (old_notify)
270 		kref_put(&old_notify->kref, old_notify->release);
271 
272 	return 0;
273 }
274 EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
275 
276 #ifndef CONFIG_AUTO_IRQ_AFFINITY
277 /*
278  * Generic version of the affinity autoselector.
279  */
280 static int
281 setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
282 {
283 	struct irq_chip *chip = irq_desc_get_chip(desc);
284 	struct cpumask *set = irq_default_affinity;
285 	int ret, node = desc->irq_data.node;
286 
287 	/* Excludes PER_CPU and NO_BALANCE interrupts */
288 	if (!irq_can_set_affinity(irq))
289 		return 0;
290 
291 	/*
292 	 * Preserve an userspace affinity setup, but make sure that
293 	 * one of the targets is online.
294 	 */
295 	if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
296 		if (cpumask_intersects(desc->irq_data.affinity,
297 				       cpu_online_mask))
298 			set = desc->irq_data.affinity;
299 		else
300 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
301 	}
302 
303 	cpumask_and(mask, cpu_online_mask, set);
304 	if (node != NUMA_NO_NODE) {
305 		const struct cpumask *nodemask = cpumask_of_node(node);
306 
307 		/* make sure at least one of the cpus in nodemask is online */
308 		if (cpumask_intersects(mask, nodemask))
309 			cpumask_and(mask, mask, nodemask);
310 	}
311 	ret = chip->irq_set_affinity(&desc->irq_data, mask, false);
312 	switch (ret) {
313 	case IRQ_SET_MASK_OK:
314 		cpumask_copy(desc->irq_data.affinity, mask);
315 	case IRQ_SET_MASK_OK_NOCOPY:
316 		irq_set_thread_affinity(desc);
317 	}
318 	return 0;
319 }
320 #else
321 static inline int
322 setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
323 {
324 	return irq_select_affinity(irq);
325 }
326 #endif
327 
328 /*
329  * Called when affinity is set via /proc/irq
330  */
331 int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
332 {
333 	struct irq_desc *desc = irq_to_desc(irq);
334 	unsigned long flags;
335 	int ret;
336 
337 	raw_spin_lock_irqsave(&desc->lock, flags);
338 	ret = setup_affinity(irq, desc, mask);
339 	raw_spin_unlock_irqrestore(&desc->lock, flags);
340 	return ret;
341 }
342 
343 #else
344 static inline int
345 setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
346 {
347 	return 0;
348 }
349 #endif
350 
351 void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend)
352 {
353 	if (suspend) {
354 		if (!desc->action || (desc->action->flags & IRQF_NO_SUSPEND))
355 			return;
356 		desc->istate |= IRQS_SUSPENDED;
357 	}
358 
359 	if (!desc->depth++)
360 		irq_disable(desc);
361 }
362 
363 static int __disable_irq_nosync(unsigned int irq)
364 {
365 	unsigned long flags;
366 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
367 
368 	if (!desc)
369 		return -EINVAL;
370 	__disable_irq(desc, irq, false);
371 	irq_put_desc_busunlock(desc, flags);
372 	return 0;
373 }
374 
375 /**
376  *	disable_irq_nosync - disable an irq without waiting
377  *	@irq: Interrupt to disable
378  *
379  *	Disable the selected interrupt line.  Disables and Enables are
380  *	nested.
381  *	Unlike disable_irq(), this function does not ensure existing
382  *	instances of the IRQ handler have completed before returning.
383  *
384  *	This function may be called from IRQ context.
385  */
386 void disable_irq_nosync(unsigned int irq)
387 {
388 	__disable_irq_nosync(irq);
389 }
390 EXPORT_SYMBOL(disable_irq_nosync);
391 
392 /**
393  *	disable_irq - disable an irq and wait for completion
394  *	@irq: Interrupt to disable
395  *
396  *	Disable the selected interrupt line.  Enables and Disables are
397  *	nested.
398  *	This function waits for any pending IRQ handlers for this interrupt
399  *	to complete before returning. If you use this function while
400  *	holding a resource the IRQ handler may need you will deadlock.
401  *
402  *	This function may be called - with care - from IRQ context.
403  */
404 void disable_irq(unsigned int irq)
405 {
406 	if (!__disable_irq_nosync(irq))
407 		synchronize_irq(irq);
408 }
409 EXPORT_SYMBOL(disable_irq);
410 
411 void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume)
412 {
413 	if (resume) {
414 		if (!(desc->istate & IRQS_SUSPENDED)) {
415 			if (!desc->action)
416 				return;
417 			if (!(desc->action->flags & IRQF_FORCE_RESUME))
418 				return;
419 			/* Pretend that it got disabled ! */
420 			desc->depth++;
421 		}
422 		desc->istate &= ~IRQS_SUSPENDED;
423 	}
424 
425 	switch (desc->depth) {
426 	case 0:
427  err_out:
428 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
429 		break;
430 	case 1: {
431 		if (desc->istate & IRQS_SUSPENDED)
432 			goto err_out;
433 		/* Prevent probing on this irq: */
434 		irq_settings_set_noprobe(desc);
435 		irq_enable(desc);
436 		check_irq_resend(desc, irq);
437 		/* fall-through */
438 	}
439 	default:
440 		desc->depth--;
441 	}
442 }
443 
444 /**
445  *	enable_irq - enable handling of an irq
446  *	@irq: Interrupt to enable
447  *
448  *	Undoes the effect of one call to disable_irq().  If this
449  *	matches the last disable, processing of interrupts on this
450  *	IRQ line is re-enabled.
451  *
452  *	This function may be called from IRQ context only when
453  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
454  */
455 void enable_irq(unsigned int irq)
456 {
457 	unsigned long flags;
458 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
459 
460 	if (!desc)
461 		return;
462 	if (WARN(!desc->irq_data.chip,
463 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
464 		goto out;
465 
466 	__enable_irq(desc, irq, false);
467 out:
468 	irq_put_desc_busunlock(desc, flags);
469 }
470 EXPORT_SYMBOL(enable_irq);
471 
472 static int set_irq_wake_real(unsigned int irq, unsigned int on)
473 {
474 	struct irq_desc *desc = irq_to_desc(irq);
475 	int ret = -ENXIO;
476 
477 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
478 		return 0;
479 
480 	if (desc->irq_data.chip->irq_set_wake)
481 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
482 
483 	return ret;
484 }
485 
486 /**
487  *	irq_set_irq_wake - control irq power management wakeup
488  *	@irq:	interrupt to control
489  *	@on:	enable/disable power management wakeup
490  *
491  *	Enable/disable power management wakeup mode, which is
492  *	disabled by default.  Enables and disables must match,
493  *	just as they match for non-wakeup mode support.
494  *
495  *	Wakeup mode lets this IRQ wake the system from sleep
496  *	states like "suspend to RAM".
497  */
498 int irq_set_irq_wake(unsigned int irq, unsigned int on)
499 {
500 	unsigned long flags;
501 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
502 	int ret = 0;
503 
504 	if (!desc)
505 		return -EINVAL;
506 
507 	/* wakeup-capable irqs can be shared between drivers that
508 	 * don't need to have the same sleep mode behaviors.
509 	 */
510 	if (on) {
511 		if (desc->wake_depth++ == 0) {
512 			ret = set_irq_wake_real(irq, on);
513 			if (ret)
514 				desc->wake_depth = 0;
515 			else
516 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
517 		}
518 	} else {
519 		if (desc->wake_depth == 0) {
520 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
521 		} else if (--desc->wake_depth == 0) {
522 			ret = set_irq_wake_real(irq, on);
523 			if (ret)
524 				desc->wake_depth = 1;
525 			else
526 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
527 		}
528 	}
529 	irq_put_desc_busunlock(desc, flags);
530 	return ret;
531 }
532 EXPORT_SYMBOL(irq_set_irq_wake);
533 
534 /*
535  * Internal function that tells the architecture code whether a
536  * particular irq has been exclusively allocated or is available
537  * for driver use.
538  */
539 int can_request_irq(unsigned int irq, unsigned long irqflags)
540 {
541 	unsigned long flags;
542 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
543 	int canrequest = 0;
544 
545 	if (!desc)
546 		return 0;
547 
548 	if (irq_settings_can_request(desc)) {
549 		if (desc->action)
550 			if (irqflags & desc->action->flags & IRQF_SHARED)
551 				canrequest =1;
552 	}
553 	irq_put_desc_unlock(desc, flags);
554 	return canrequest;
555 }
556 
557 int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
558 		      unsigned long flags)
559 {
560 	struct irq_chip *chip = desc->irq_data.chip;
561 	int ret, unmask = 0;
562 
563 	if (!chip || !chip->irq_set_type) {
564 		/*
565 		 * IRQF_TRIGGER_* but the PIC does not support multiple
566 		 * flow-types?
567 		 */
568 		pr_debug("No set_type function for IRQ %d (%s)\n", irq,
569 				chip ? (chip->name ? : "unknown") : "unknown");
570 		return 0;
571 	}
572 
573 	flags &= IRQ_TYPE_SENSE_MASK;
574 
575 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
576 		if (!irqd_irq_masked(&desc->irq_data))
577 			mask_irq(desc);
578 		if (!irqd_irq_disabled(&desc->irq_data))
579 			unmask = 1;
580 	}
581 
582 	/* caller masked out all except trigger mode flags */
583 	ret = chip->irq_set_type(&desc->irq_data, flags);
584 
585 	switch (ret) {
586 	case IRQ_SET_MASK_OK:
587 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
588 		irqd_set(&desc->irq_data, flags);
589 
590 	case IRQ_SET_MASK_OK_NOCOPY:
591 		flags = irqd_get_trigger_type(&desc->irq_data);
592 		irq_settings_set_trigger_mask(desc, flags);
593 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
594 		irq_settings_clr_level(desc);
595 		if (flags & IRQ_TYPE_LEVEL_MASK) {
596 			irq_settings_set_level(desc);
597 			irqd_set(&desc->irq_data, IRQD_LEVEL);
598 		}
599 
600 		ret = 0;
601 		break;
602 	default:
603 		pr_err("setting trigger mode %lu for irq %u failed (%pF)\n",
604 		       flags, irq, chip->irq_set_type);
605 	}
606 	if (unmask)
607 		unmask_irq(desc);
608 	return ret;
609 }
610 
611 /*
612  * Default primary interrupt handler for threaded interrupts. Is
613  * assigned as primary handler when request_threaded_irq is called
614  * with handler == NULL. Useful for oneshot interrupts.
615  */
616 static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
617 {
618 	return IRQ_WAKE_THREAD;
619 }
620 
621 /*
622  * Primary handler for nested threaded interrupts. Should never be
623  * called.
624  */
625 static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
626 {
627 	WARN(1, "Primary handler called for nested irq %d\n", irq);
628 	return IRQ_NONE;
629 }
630 
631 static int irq_wait_for_interrupt(struct irqaction *action)
632 {
633 	set_current_state(TASK_INTERRUPTIBLE);
634 
635 	while (!kthread_should_stop()) {
636 
637 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
638 				       &action->thread_flags)) {
639 			__set_current_state(TASK_RUNNING);
640 			return 0;
641 		}
642 		schedule();
643 		set_current_state(TASK_INTERRUPTIBLE);
644 	}
645 	__set_current_state(TASK_RUNNING);
646 	return -1;
647 }
648 
649 /*
650  * Oneshot interrupts keep the irq line masked until the threaded
651  * handler finished. unmask if the interrupt has not been disabled and
652  * is marked MASKED.
653  */
654 static void irq_finalize_oneshot(struct irq_desc *desc,
655 				 struct irqaction *action)
656 {
657 	if (!(desc->istate & IRQS_ONESHOT))
658 		return;
659 again:
660 	chip_bus_lock(desc);
661 	raw_spin_lock_irq(&desc->lock);
662 
663 	/*
664 	 * Implausible though it may be we need to protect us against
665 	 * the following scenario:
666 	 *
667 	 * The thread is faster done than the hard interrupt handler
668 	 * on the other CPU. If we unmask the irq line then the
669 	 * interrupt can come in again and masks the line, leaves due
670 	 * to IRQS_INPROGRESS and the irq line is masked forever.
671 	 *
672 	 * This also serializes the state of shared oneshot handlers
673 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
674 	 * irq_wake_thread(). See the comment there which explains the
675 	 * serialization.
676 	 */
677 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
678 		raw_spin_unlock_irq(&desc->lock);
679 		chip_bus_sync_unlock(desc);
680 		cpu_relax();
681 		goto again;
682 	}
683 
684 	/*
685 	 * Now check again, whether the thread should run. Otherwise
686 	 * we would clear the threads_oneshot bit of this thread which
687 	 * was just set.
688 	 */
689 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
690 		goto out_unlock;
691 
692 	desc->threads_oneshot &= ~action->thread_mask;
693 
694 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
695 	    irqd_irq_masked(&desc->irq_data))
696 		unmask_irq(desc);
697 
698 out_unlock:
699 	raw_spin_unlock_irq(&desc->lock);
700 	chip_bus_sync_unlock(desc);
701 }
702 
703 #ifdef CONFIG_SMP
704 /*
705  * Check whether we need to chasnge the affinity of the interrupt thread.
706  */
707 static void
708 irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
709 {
710 	cpumask_var_t mask;
711 
712 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
713 		return;
714 
715 	/*
716 	 * In case we are out of memory we set IRQTF_AFFINITY again and
717 	 * try again next time
718 	 */
719 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
720 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
721 		return;
722 	}
723 
724 	raw_spin_lock_irq(&desc->lock);
725 	cpumask_copy(mask, desc->irq_data.affinity);
726 	raw_spin_unlock_irq(&desc->lock);
727 
728 	set_cpus_allowed_ptr(current, mask);
729 	free_cpumask_var(mask);
730 }
731 #else
732 static inline void
733 irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
734 #endif
735 
736 /*
737  * Interrupts which are not explicitely requested as threaded
738  * interrupts rely on the implicit bh/preempt disable of the hard irq
739  * context. So we need to disable bh here to avoid deadlocks and other
740  * side effects.
741  */
742 static irqreturn_t
743 irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
744 {
745 	irqreturn_t ret;
746 
747 	local_bh_disable();
748 	ret = action->thread_fn(action->irq, action->dev_id);
749 	irq_finalize_oneshot(desc, action);
750 	local_bh_enable();
751 	return ret;
752 }
753 
754 /*
755  * Interrupts explicitely requested as threaded interupts want to be
756  * preemtible - many of them need to sleep and wait for slow busses to
757  * complete.
758  */
759 static irqreturn_t irq_thread_fn(struct irq_desc *desc,
760 		struct irqaction *action)
761 {
762 	irqreturn_t ret;
763 
764 	ret = action->thread_fn(action->irq, action->dev_id);
765 	irq_finalize_oneshot(desc, action);
766 	return ret;
767 }
768 
769 static void wake_threads_waitq(struct irq_desc *desc)
770 {
771 	if (atomic_dec_and_test(&desc->threads_active) &&
772 	    waitqueue_active(&desc->wait_for_threads))
773 		wake_up(&desc->wait_for_threads);
774 }
775 
776 /*
777  * Interrupt handler thread
778  */
779 static int irq_thread(void *data)
780 {
781 	static const struct sched_param param = {
782 		.sched_priority = MAX_USER_RT_PRIO/2,
783 	};
784 	struct irqaction *action = data;
785 	struct irq_desc *desc = irq_to_desc(action->irq);
786 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
787 			struct irqaction *action);
788 
789 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
790 					&action->thread_flags))
791 		handler_fn = irq_forced_thread_fn;
792 	else
793 		handler_fn = irq_thread_fn;
794 
795 	sched_setscheduler(current, SCHED_FIFO, &param);
796 	current->irq_thread = 1;
797 
798 	while (!irq_wait_for_interrupt(action)) {
799 		irqreturn_t action_ret;
800 
801 		irq_thread_check_affinity(desc, action);
802 
803 		action_ret = handler_fn(desc, action);
804 		if (!noirqdebug)
805 			note_interrupt(action->irq, desc, action_ret);
806 
807 		wake_threads_waitq(desc);
808 	}
809 
810 	/*
811 	 * This is the regular exit path. __free_irq() is stopping the
812 	 * thread via kthread_stop() after calling
813 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
814 	 * oneshot mask bit can be set. We cannot verify that as we
815 	 * cannot touch the oneshot mask at this point anymore as
816 	 * __setup_irq() might have given out currents thread_mask
817 	 * again.
818 	 *
819 	 * Clear irq_thread. Otherwise exit_irq_thread() would make
820 	 * fuzz about an active irq thread going into nirvana.
821 	 */
822 	current->irq_thread = 0;
823 	return 0;
824 }
825 
826 /*
827  * Called from do_exit()
828  */
829 void exit_irq_thread(void)
830 {
831 	struct task_struct *tsk = current;
832 	struct irq_desc *desc;
833 	struct irqaction *action;
834 
835 	if (!tsk->irq_thread)
836 		return;
837 
838 	action = kthread_data(tsk);
839 
840 	printk(KERN_ERR
841 	       "exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
842 	       tsk->comm ? tsk->comm : "", tsk->pid, action->irq);
843 
844 	desc = irq_to_desc(action->irq);
845 
846 	/*
847 	 * If IRQTF_RUNTHREAD is set, we need to decrement
848 	 * desc->threads_active and wake possible waiters.
849 	 */
850 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
851 		wake_threads_waitq(desc);
852 
853 	/* Prevent a stale desc->threads_oneshot */
854 	irq_finalize_oneshot(desc, action);
855 }
856 
857 static void irq_setup_forced_threading(struct irqaction *new)
858 {
859 	if (!force_irqthreads)
860 		return;
861 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
862 		return;
863 
864 	new->flags |= IRQF_ONESHOT;
865 
866 	if (!new->thread_fn) {
867 		set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
868 		new->thread_fn = new->handler;
869 		new->handler = irq_default_primary_handler;
870 	}
871 }
872 
873 /*
874  * Internal function to register an irqaction - typically used to
875  * allocate special interrupts that are part of the architecture.
876  */
877 static int
878 __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
879 {
880 	struct irqaction *old, **old_ptr;
881 	const char *old_name = NULL;
882 	unsigned long flags, thread_mask = 0;
883 	int ret, nested, shared = 0;
884 	cpumask_var_t mask;
885 
886 	if (!desc)
887 		return -EINVAL;
888 
889 	if (desc->irq_data.chip == &no_irq_chip)
890 		return -ENOSYS;
891 	if (!try_module_get(desc->owner))
892 		return -ENODEV;
893 	/*
894 	 * Some drivers like serial.c use request_irq() heavily,
895 	 * so we have to be careful not to interfere with a
896 	 * running system.
897 	 */
898 	if (new->flags & IRQF_SAMPLE_RANDOM) {
899 		/*
900 		 * This function might sleep, we want to call it first,
901 		 * outside of the atomic block.
902 		 * Yes, this might clear the entropy pool if the wrong
903 		 * driver is attempted to be loaded, without actually
904 		 * installing a new handler, but is this really a problem,
905 		 * only the sysadmin is able to do this.
906 		 */
907 		rand_initialize_irq(irq);
908 	}
909 
910 	/*
911 	 * Check whether the interrupt nests into another interrupt
912 	 * thread.
913 	 */
914 	nested = irq_settings_is_nested_thread(desc);
915 	if (nested) {
916 		if (!new->thread_fn) {
917 			ret = -EINVAL;
918 			goto out_mput;
919 		}
920 		/*
921 		 * Replace the primary handler which was provided from
922 		 * the driver for non nested interrupt handling by the
923 		 * dummy function which warns when called.
924 		 */
925 		new->handler = irq_nested_primary_handler;
926 	} else {
927 		if (irq_settings_can_thread(desc))
928 			irq_setup_forced_threading(new);
929 	}
930 
931 	/*
932 	 * Create a handler thread when a thread function is supplied
933 	 * and the interrupt does not nest into another interrupt
934 	 * thread.
935 	 */
936 	if (new->thread_fn && !nested) {
937 		struct task_struct *t;
938 
939 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
940 				   new->name);
941 		if (IS_ERR(t)) {
942 			ret = PTR_ERR(t);
943 			goto out_mput;
944 		}
945 		/*
946 		 * We keep the reference to the task struct even if
947 		 * the thread dies to avoid that the interrupt code
948 		 * references an already freed task_struct.
949 		 */
950 		get_task_struct(t);
951 		new->thread = t;
952 	}
953 
954 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
955 		ret = -ENOMEM;
956 		goto out_thread;
957 	}
958 
959 	/*
960 	 * The following block of code has to be executed atomically
961 	 */
962 	raw_spin_lock_irqsave(&desc->lock, flags);
963 	old_ptr = &desc->action;
964 	old = *old_ptr;
965 	if (old) {
966 		/*
967 		 * Can't share interrupts unless both agree to and are
968 		 * the same type (level, edge, polarity). So both flag
969 		 * fields must have IRQF_SHARED set and the bits which
970 		 * set the trigger type must match. Also all must
971 		 * agree on ONESHOT.
972 		 */
973 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
974 		    ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
975 		    ((old->flags ^ new->flags) & IRQF_ONESHOT)) {
976 			old_name = old->name;
977 			goto mismatch;
978 		}
979 
980 		/* All handlers must agree on per-cpuness */
981 		if ((old->flags & IRQF_PERCPU) !=
982 		    (new->flags & IRQF_PERCPU))
983 			goto mismatch;
984 
985 		/* add new interrupt at end of irq queue */
986 		do {
987 			/*
988 			 * Or all existing action->thread_mask bits,
989 			 * so we can find the next zero bit for this
990 			 * new action.
991 			 */
992 			thread_mask |= old->thread_mask;
993 			old_ptr = &old->next;
994 			old = *old_ptr;
995 		} while (old);
996 		shared = 1;
997 	}
998 
999 	/*
1000 	 * Setup the thread mask for this irqaction for ONESHOT. For
1001 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
1002 	 * conditional in irq_wake_thread().
1003 	 */
1004 	if (new->flags & IRQF_ONESHOT) {
1005 		/*
1006 		 * Unlikely to have 32 resp 64 irqs sharing one line,
1007 		 * but who knows.
1008 		 */
1009 		if (thread_mask == ~0UL) {
1010 			ret = -EBUSY;
1011 			goto out_mask;
1012 		}
1013 		/*
1014 		 * The thread_mask for the action is or'ed to
1015 		 * desc->thread_active to indicate that the
1016 		 * IRQF_ONESHOT thread handler has been woken, but not
1017 		 * yet finished. The bit is cleared when a thread
1018 		 * completes. When all threads of a shared interrupt
1019 		 * line have completed desc->threads_active becomes
1020 		 * zero and the interrupt line is unmasked. See
1021 		 * handle.c:irq_wake_thread() for further information.
1022 		 *
1023 		 * If no thread is woken by primary (hard irq context)
1024 		 * interrupt handlers, then desc->threads_active is
1025 		 * also checked for zero to unmask the irq line in the
1026 		 * affected hard irq flow handlers
1027 		 * (handle_[fasteoi|level]_irq).
1028 		 *
1029 		 * The new action gets the first zero bit of
1030 		 * thread_mask assigned. See the loop above which or's
1031 		 * all existing action->thread_mask bits.
1032 		 */
1033 		new->thread_mask = 1 << ffz(thread_mask);
1034 	}
1035 
1036 	if (!shared) {
1037 		init_waitqueue_head(&desc->wait_for_threads);
1038 
1039 		/* Setup the type (level, edge polarity) if configured: */
1040 		if (new->flags & IRQF_TRIGGER_MASK) {
1041 			ret = __irq_set_trigger(desc, irq,
1042 					new->flags & IRQF_TRIGGER_MASK);
1043 
1044 			if (ret)
1045 				goto out_mask;
1046 		}
1047 
1048 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
1049 				  IRQS_ONESHOT | IRQS_WAITING);
1050 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
1051 
1052 		if (new->flags & IRQF_PERCPU) {
1053 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1054 			irq_settings_set_per_cpu(desc);
1055 		}
1056 
1057 		if (new->flags & IRQF_ONESHOT)
1058 			desc->istate |= IRQS_ONESHOT;
1059 
1060 		if (irq_settings_can_autoenable(desc))
1061 			irq_startup(desc, true);
1062 		else
1063 			/* Undo nested disables: */
1064 			desc->depth = 1;
1065 
1066 		/* Exclude IRQ from balancing if requested */
1067 		if (new->flags & IRQF_NOBALANCING) {
1068 			irq_settings_set_no_balancing(desc);
1069 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1070 		}
1071 
1072 		/* Set default affinity mask once everything is setup */
1073 		setup_affinity(irq, desc, mask);
1074 
1075 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1076 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
1077 		unsigned int omsk = irq_settings_get_trigger_mask(desc);
1078 
1079 		if (nmsk != omsk)
1080 			/* hope the handler works with current  trigger mode */
1081 			pr_warning("IRQ %d uses trigger mode %u; requested %u\n",
1082 				   irq, nmsk, omsk);
1083 	}
1084 
1085 	new->irq = irq;
1086 	*old_ptr = new;
1087 
1088 	/* Reset broken irq detection when installing new handler */
1089 	desc->irq_count = 0;
1090 	desc->irqs_unhandled = 0;
1091 
1092 	/*
1093 	 * Check whether we disabled the irq via the spurious handler
1094 	 * before. Reenable it and give it another chance.
1095 	 */
1096 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
1097 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
1098 		__enable_irq(desc, irq, false);
1099 	}
1100 
1101 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1102 
1103 	/*
1104 	 * Strictly no need to wake it up, but hung_task complains
1105 	 * when no hard interrupt wakes the thread up.
1106 	 */
1107 	if (new->thread)
1108 		wake_up_process(new->thread);
1109 
1110 	register_irq_proc(irq, desc);
1111 	new->dir = NULL;
1112 	register_handler_proc(irq, new);
1113 	free_cpumask_var(mask);
1114 
1115 	return 0;
1116 
1117 mismatch:
1118 #ifdef CONFIG_DEBUG_SHIRQ
1119 	if (!(new->flags & IRQF_PROBE_SHARED)) {
1120 		printk(KERN_ERR "IRQ handler type mismatch for IRQ %d\n", irq);
1121 		if (old_name)
1122 			printk(KERN_ERR "current handler: %s\n", old_name);
1123 		dump_stack();
1124 	}
1125 #endif
1126 	ret = -EBUSY;
1127 
1128 out_mask:
1129 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1130 	free_cpumask_var(mask);
1131 
1132 out_thread:
1133 	if (new->thread) {
1134 		struct task_struct *t = new->thread;
1135 
1136 		new->thread = NULL;
1137 		kthread_stop(t);
1138 		put_task_struct(t);
1139 	}
1140 out_mput:
1141 	module_put(desc->owner);
1142 	return ret;
1143 }
1144 
1145 /**
1146  *	setup_irq - setup an interrupt
1147  *	@irq: Interrupt line to setup
1148  *	@act: irqaction for the interrupt
1149  *
1150  * Used to statically setup interrupts in the early boot process.
1151  */
1152 int setup_irq(unsigned int irq, struct irqaction *act)
1153 {
1154 	int retval;
1155 	struct irq_desc *desc = irq_to_desc(irq);
1156 
1157 	if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1158 		return -EINVAL;
1159 	chip_bus_lock(desc);
1160 	retval = __setup_irq(irq, desc, act);
1161 	chip_bus_sync_unlock(desc);
1162 
1163 	return retval;
1164 }
1165 EXPORT_SYMBOL_GPL(setup_irq);
1166 
1167 /*
1168  * Internal function to unregister an irqaction - used to free
1169  * regular and special interrupts that are part of the architecture.
1170  */
1171 static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
1172 {
1173 	struct irq_desc *desc = irq_to_desc(irq);
1174 	struct irqaction *action, **action_ptr;
1175 	unsigned long flags;
1176 
1177 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
1178 
1179 	if (!desc)
1180 		return NULL;
1181 
1182 	raw_spin_lock_irqsave(&desc->lock, flags);
1183 
1184 	/*
1185 	 * There can be multiple actions per IRQ descriptor, find the right
1186 	 * one based on the dev_id:
1187 	 */
1188 	action_ptr = &desc->action;
1189 	for (;;) {
1190 		action = *action_ptr;
1191 
1192 		if (!action) {
1193 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1194 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1195 
1196 			return NULL;
1197 		}
1198 
1199 		if (action->dev_id == dev_id)
1200 			break;
1201 		action_ptr = &action->next;
1202 	}
1203 
1204 	/* Found it - now remove it from the list of entries: */
1205 	*action_ptr = action->next;
1206 
1207 	/* Currently used only by UML, might disappear one day: */
1208 #ifdef CONFIG_IRQ_RELEASE_METHOD
1209 	if (desc->irq_data.chip->release)
1210 		desc->irq_data.chip->release(irq, dev_id);
1211 #endif
1212 
1213 	/* If this was the last handler, shut down the IRQ line: */
1214 	if (!desc->action)
1215 		irq_shutdown(desc);
1216 
1217 #ifdef CONFIG_SMP
1218 	/* make sure affinity_hint is cleaned up */
1219 	if (WARN_ON_ONCE(desc->affinity_hint))
1220 		desc->affinity_hint = NULL;
1221 #endif
1222 
1223 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1224 
1225 	unregister_handler_proc(irq, action);
1226 
1227 	/* Make sure it's not being used on another CPU: */
1228 	synchronize_irq(irq);
1229 
1230 #ifdef CONFIG_DEBUG_SHIRQ
1231 	/*
1232 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1233 	 * event to happen even now it's being freed, so let's make sure that
1234 	 * is so by doing an extra call to the handler ....
1235 	 *
1236 	 * ( We do this after actually deregistering it, to make sure that a
1237 	 *   'real' IRQ doesn't run in * parallel with our fake. )
1238 	 */
1239 	if (action->flags & IRQF_SHARED) {
1240 		local_irq_save(flags);
1241 		action->handler(irq, dev_id);
1242 		local_irq_restore(flags);
1243 	}
1244 #endif
1245 
1246 	if (action->thread) {
1247 		kthread_stop(action->thread);
1248 		put_task_struct(action->thread);
1249 	}
1250 
1251 	module_put(desc->owner);
1252 	return action;
1253 }
1254 
1255 /**
1256  *	remove_irq - free an interrupt
1257  *	@irq: Interrupt line to free
1258  *	@act: irqaction for the interrupt
1259  *
1260  * Used to remove interrupts statically setup by the early boot process.
1261  */
1262 void remove_irq(unsigned int irq, struct irqaction *act)
1263 {
1264 	struct irq_desc *desc = irq_to_desc(irq);
1265 
1266 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1267 	    __free_irq(irq, act->dev_id);
1268 }
1269 EXPORT_SYMBOL_GPL(remove_irq);
1270 
1271 /**
1272  *	free_irq - free an interrupt allocated with request_irq
1273  *	@irq: Interrupt line to free
1274  *	@dev_id: Device identity to free
1275  *
1276  *	Remove an interrupt handler. The handler is removed and if the
1277  *	interrupt line is no longer in use by any driver it is disabled.
1278  *	On a shared IRQ the caller must ensure the interrupt is disabled
1279  *	on the card it drives before calling this function. The function
1280  *	does not return until any executing interrupts for this IRQ
1281  *	have completed.
1282  *
1283  *	This function must not be called from interrupt context.
1284  */
1285 void free_irq(unsigned int irq, void *dev_id)
1286 {
1287 	struct irq_desc *desc = irq_to_desc(irq);
1288 
1289 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1290 		return;
1291 
1292 #ifdef CONFIG_SMP
1293 	if (WARN_ON(desc->affinity_notify))
1294 		desc->affinity_notify = NULL;
1295 #endif
1296 
1297 	chip_bus_lock(desc);
1298 	kfree(__free_irq(irq, dev_id));
1299 	chip_bus_sync_unlock(desc);
1300 }
1301 EXPORT_SYMBOL(free_irq);
1302 
1303 /**
1304  *	request_threaded_irq - allocate an interrupt line
1305  *	@irq: Interrupt line to allocate
1306  *	@handler: Function to be called when the IRQ occurs.
1307  *		  Primary handler for threaded interrupts
1308  *		  If NULL and thread_fn != NULL the default
1309  *		  primary handler is installed
1310  *	@thread_fn: Function called from the irq handler thread
1311  *		    If NULL, no irq thread is created
1312  *	@irqflags: Interrupt type flags
1313  *	@devname: An ascii name for the claiming device
1314  *	@dev_id: A cookie passed back to the handler function
1315  *
1316  *	This call allocates interrupt resources and enables the
1317  *	interrupt line and IRQ handling. From the point this
1318  *	call is made your handler function may be invoked. Since
1319  *	your handler function must clear any interrupt the board
1320  *	raises, you must take care both to initialise your hardware
1321  *	and to set up the interrupt handler in the right order.
1322  *
1323  *	If you want to set up a threaded irq handler for your device
1324  *	then you need to supply @handler and @thread_fn. @handler is
1325  *	still called in hard interrupt context and has to check
1326  *	whether the interrupt originates from the device. If yes it
1327  *	needs to disable the interrupt on the device and return
1328  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
1329  *	@thread_fn. This split handler design is necessary to support
1330  *	shared interrupts.
1331  *
1332  *	Dev_id must be globally unique. Normally the address of the
1333  *	device data structure is used as the cookie. Since the handler
1334  *	receives this value it makes sense to use it.
1335  *
1336  *	If your interrupt is shared you must pass a non NULL dev_id
1337  *	as this is required when freeing the interrupt.
1338  *
1339  *	Flags:
1340  *
1341  *	IRQF_SHARED		Interrupt is shared
1342  *	IRQF_SAMPLE_RANDOM	The interrupt can be used for entropy
1343  *	IRQF_TRIGGER_*		Specify active edge(s) or level
1344  *
1345  */
1346 int request_threaded_irq(unsigned int irq, irq_handler_t handler,
1347 			 irq_handler_t thread_fn, unsigned long irqflags,
1348 			 const char *devname, void *dev_id)
1349 {
1350 	struct irqaction *action;
1351 	struct irq_desc *desc;
1352 	int retval;
1353 
1354 	/*
1355 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
1356 	 * otherwise we'll have trouble later trying to figure out
1357 	 * which interrupt is which (messes up the interrupt freeing
1358 	 * logic etc).
1359 	 */
1360 	if ((irqflags & IRQF_SHARED) && !dev_id)
1361 		return -EINVAL;
1362 
1363 	desc = irq_to_desc(irq);
1364 	if (!desc)
1365 		return -EINVAL;
1366 
1367 	if (!irq_settings_can_request(desc) ||
1368 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1369 		return -EINVAL;
1370 
1371 	if (!handler) {
1372 		if (!thread_fn)
1373 			return -EINVAL;
1374 		handler = irq_default_primary_handler;
1375 	}
1376 
1377 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
1378 	if (!action)
1379 		return -ENOMEM;
1380 
1381 	action->handler = handler;
1382 	action->thread_fn = thread_fn;
1383 	action->flags = irqflags;
1384 	action->name = devname;
1385 	action->dev_id = dev_id;
1386 
1387 	chip_bus_lock(desc);
1388 	retval = __setup_irq(irq, desc, action);
1389 	chip_bus_sync_unlock(desc);
1390 
1391 	if (retval)
1392 		kfree(action);
1393 
1394 #ifdef CONFIG_DEBUG_SHIRQ_FIXME
1395 	if (!retval && (irqflags & IRQF_SHARED)) {
1396 		/*
1397 		 * It's a shared IRQ -- the driver ought to be prepared for it
1398 		 * to happen immediately, so let's make sure....
1399 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1400 		 * run in parallel with our fake.
1401 		 */
1402 		unsigned long flags;
1403 
1404 		disable_irq(irq);
1405 		local_irq_save(flags);
1406 
1407 		handler(irq, dev_id);
1408 
1409 		local_irq_restore(flags);
1410 		enable_irq(irq);
1411 	}
1412 #endif
1413 	return retval;
1414 }
1415 EXPORT_SYMBOL(request_threaded_irq);
1416 
1417 /**
1418  *	request_any_context_irq - allocate an interrupt line
1419  *	@irq: Interrupt line to allocate
1420  *	@handler: Function to be called when the IRQ occurs.
1421  *		  Threaded handler for threaded interrupts.
1422  *	@flags: Interrupt type flags
1423  *	@name: An ascii name for the claiming device
1424  *	@dev_id: A cookie passed back to the handler function
1425  *
1426  *	This call allocates interrupt resources and enables the
1427  *	interrupt line and IRQ handling. It selects either a
1428  *	hardirq or threaded handling method depending on the
1429  *	context.
1430  *
1431  *	On failure, it returns a negative value. On success,
1432  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1433  */
1434 int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1435 			    unsigned long flags, const char *name, void *dev_id)
1436 {
1437 	struct irq_desc *desc = irq_to_desc(irq);
1438 	int ret;
1439 
1440 	if (!desc)
1441 		return -EINVAL;
1442 
1443 	if (irq_settings_is_nested_thread(desc)) {
1444 		ret = request_threaded_irq(irq, NULL, handler,
1445 					   flags, name, dev_id);
1446 		return !ret ? IRQC_IS_NESTED : ret;
1447 	}
1448 
1449 	ret = request_irq(irq, handler, flags, name, dev_id);
1450 	return !ret ? IRQC_IS_HARDIRQ : ret;
1451 }
1452 EXPORT_SYMBOL_GPL(request_any_context_irq);
1453 
1454 void enable_percpu_irq(unsigned int irq, unsigned int type)
1455 {
1456 	unsigned int cpu = smp_processor_id();
1457 	unsigned long flags;
1458 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1459 
1460 	if (!desc)
1461 		return;
1462 
1463 	type &= IRQ_TYPE_SENSE_MASK;
1464 	if (type != IRQ_TYPE_NONE) {
1465 		int ret;
1466 
1467 		ret = __irq_set_trigger(desc, irq, type);
1468 
1469 		if (ret) {
1470 			WARN(1, "failed to set type for IRQ%d\n", irq);
1471 			goto out;
1472 		}
1473 	}
1474 
1475 	irq_percpu_enable(desc, cpu);
1476 out:
1477 	irq_put_desc_unlock(desc, flags);
1478 }
1479 
1480 void disable_percpu_irq(unsigned int irq)
1481 {
1482 	unsigned int cpu = smp_processor_id();
1483 	unsigned long flags;
1484 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1485 
1486 	if (!desc)
1487 		return;
1488 
1489 	irq_percpu_disable(desc, cpu);
1490 	irq_put_desc_unlock(desc, flags);
1491 }
1492 
1493 /*
1494  * Internal function to unregister a percpu irqaction.
1495  */
1496 static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
1497 {
1498 	struct irq_desc *desc = irq_to_desc(irq);
1499 	struct irqaction *action;
1500 	unsigned long flags;
1501 
1502 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
1503 
1504 	if (!desc)
1505 		return NULL;
1506 
1507 	raw_spin_lock_irqsave(&desc->lock, flags);
1508 
1509 	action = desc->action;
1510 	if (!action || action->percpu_dev_id != dev_id) {
1511 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
1512 		goto bad;
1513 	}
1514 
1515 	if (!cpumask_empty(desc->percpu_enabled)) {
1516 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
1517 		     irq, cpumask_first(desc->percpu_enabled));
1518 		goto bad;
1519 	}
1520 
1521 	/* Found it - now remove it from the list of entries: */
1522 	desc->action = NULL;
1523 
1524 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1525 
1526 	unregister_handler_proc(irq, action);
1527 
1528 	module_put(desc->owner);
1529 	return action;
1530 
1531 bad:
1532 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1533 	return NULL;
1534 }
1535 
1536 /**
1537  *	remove_percpu_irq - free a per-cpu interrupt
1538  *	@irq: Interrupt line to free
1539  *	@act: irqaction for the interrupt
1540  *
1541  * Used to remove interrupts statically setup by the early boot process.
1542  */
1543 void remove_percpu_irq(unsigned int irq, struct irqaction *act)
1544 {
1545 	struct irq_desc *desc = irq_to_desc(irq);
1546 
1547 	if (desc && irq_settings_is_per_cpu_devid(desc))
1548 	    __free_percpu_irq(irq, act->percpu_dev_id);
1549 }
1550 
1551 /**
1552  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
1553  *	@irq: Interrupt line to free
1554  *	@dev_id: Device identity to free
1555  *
1556  *	Remove a percpu interrupt handler. The handler is removed, but
1557  *	the interrupt line is not disabled. This must be done on each
1558  *	CPU before calling this function. The function does not return
1559  *	until any executing interrupts for this IRQ have completed.
1560  *
1561  *	This function must not be called from interrupt context.
1562  */
1563 void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
1564 {
1565 	struct irq_desc *desc = irq_to_desc(irq);
1566 
1567 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
1568 		return;
1569 
1570 	chip_bus_lock(desc);
1571 	kfree(__free_percpu_irq(irq, dev_id));
1572 	chip_bus_sync_unlock(desc);
1573 }
1574 
1575 /**
1576  *	setup_percpu_irq - setup a per-cpu interrupt
1577  *	@irq: Interrupt line to setup
1578  *	@act: irqaction for the interrupt
1579  *
1580  * Used to statically setup per-cpu interrupts in the early boot process.
1581  */
1582 int setup_percpu_irq(unsigned int irq, struct irqaction *act)
1583 {
1584 	struct irq_desc *desc = irq_to_desc(irq);
1585 	int retval;
1586 
1587 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
1588 		return -EINVAL;
1589 	chip_bus_lock(desc);
1590 	retval = __setup_irq(irq, desc, act);
1591 	chip_bus_sync_unlock(desc);
1592 
1593 	return retval;
1594 }
1595 
1596 /**
1597  *	request_percpu_irq - allocate a percpu interrupt line
1598  *	@irq: Interrupt line to allocate
1599  *	@handler: Function to be called when the IRQ occurs.
1600  *	@devname: An ascii name for the claiming device
1601  *	@dev_id: A percpu cookie passed back to the handler function
1602  *
1603  *	This call allocates interrupt resources, but doesn't
1604  *	automatically enable the interrupt. It has to be done on each
1605  *	CPU using enable_percpu_irq().
1606  *
1607  *	Dev_id must be globally unique. It is a per-cpu variable, and
1608  *	the handler gets called with the interrupted CPU's instance of
1609  *	that variable.
1610  */
1611 int request_percpu_irq(unsigned int irq, irq_handler_t handler,
1612 		       const char *devname, void __percpu *dev_id)
1613 {
1614 	struct irqaction *action;
1615 	struct irq_desc *desc;
1616 	int retval;
1617 
1618 	if (!dev_id)
1619 		return -EINVAL;
1620 
1621 	desc = irq_to_desc(irq);
1622 	if (!desc || !irq_settings_can_request(desc) ||
1623 	    !irq_settings_is_per_cpu_devid(desc))
1624 		return -EINVAL;
1625 
1626 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
1627 	if (!action)
1628 		return -ENOMEM;
1629 
1630 	action->handler = handler;
1631 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
1632 	action->name = devname;
1633 	action->percpu_dev_id = dev_id;
1634 
1635 	chip_bus_lock(desc);
1636 	retval = __setup_irq(irq, desc, action);
1637 	chip_bus_sync_unlock(desc);
1638 
1639 	if (retval)
1640 		kfree(action);
1641 
1642 	return retval;
1643 }
1644