xref: /openbmc/linux/kernel/irq/manage.c (revision 4fe7ffb7e17ca6ad9173b8de35f260c9c8fc2f79)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * linux/kernel/irq/manage.c
31da177e4SLinus Torvalds  *
4a34db9b2SIngo Molnar  * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
5a34db9b2SIngo Molnar  * Copyright (C) 2005-2006 Thomas Gleixner
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  * This file contains driver APIs to the irq subsystem.
81da177e4SLinus Torvalds  */
91da177e4SLinus Torvalds 
1097fd75b7SAndrew Morton #define pr_fmt(fmt) "genirq: " fmt
1197fd75b7SAndrew Morton 
121da177e4SLinus Torvalds #include <linux/irq.h>
133aa551c9SThomas Gleixner #include <linux/kthread.h>
141da177e4SLinus Torvalds #include <linux/module.h>
151da177e4SLinus Torvalds #include <linux/random.h>
161da177e4SLinus Torvalds #include <linux/interrupt.h>
171aeb272cSRobert P. J. Day #include <linux/slab.h>
183aa551c9SThomas Gleixner #include <linux/sched.h>
198bd75c77SClark Williams #include <linux/sched/rt.h>
204d1d61a6SOleg Nesterov #include <linux/task_work.h>
211da177e4SLinus Torvalds 
221da177e4SLinus Torvalds #include "internals.h"
231da177e4SLinus Torvalds 
248d32a307SThomas Gleixner #ifdef CONFIG_IRQ_FORCED_THREADING
258d32a307SThomas Gleixner __read_mostly bool force_irqthreads;
268d32a307SThomas Gleixner 
278d32a307SThomas Gleixner static int __init setup_forced_irqthreads(char *arg)
288d32a307SThomas Gleixner {
298d32a307SThomas Gleixner 	force_irqthreads = true;
308d32a307SThomas Gleixner 	return 0;
318d32a307SThomas Gleixner }
328d32a307SThomas Gleixner early_param("threadirqs", setup_forced_irqthreads);
338d32a307SThomas Gleixner #endif
348d32a307SThomas Gleixner 
3518258f72SThomas Gleixner static void __synchronize_hardirq(struct irq_desc *desc)
361da177e4SLinus Torvalds {
3732f4125eSThomas Gleixner 	bool inprogress;
381da177e4SLinus Torvalds 
39a98ce5c6SHerbert Xu 	do {
40a98ce5c6SHerbert Xu 		unsigned long flags;
41a98ce5c6SHerbert Xu 
42a98ce5c6SHerbert Xu 		/*
43a98ce5c6SHerbert Xu 		 * Wait until we're out of the critical section.  This might
44a98ce5c6SHerbert Xu 		 * give the wrong answer due to the lack of memory barriers.
45a98ce5c6SHerbert Xu 		 */
4632f4125eSThomas Gleixner 		while (irqd_irq_inprogress(&desc->irq_data))
471da177e4SLinus Torvalds 			cpu_relax();
48a98ce5c6SHerbert Xu 
49a98ce5c6SHerbert Xu 		/* Ok, that indicated we're done: double-check carefully. */
50239007b8SThomas Gleixner 		raw_spin_lock_irqsave(&desc->lock, flags);
5132f4125eSThomas Gleixner 		inprogress = irqd_irq_inprogress(&desc->irq_data);
52239007b8SThomas Gleixner 		raw_spin_unlock_irqrestore(&desc->lock, flags);
53a98ce5c6SHerbert Xu 
54a98ce5c6SHerbert Xu 		/* Oops, that failed? */
5532f4125eSThomas Gleixner 	} while (inprogress);
5618258f72SThomas Gleixner }
573aa551c9SThomas Gleixner 
5818258f72SThomas Gleixner /**
5918258f72SThomas Gleixner  *	synchronize_hardirq - wait for pending hard IRQ handlers (on other CPUs)
6018258f72SThomas Gleixner  *	@irq: interrupt number to wait for
6118258f72SThomas Gleixner  *
6218258f72SThomas Gleixner  *	This function waits for any pending hard IRQ handlers for this
6318258f72SThomas Gleixner  *	interrupt to complete before returning. If you use this
6418258f72SThomas Gleixner  *	function while holding a resource the IRQ handler may need you
6518258f72SThomas Gleixner  *	will deadlock. It does not take associated threaded handlers
6618258f72SThomas Gleixner  *	into account.
6718258f72SThomas Gleixner  *
6818258f72SThomas Gleixner  *	Do not use this for shutdown scenarios where you must be sure
6918258f72SThomas Gleixner  *	that all parts (hardirq and threaded handler) have completed.
7018258f72SThomas Gleixner  *
7118258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
723aa551c9SThomas Gleixner  */
7318258f72SThomas Gleixner void synchronize_hardirq(unsigned int irq)
7418258f72SThomas Gleixner {
7518258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
7618258f72SThomas Gleixner 
7718258f72SThomas Gleixner 	if (desc)
7818258f72SThomas Gleixner 		__synchronize_hardirq(desc);
7918258f72SThomas Gleixner }
8018258f72SThomas Gleixner EXPORT_SYMBOL(synchronize_hardirq);
8118258f72SThomas Gleixner 
8218258f72SThomas Gleixner /**
8318258f72SThomas Gleixner  *	synchronize_irq - wait for pending IRQ handlers (on other CPUs)
8418258f72SThomas Gleixner  *	@irq: interrupt number to wait for
8518258f72SThomas Gleixner  *
8618258f72SThomas Gleixner  *	This function waits for any pending IRQ handlers for this interrupt
8718258f72SThomas Gleixner  *	to complete before returning. If you use this function while
8818258f72SThomas Gleixner  *	holding a resource the IRQ handler may need you will deadlock.
8918258f72SThomas Gleixner  *
9018258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
9118258f72SThomas Gleixner  */
9218258f72SThomas Gleixner void synchronize_irq(unsigned int irq)
9318258f72SThomas Gleixner {
9418258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
9518258f72SThomas Gleixner 
9618258f72SThomas Gleixner 	if (desc) {
9718258f72SThomas Gleixner 		__synchronize_hardirq(desc);
9818258f72SThomas Gleixner 		/*
9918258f72SThomas Gleixner 		 * We made sure that no hardirq handler is
10018258f72SThomas Gleixner 		 * running. Now verify that no threaded handlers are
10118258f72SThomas Gleixner 		 * active.
10218258f72SThomas Gleixner 		 */
10318258f72SThomas Gleixner 		wait_event(desc->wait_for_threads,
10418258f72SThomas Gleixner 			   !atomic_read(&desc->threads_active));
10518258f72SThomas Gleixner 	}
1061da177e4SLinus Torvalds }
1071da177e4SLinus Torvalds EXPORT_SYMBOL(synchronize_irq);
1081da177e4SLinus Torvalds 
1093aa551c9SThomas Gleixner #ifdef CONFIG_SMP
1103aa551c9SThomas Gleixner cpumask_var_t irq_default_affinity;
1113aa551c9SThomas Gleixner 
112771ee3b0SThomas Gleixner /**
113771ee3b0SThomas Gleixner  *	irq_can_set_affinity - Check if the affinity of a given irq can be set
114771ee3b0SThomas Gleixner  *	@irq:		Interrupt to check
115771ee3b0SThomas Gleixner  *
116771ee3b0SThomas Gleixner  */
117771ee3b0SThomas Gleixner int irq_can_set_affinity(unsigned int irq)
118771ee3b0SThomas Gleixner {
11908678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
120771ee3b0SThomas Gleixner 
121bce43032SThomas Gleixner 	if (!desc || !irqd_can_balance(&desc->irq_data) ||
122bce43032SThomas Gleixner 	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
123771ee3b0SThomas Gleixner 		return 0;
124771ee3b0SThomas Gleixner 
125771ee3b0SThomas Gleixner 	return 1;
126771ee3b0SThomas Gleixner }
127771ee3b0SThomas Gleixner 
128591d2fb0SThomas Gleixner /**
129591d2fb0SThomas Gleixner  *	irq_set_thread_affinity - Notify irq threads to adjust affinity
130591d2fb0SThomas Gleixner  *	@desc:		irq descriptor which has affitnity changed
131591d2fb0SThomas Gleixner  *
132591d2fb0SThomas Gleixner  *	We just set IRQTF_AFFINITY and delegate the affinity setting
133591d2fb0SThomas Gleixner  *	to the interrupt thread itself. We can not call
134591d2fb0SThomas Gleixner  *	set_cpus_allowed_ptr() here as we hold desc->lock and this
135591d2fb0SThomas Gleixner  *	code can be called from hard interrupt context.
136591d2fb0SThomas Gleixner  */
137591d2fb0SThomas Gleixner void irq_set_thread_affinity(struct irq_desc *desc)
1383aa551c9SThomas Gleixner {
1393aa551c9SThomas Gleixner 	struct irqaction *action = desc->action;
1403aa551c9SThomas Gleixner 
1413aa551c9SThomas Gleixner 	while (action) {
1423aa551c9SThomas Gleixner 		if (action->thread)
143591d2fb0SThomas Gleixner 			set_bit(IRQTF_AFFINITY, &action->thread_flags);
1443aa551c9SThomas Gleixner 		action = action->next;
1453aa551c9SThomas Gleixner 	}
1463aa551c9SThomas Gleixner }
1473aa551c9SThomas Gleixner 
1481fa46f1fSThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ
1490ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data)
1501fa46f1fSThomas Gleixner {
1510ef5ca1eSThomas Gleixner 	return irqd_can_move_in_process_context(data);
1521fa46f1fSThomas Gleixner }
1530ef5ca1eSThomas Gleixner static inline bool irq_move_pending(struct irq_data *data)
1541fa46f1fSThomas Gleixner {
1550ef5ca1eSThomas Gleixner 	return irqd_is_setaffinity_pending(data);
1561fa46f1fSThomas Gleixner }
1571fa46f1fSThomas Gleixner static inline void
1581fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
1591fa46f1fSThomas Gleixner {
1601fa46f1fSThomas Gleixner 	cpumask_copy(desc->pending_mask, mask);
1611fa46f1fSThomas Gleixner }
1621fa46f1fSThomas Gleixner static inline void
1631fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
1641fa46f1fSThomas Gleixner {
1651fa46f1fSThomas Gleixner 	cpumask_copy(mask, desc->pending_mask);
1661fa46f1fSThomas Gleixner }
1671fa46f1fSThomas Gleixner #else
1680ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
169cd22c0e4SThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) { return false; }
1701fa46f1fSThomas Gleixner static inline void
1711fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
1721fa46f1fSThomas Gleixner static inline void
1731fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
1741fa46f1fSThomas Gleixner #endif
1751fa46f1fSThomas Gleixner 
176818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
177818b0f3bSJiang Liu 			bool force)
178818b0f3bSJiang Liu {
179818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
180818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
181818b0f3bSJiang Liu 	int ret;
182818b0f3bSJiang Liu 
18301f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
184818b0f3bSJiang Liu 	switch (ret) {
185818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
1862cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
187818b0f3bSJiang Liu 		cpumask_copy(data->affinity, mask);
188818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
189818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
190818b0f3bSJiang Liu 		ret = 0;
191818b0f3bSJiang Liu 	}
192818b0f3bSJiang Liu 
193818b0f3bSJiang Liu 	return ret;
194818b0f3bSJiang Liu }
195818b0f3bSJiang Liu 
19601f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
19701f8fa4fSThomas Gleixner 			    bool force)
198c2d0c555SDavid Daney {
199c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
200c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
201c2d0c555SDavid Daney 	int ret = 0;
202c2d0c555SDavid Daney 
203c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
204c2d0c555SDavid Daney 		return -EINVAL;
205c2d0c555SDavid Daney 
2060ef5ca1eSThomas Gleixner 	if (irq_can_move_pcntxt(data)) {
20701f8fa4fSThomas Gleixner 		ret = irq_do_set_affinity(data, mask, force);
208c2d0c555SDavid Daney 	} else {
209c2d0c555SDavid Daney 		irqd_set_move_pending(data);
210c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
211c2d0c555SDavid Daney 	}
212c2d0c555SDavid Daney 
213c2d0c555SDavid Daney 	if (desc->affinity_notify) {
214c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
215c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
216c2d0c555SDavid Daney 	}
217c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
218c2d0c555SDavid Daney 
219c2d0c555SDavid Daney 	return ret;
220c2d0c555SDavid Daney }
221c2d0c555SDavid Daney 
22201f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
223771ee3b0SThomas Gleixner {
22408678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
225f6d87f4bSThomas Gleixner 	unsigned long flags;
226c2d0c555SDavid Daney 	int ret;
227771ee3b0SThomas Gleixner 
228c2d0c555SDavid Daney 	if (!desc)
229771ee3b0SThomas Gleixner 		return -EINVAL;
230771ee3b0SThomas Gleixner 
231239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
23201f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
233239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2341fa46f1fSThomas Gleixner 	return ret;
235771ee3b0SThomas Gleixner }
236771ee3b0SThomas Gleixner 
237e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
238e7a297b0SPeter P Waskiewicz Jr {
239e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
24031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
241e7a297b0SPeter P Waskiewicz Jr 
242e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
243e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
244e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
24502725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
246e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
247*4fe7ffb7SJesse Brandeburg 	if (m)
248e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
249e7a297b0SPeter P Waskiewicz Jr 	return 0;
250e7a297b0SPeter P Waskiewicz Jr }
251e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
252e7a297b0SPeter P Waskiewicz Jr 
253cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
254cd7eab44SBen Hutchings {
255cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
256cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
257cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
258cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
259cd7eab44SBen Hutchings 	unsigned long flags;
260cd7eab44SBen Hutchings 
2611fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
262cd7eab44SBen Hutchings 		goto out;
263cd7eab44SBen Hutchings 
264cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
2650ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
2661fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
267cd7eab44SBen Hutchings 	else
2681fb0ef31SThomas Gleixner 		cpumask_copy(cpumask, desc->irq_data.affinity);
269cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
270cd7eab44SBen Hutchings 
271cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
272cd7eab44SBen Hutchings 
273cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
274cd7eab44SBen Hutchings out:
275cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
276cd7eab44SBen Hutchings }
277cd7eab44SBen Hutchings 
278cd7eab44SBen Hutchings /**
279cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
280cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
281cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
282cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
283cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
284cd7eab44SBen Hutchings  *
285cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
286cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
287cd7eab44SBen Hutchings  *	freed using free_irq().
288cd7eab44SBen Hutchings  */
289cd7eab44SBen Hutchings int
290cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
291cd7eab44SBen Hutchings {
292cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
293cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
294cd7eab44SBen Hutchings 	unsigned long flags;
295cd7eab44SBen Hutchings 
296cd7eab44SBen Hutchings 	/* The release function is promised process context */
297cd7eab44SBen Hutchings 	might_sleep();
298cd7eab44SBen Hutchings 
299cd7eab44SBen Hutchings 	if (!desc)
300cd7eab44SBen Hutchings 		return -EINVAL;
301cd7eab44SBen Hutchings 
302cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
303cd7eab44SBen Hutchings 	if (notify) {
304cd7eab44SBen Hutchings 		notify->irq = irq;
305cd7eab44SBen Hutchings 		kref_init(&notify->kref);
306cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
307cd7eab44SBen Hutchings 	}
308cd7eab44SBen Hutchings 
309cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
310cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
311cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
312cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
313cd7eab44SBen Hutchings 
314cd7eab44SBen Hutchings 	if (old_notify)
315cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
316cd7eab44SBen Hutchings 
317cd7eab44SBen Hutchings 	return 0;
318cd7eab44SBen Hutchings }
319cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
320cd7eab44SBen Hutchings 
32118404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
32218404756SMax Krasnyansky /*
32318404756SMax Krasnyansky  * Generic version of the affinity autoselector.
32418404756SMax Krasnyansky  */
3253b8249e7SThomas Gleixner static int
3263b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
32718404756SMax Krasnyansky {
328569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
329818b0f3bSJiang Liu 	int node = desc->irq_data.node;
330569bda8dSThomas Gleixner 
331b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
33218404756SMax Krasnyansky 	if (!irq_can_set_affinity(irq))
33318404756SMax Krasnyansky 		return 0;
33418404756SMax Krasnyansky 
335f6d87f4bSThomas Gleixner 	/*
336f6d87f4bSThomas Gleixner 	 * Preserve an userspace affinity setup, but make sure that
337f6d87f4bSThomas Gleixner 	 * one of the targets is online.
338f6d87f4bSThomas Gleixner 	 */
3392bdd1055SThomas Gleixner 	if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
340569bda8dSThomas Gleixner 		if (cpumask_intersects(desc->irq_data.affinity,
341569bda8dSThomas Gleixner 				       cpu_online_mask))
342569bda8dSThomas Gleixner 			set = desc->irq_data.affinity;
3430c6f8a8bSThomas Gleixner 		else
3442bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3452bdd1055SThomas Gleixner 	}
34618404756SMax Krasnyansky 
3473b8249e7SThomas Gleixner 	cpumask_and(mask, cpu_online_mask, set);
348241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
349241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
350241fc640SPrarit Bhargava 
351241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
352241fc640SPrarit Bhargava 		if (cpumask_intersects(mask, nodemask))
353241fc640SPrarit Bhargava 			cpumask_and(mask, mask, nodemask);
354241fc640SPrarit Bhargava 	}
355818b0f3bSJiang Liu 	irq_do_set_affinity(&desc->irq_data, mask, false);
35618404756SMax Krasnyansky 	return 0;
35718404756SMax Krasnyansky }
358f6d87f4bSThomas Gleixner #else
3593b8249e7SThomas Gleixner static inline int
3603b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
361f6d87f4bSThomas Gleixner {
362f6d87f4bSThomas Gleixner 	return irq_select_affinity(irq);
363f6d87f4bSThomas Gleixner }
36418404756SMax Krasnyansky #endif
36518404756SMax Krasnyansky 
366f6d87f4bSThomas Gleixner /*
367f6d87f4bSThomas Gleixner  * Called when affinity is set via /proc/irq
368f6d87f4bSThomas Gleixner  */
3693b8249e7SThomas Gleixner int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
370f6d87f4bSThomas Gleixner {
371f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
372f6d87f4bSThomas Gleixner 	unsigned long flags;
373f6d87f4bSThomas Gleixner 	int ret;
374f6d87f4bSThomas Gleixner 
375239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
3763b8249e7SThomas Gleixner 	ret = setup_affinity(irq, desc, mask);
377239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
378f6d87f4bSThomas Gleixner 	return ret;
379f6d87f4bSThomas Gleixner }
380f6d87f4bSThomas Gleixner 
381f6d87f4bSThomas Gleixner #else
3823b8249e7SThomas Gleixner static inline int
3833b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
384f6d87f4bSThomas Gleixner {
385f6d87f4bSThomas Gleixner 	return 0;
386f6d87f4bSThomas Gleixner }
3871da177e4SLinus Torvalds #endif
3881da177e4SLinus Torvalds 
3898df2e02cSThomas Gleixner void __disable_irq(struct irq_desc *desc, unsigned int irq)
3900a0c5168SRafael J. Wysocki {
3913aae994fSThomas Gleixner 	if (!desc->depth++)
39287923470SThomas Gleixner 		irq_disable(desc);
3930a0c5168SRafael J. Wysocki }
3940a0c5168SRafael J. Wysocki 
39502725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
39602725e74SThomas Gleixner {
39702725e74SThomas Gleixner 	unsigned long flags;
39831d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
39902725e74SThomas Gleixner 
40002725e74SThomas Gleixner 	if (!desc)
40102725e74SThomas Gleixner 		return -EINVAL;
4028df2e02cSThomas Gleixner 	__disable_irq(desc, irq);
40302725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
40402725e74SThomas Gleixner 	return 0;
40502725e74SThomas Gleixner }
40602725e74SThomas Gleixner 
4071da177e4SLinus Torvalds /**
4081da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4091da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4101da177e4SLinus Torvalds  *
4111da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4121da177e4SLinus Torvalds  *	nested.
4131da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
4141da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
4151da177e4SLinus Torvalds  *
4161da177e4SLinus Torvalds  *	This function may be called from IRQ context.
4171da177e4SLinus Torvalds  */
4181da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
4191da177e4SLinus Torvalds {
42002725e74SThomas Gleixner 	__disable_irq_nosync(irq);
4211da177e4SLinus Torvalds }
4221da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
4231da177e4SLinus Torvalds 
4241da177e4SLinus Torvalds /**
4251da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
4261da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4271da177e4SLinus Torvalds  *
4281da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
4291da177e4SLinus Torvalds  *	nested.
4301da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
4311da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
4321da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
4331da177e4SLinus Torvalds  *
4341da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
4351da177e4SLinus Torvalds  */
4361da177e4SLinus Torvalds void disable_irq(unsigned int irq)
4371da177e4SLinus Torvalds {
43802725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
4391da177e4SLinus Torvalds 		synchronize_irq(irq);
4401da177e4SLinus Torvalds }
4411da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
4421da177e4SLinus Torvalds 
4438df2e02cSThomas Gleixner void __enable_irq(struct irq_desc *desc, unsigned int irq)
4441adb0850SThomas Gleixner {
4451adb0850SThomas Gleixner 	switch (desc->depth) {
4461adb0850SThomas Gleixner 	case 0:
4470a0c5168SRafael J. Wysocki  err_out:
448b8c512f6SArjan van de Ven 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
4491adb0850SThomas Gleixner 		break;
4501adb0850SThomas Gleixner 	case 1: {
451c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
4520a0c5168SRafael J. Wysocki 			goto err_out;
4531adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
4541ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
4553aae994fSThomas Gleixner 		irq_enable(desc);
4561adb0850SThomas Gleixner 		check_irq_resend(desc, irq);
4571adb0850SThomas Gleixner 		/* fall-through */
4581adb0850SThomas Gleixner 	}
4591adb0850SThomas Gleixner 	default:
4601adb0850SThomas Gleixner 		desc->depth--;
4611adb0850SThomas Gleixner 	}
4621adb0850SThomas Gleixner }
4631adb0850SThomas Gleixner 
4641da177e4SLinus Torvalds /**
4651da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
4661da177e4SLinus Torvalds  *	@irq: Interrupt to enable
4671da177e4SLinus Torvalds  *
4681da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
4691da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
4701da177e4SLinus Torvalds  *	IRQ line is re-enabled.
4711da177e4SLinus Torvalds  *
47270aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
4736b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
4741da177e4SLinus Torvalds  */
4751da177e4SLinus Torvalds void enable_irq(unsigned int irq)
4761da177e4SLinus Torvalds {
4771da177e4SLinus Torvalds 	unsigned long flags;
47831d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
4791da177e4SLinus Torvalds 
4807d94f7caSYinghai Lu 	if (!desc)
481c2b5a251SMatthew Wilcox 		return;
48250f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
4832656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
48402725e74SThomas Gleixner 		goto out;
4852656c366SThomas Gleixner 
4868df2e02cSThomas Gleixner 	__enable_irq(desc, irq);
48702725e74SThomas Gleixner out:
48802725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
4891da177e4SLinus Torvalds }
4901da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
4911da177e4SLinus Torvalds 
4920c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
4932db87321SUwe Kleine-König {
49408678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
4952db87321SUwe Kleine-König 	int ret = -ENXIO;
4962db87321SUwe Kleine-König 
49760f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
49860f96b41SSantosh Shilimkar 		return 0;
49960f96b41SSantosh Shilimkar 
5002f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
5012f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
5022db87321SUwe Kleine-König 
5032db87321SUwe Kleine-König 	return ret;
5042db87321SUwe Kleine-König }
5052db87321SUwe Kleine-König 
506ba9a2331SThomas Gleixner /**
507a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
508ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
509ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
510ba9a2331SThomas Gleixner  *
51115a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
51215a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
51315a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
51415a647ebSDavid Brownell  *
51515a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
51615a647ebSDavid Brownell  *	states like "suspend to RAM".
517ba9a2331SThomas Gleixner  */
518a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
519ba9a2331SThomas Gleixner {
520ba9a2331SThomas Gleixner 	unsigned long flags;
52131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5222db87321SUwe Kleine-König 	int ret = 0;
523ba9a2331SThomas Gleixner 
52413863a66SJesper Juhl 	if (!desc)
52513863a66SJesper Juhl 		return -EINVAL;
52613863a66SJesper Juhl 
52715a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
52815a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
52915a647ebSDavid Brownell 	 */
53015a647ebSDavid Brownell 	if (on) {
5312db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
5322db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5332db87321SUwe Kleine-König 			if (ret)
5342db87321SUwe Kleine-König 				desc->wake_depth = 0;
53515a647ebSDavid Brownell 			else
5367f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
5372db87321SUwe Kleine-König 		}
53815a647ebSDavid Brownell 	} else {
53915a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
5407a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
5412db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
5422db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5432db87321SUwe Kleine-König 			if (ret)
5442db87321SUwe Kleine-König 				desc->wake_depth = 1;
54515a647ebSDavid Brownell 			else
5467f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
54715a647ebSDavid Brownell 		}
5482db87321SUwe Kleine-König 	}
54902725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
550ba9a2331SThomas Gleixner 	return ret;
551ba9a2331SThomas Gleixner }
552a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
553ba9a2331SThomas Gleixner 
5541da177e4SLinus Torvalds /*
5551da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
5561da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
5571da177e4SLinus Torvalds  * for driver use.
5581da177e4SLinus Torvalds  */
5591da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
5601da177e4SLinus Torvalds {
561cc8c3b78SThomas Gleixner 	unsigned long flags;
56231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
56302725e74SThomas Gleixner 	int canrequest = 0;
5641da177e4SLinus Torvalds 
5657d94f7caSYinghai Lu 	if (!desc)
5667d94f7caSYinghai Lu 		return 0;
5677d94f7caSYinghai Lu 
56802725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
5692779db8dSBen Hutchings 		if (!desc->action ||
5702779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
57102725e74SThomas Gleixner 			canrequest = 1;
57202725e74SThomas Gleixner 	}
57302725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
57402725e74SThomas Gleixner 	return canrequest;
5751da177e4SLinus Torvalds }
5761da177e4SLinus Torvalds 
5770c5d1eb7SDavid Brownell int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
57882736f4dSUwe Kleine-König 		      unsigned long flags)
57982736f4dSUwe Kleine-König {
5806b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
581d4d5e089SThomas Gleixner 	int ret, unmask = 0;
58282736f4dSUwe Kleine-König 
583b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
58482736f4dSUwe Kleine-König 		/*
58582736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
58682736f4dSUwe Kleine-König 		 * flow-types?
58782736f4dSUwe Kleine-König 		 */
58897fd75b7SAndrew Morton 		pr_debug("No set_type function for IRQ %d (%s)\n", irq,
58982736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
59082736f4dSUwe Kleine-König 		return 0;
59182736f4dSUwe Kleine-König 	}
59282736f4dSUwe Kleine-König 
593876dbd4cSThomas Gleixner 	flags &= IRQ_TYPE_SENSE_MASK;
594d4d5e089SThomas Gleixner 
595d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
59632f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
597d4d5e089SThomas Gleixner 			mask_irq(desc);
59832f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
599d4d5e089SThomas Gleixner 			unmask = 1;
600d4d5e089SThomas Gleixner 	}
601d4d5e089SThomas Gleixner 
602f2b662daSDavid Brownell 	/* caller masked out all except trigger mode flags */
603b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
60482736f4dSUwe Kleine-König 
605876dbd4cSThomas Gleixner 	switch (ret) {
606876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
6072cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
608876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
609876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
610876dbd4cSThomas Gleixner 
611876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
612876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
613876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
614876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
615876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
616876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
617876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
618876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
619876dbd4cSThomas Gleixner 		}
62046732475SThomas Gleixner 
621d4d5e089SThomas Gleixner 		ret = 0;
6228fff39e0SThomas Gleixner 		break;
623876dbd4cSThomas Gleixner 	default:
62497fd75b7SAndrew Morton 		pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
625876dbd4cSThomas Gleixner 		       flags, irq, chip->irq_set_type);
6260c5d1eb7SDavid Brownell 	}
627d4d5e089SThomas Gleixner 	if (unmask)
628d4d5e089SThomas Gleixner 		unmask_irq(desc);
62982736f4dSUwe Kleine-König 	return ret;
63082736f4dSUwe Kleine-König }
63182736f4dSUwe Kleine-König 
632293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
633293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
634293a7a0aSThomas Gleixner {
635293a7a0aSThomas Gleixner 	unsigned long flags;
636293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
637293a7a0aSThomas Gleixner 
638293a7a0aSThomas Gleixner 	if (!desc)
639293a7a0aSThomas Gleixner 		return -EINVAL;
640293a7a0aSThomas Gleixner 
641293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
642293a7a0aSThomas Gleixner 
643293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
644293a7a0aSThomas Gleixner 	return 0;
645293a7a0aSThomas Gleixner }
646293a7a0aSThomas Gleixner #endif
647293a7a0aSThomas Gleixner 
648b25c340cSThomas Gleixner /*
649b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
650b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
651b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
652b25c340cSThomas Gleixner  */
653b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
654b25c340cSThomas Gleixner {
655b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
656b25c340cSThomas Gleixner }
657b25c340cSThomas Gleixner 
658399b5da2SThomas Gleixner /*
659399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
660399b5da2SThomas Gleixner  * called.
661399b5da2SThomas Gleixner  */
662399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
663399b5da2SThomas Gleixner {
664399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
665399b5da2SThomas Gleixner 	return IRQ_NONE;
666399b5da2SThomas Gleixner }
667399b5da2SThomas Gleixner 
6683aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
6693aa551c9SThomas Gleixner {
6703aa551c9SThomas Gleixner 	set_current_state(TASK_INTERRUPTIBLE);
671f48fe81eSThomas Gleixner 
672550acb19SIdo Yariv 	while (!kthread_should_stop()) {
673550acb19SIdo Yariv 
674f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
675f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
6763aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
6773aa551c9SThomas Gleixner 			return 0;
678f48fe81eSThomas Gleixner 		}
6793aa551c9SThomas Gleixner 		schedule();
680550acb19SIdo Yariv 		set_current_state(TASK_INTERRUPTIBLE);
6813aa551c9SThomas Gleixner 	}
682550acb19SIdo Yariv 	__set_current_state(TASK_RUNNING);
6833aa551c9SThomas Gleixner 	return -1;
6843aa551c9SThomas Gleixner }
6853aa551c9SThomas Gleixner 
686b25c340cSThomas Gleixner /*
687b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
688b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
689b25c340cSThomas Gleixner  * is marked MASKED.
690b25c340cSThomas Gleixner  */
691b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
692f3f79e38SAlexander Gordeev 				 struct irqaction *action)
693b25c340cSThomas Gleixner {
694b5faba21SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT))
695b5faba21SThomas Gleixner 		return;
6960b1adaa0SThomas Gleixner again:
6973876ec9eSThomas Gleixner 	chip_bus_lock(desc);
698239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
6990b1adaa0SThomas Gleixner 
7000b1adaa0SThomas Gleixner 	/*
7010b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
7020b1adaa0SThomas Gleixner 	 * the following scenario:
7030b1adaa0SThomas Gleixner 	 *
7040b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
7050b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
7060b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
707009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
708b5faba21SThomas Gleixner 	 *
709b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
710b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
711b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
712b5faba21SThomas Gleixner 	 * serialization.
7130b1adaa0SThomas Gleixner 	 */
71432f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
7150b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
7163876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
7170b1adaa0SThomas Gleixner 		cpu_relax();
7180b1adaa0SThomas Gleixner 		goto again;
7190b1adaa0SThomas Gleixner 	}
7200b1adaa0SThomas Gleixner 
721b5faba21SThomas Gleixner 	/*
722b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
723b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
724b5faba21SThomas Gleixner 	 * was just set.
725b5faba21SThomas Gleixner 	 */
726f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
727b5faba21SThomas Gleixner 		goto out_unlock;
728b5faba21SThomas Gleixner 
729b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
730b5faba21SThomas Gleixner 
73132f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
73232f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
733328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
73432f4125eSThomas Gleixner 
735b5faba21SThomas Gleixner out_unlock:
736239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
7373876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
738b25c340cSThomas Gleixner }
739b25c340cSThomas Gleixner 
74061f38261SBruno Premont #ifdef CONFIG_SMP
7413aa551c9SThomas Gleixner /*
742b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
743591d2fb0SThomas Gleixner  */
744591d2fb0SThomas Gleixner static void
745591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
746591d2fb0SThomas Gleixner {
747591d2fb0SThomas Gleixner 	cpumask_var_t mask;
74804aa530eSThomas Gleixner 	bool valid = true;
749591d2fb0SThomas Gleixner 
750591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
751591d2fb0SThomas Gleixner 		return;
752591d2fb0SThomas Gleixner 
753591d2fb0SThomas Gleixner 	/*
754591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
755591d2fb0SThomas Gleixner 	 * try again next time
756591d2fb0SThomas Gleixner 	 */
757591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
758591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
759591d2fb0SThomas Gleixner 		return;
760591d2fb0SThomas Gleixner 	}
761591d2fb0SThomas Gleixner 
762239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
76304aa530eSThomas Gleixner 	/*
76404aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
76504aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
76604aa530eSThomas Gleixner 	 */
76704aa530eSThomas Gleixner 	if (desc->irq_data.affinity)
7686b8ff312SThomas Gleixner 		cpumask_copy(mask, desc->irq_data.affinity);
76904aa530eSThomas Gleixner 	else
77004aa530eSThomas Gleixner 		valid = false;
771239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
772591d2fb0SThomas Gleixner 
77304aa530eSThomas Gleixner 	if (valid)
774591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
775591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
776591d2fb0SThomas Gleixner }
77761f38261SBruno Premont #else
77861f38261SBruno Premont static inline void
77961f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
78061f38261SBruno Premont #endif
781591d2fb0SThomas Gleixner 
782591d2fb0SThomas Gleixner /*
7838d32a307SThomas Gleixner  * Interrupts which are not explicitely requested as threaded
7848d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
7858d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
7868d32a307SThomas Gleixner  * side effects.
7878d32a307SThomas Gleixner  */
7883a43e05fSSebastian Andrzej Siewior static irqreturn_t
7898d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
7908d32a307SThomas Gleixner {
7913a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
7923a43e05fSSebastian Andrzej Siewior 
7938d32a307SThomas Gleixner 	local_bh_disable();
7943a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
795f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
7968d32a307SThomas Gleixner 	local_bh_enable();
7973a43e05fSSebastian Andrzej Siewior 	return ret;
7988d32a307SThomas Gleixner }
7998d32a307SThomas Gleixner 
8008d32a307SThomas Gleixner /*
801f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
8028d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
8038d32a307SThomas Gleixner  * complete.
8048d32a307SThomas Gleixner  */
8053a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
8063a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
8078d32a307SThomas Gleixner {
8083a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8093a43e05fSSebastian Andrzej Siewior 
8103a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
811f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8123a43e05fSSebastian Andrzej Siewior 	return ret;
8138d32a307SThomas Gleixner }
8148d32a307SThomas Gleixner 
8157140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
8167140ea19SIdo Yariv {
817c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
8187140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
8197140ea19SIdo Yariv }
8207140ea19SIdo Yariv 
82167d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
8224d1d61a6SOleg Nesterov {
8234d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
8244d1d61a6SOleg Nesterov 	struct irq_desc *desc;
8254d1d61a6SOleg Nesterov 	struct irqaction *action;
8264d1d61a6SOleg Nesterov 
8274d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
8284d1d61a6SOleg Nesterov 		return;
8294d1d61a6SOleg Nesterov 
8304d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
8314d1d61a6SOleg Nesterov 
832fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
83319af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
8344d1d61a6SOleg Nesterov 
8354d1d61a6SOleg Nesterov 
8364d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
8374d1d61a6SOleg Nesterov 	/*
8384d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
8394d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
8404d1d61a6SOleg Nesterov 	 */
8414d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
8424d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
8434d1d61a6SOleg Nesterov 
8444d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
8454d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
8464d1d61a6SOleg Nesterov }
8474d1d61a6SOleg Nesterov 
8488d32a307SThomas Gleixner /*
8493aa551c9SThomas Gleixner  * Interrupt handler thread
8503aa551c9SThomas Gleixner  */
8513aa551c9SThomas Gleixner static int irq_thread(void *data)
8523aa551c9SThomas Gleixner {
85367d12145SAl Viro 	struct callback_head on_exit_work;
8543aa551c9SThomas Gleixner 	struct irqaction *action = data;
8553aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
8563a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
8573a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
8583aa551c9SThomas Gleixner 
859540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
8608d32a307SThomas Gleixner 					&action->thread_flags))
8618d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
8628d32a307SThomas Gleixner 	else
8638d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
8648d32a307SThomas Gleixner 
86541f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
8664d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
8673aa551c9SThomas Gleixner 
868f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
869f3de44edSSankara Muthukrishnan 
8703aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
8717140ea19SIdo Yariv 		irqreturn_t action_ret;
8723aa551c9SThomas Gleixner 
873591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
874591d2fb0SThomas Gleixner 
8753a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
8761e77d0a1SThomas Gleixner 		if (action_ret == IRQ_HANDLED)
8771e77d0a1SThomas Gleixner 			atomic_inc(&desc->threads_handled);
8787140ea19SIdo Yariv 
8797140ea19SIdo Yariv 		wake_threads_waitq(desc);
8803aa551c9SThomas Gleixner 	}
8813aa551c9SThomas Gleixner 
8827140ea19SIdo Yariv 	/*
8837140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
8847140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
8857140ea19SIdo Yariv 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
886e04268b0SThomas Gleixner 	 * oneshot mask bit can be set. We cannot verify that as we
887e04268b0SThomas Gleixner 	 * cannot touch the oneshot mask at this point anymore as
888e04268b0SThomas Gleixner 	 * __setup_irq() might have given out currents thread_mask
889e04268b0SThomas Gleixner 	 * again.
8903aa551c9SThomas Gleixner 	 */
8914d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
8923aa551c9SThomas Gleixner 	return 0;
8933aa551c9SThomas Gleixner }
8943aa551c9SThomas Gleixner 
895a92444c6SThomas Gleixner /**
896a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
897a92444c6SThomas Gleixner  *	@irq:		Interrupt line
898a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
899a92444c6SThomas Gleixner  *
900a92444c6SThomas Gleixner  */
901a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
902a92444c6SThomas Gleixner {
903a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
904a92444c6SThomas Gleixner 	struct irqaction *action;
905a92444c6SThomas Gleixner 	unsigned long flags;
906a92444c6SThomas Gleixner 
907a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
908a92444c6SThomas Gleixner 		return;
909a92444c6SThomas Gleixner 
910a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
911a92444c6SThomas Gleixner 	for (action = desc->action; action; action = action->next) {
912a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
913a92444c6SThomas Gleixner 			if (action->thread)
914a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
915a92444c6SThomas Gleixner 			break;
916a92444c6SThomas Gleixner 		}
917a92444c6SThomas Gleixner 	}
918a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
919a92444c6SThomas Gleixner }
920a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
921a92444c6SThomas Gleixner 
9228d32a307SThomas Gleixner static void irq_setup_forced_threading(struct irqaction *new)
9238d32a307SThomas Gleixner {
9248d32a307SThomas Gleixner 	if (!force_irqthreads)
9258d32a307SThomas Gleixner 		return;
9268d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
9278d32a307SThomas Gleixner 		return;
9288d32a307SThomas Gleixner 
9298d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
9308d32a307SThomas Gleixner 
9318d32a307SThomas Gleixner 	if (!new->thread_fn) {
9328d32a307SThomas Gleixner 		set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
9338d32a307SThomas Gleixner 		new->thread_fn = new->handler;
9348d32a307SThomas Gleixner 		new->handler = irq_default_primary_handler;
9358d32a307SThomas Gleixner 	}
9368d32a307SThomas Gleixner }
9378d32a307SThomas Gleixner 
938c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
939c1bacbaeSThomas Gleixner {
940c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
941c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
942c1bacbaeSThomas Gleixner 
943c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
944c1bacbaeSThomas Gleixner }
945c1bacbaeSThomas Gleixner 
946c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
947c1bacbaeSThomas Gleixner {
948c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
949c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
950c1bacbaeSThomas Gleixner 
951c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
952c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
953c1bacbaeSThomas Gleixner }
954c1bacbaeSThomas Gleixner 
9551da177e4SLinus Torvalds /*
9561da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
9571da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
9581da177e4SLinus Torvalds  */
959d3c60047SThomas Gleixner static int
960d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
9611da177e4SLinus Torvalds {
962f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
963b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
9643b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
9653b8249e7SThomas Gleixner 	cpumask_var_t mask;
9661da177e4SLinus Torvalds 
9677d94f7caSYinghai Lu 	if (!desc)
968c2b5a251SMatthew Wilcox 		return -EINVAL;
969c2b5a251SMatthew Wilcox 
9706b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
9711da177e4SLinus Torvalds 		return -ENOSYS;
972b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
973b6873807SSebastian Andrzej Siewior 		return -ENODEV;
9741da177e4SLinus Torvalds 
9751da177e4SLinus Torvalds 	/*
976399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
977399b5da2SThomas Gleixner 	 * thread.
9783aa551c9SThomas Gleixner 	 */
9791ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
980399b5da2SThomas Gleixner 	if (nested) {
981b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
982b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
983b6873807SSebastian Andrzej Siewior 			goto out_mput;
984b6873807SSebastian Andrzej Siewior 		}
985399b5da2SThomas Gleixner 		/*
986399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
987399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
988399b5da2SThomas Gleixner 		 * dummy function which warns when called.
989399b5da2SThomas Gleixner 		 */
990399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
9918d32a307SThomas Gleixner 	} else {
9927f1b1244SPaul Mundt 		if (irq_settings_can_thread(desc))
9938d32a307SThomas Gleixner 			irq_setup_forced_threading(new);
994399b5da2SThomas Gleixner 	}
995399b5da2SThomas Gleixner 
996399b5da2SThomas Gleixner 	/*
997399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
998399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
999399b5da2SThomas Gleixner 	 * thread.
1000399b5da2SThomas Gleixner 	 */
1001399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
10023aa551c9SThomas Gleixner 		struct task_struct *t;
1003ee238713SIvo Sieben 		static const struct sched_param param = {
1004ee238713SIvo Sieben 			.sched_priority = MAX_USER_RT_PRIO/2,
1005ee238713SIvo Sieben 		};
10063aa551c9SThomas Gleixner 
10073aa551c9SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
10083aa551c9SThomas Gleixner 				   new->name);
1009b6873807SSebastian Andrzej Siewior 		if (IS_ERR(t)) {
1010b6873807SSebastian Andrzej Siewior 			ret = PTR_ERR(t);
1011b6873807SSebastian Andrzej Siewior 			goto out_mput;
1012b6873807SSebastian Andrzej Siewior 		}
1013ee238713SIvo Sieben 
1014bbfe65c2SThomas Pfaff 		sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
1015ee238713SIvo Sieben 
10163aa551c9SThomas Gleixner 		/*
10173aa551c9SThomas Gleixner 		 * We keep the reference to the task struct even if
10183aa551c9SThomas Gleixner 		 * the thread dies to avoid that the interrupt code
10193aa551c9SThomas Gleixner 		 * references an already freed task_struct.
10203aa551c9SThomas Gleixner 		 */
10213aa551c9SThomas Gleixner 		get_task_struct(t);
10223aa551c9SThomas Gleixner 		new->thread = t;
102304aa530eSThomas Gleixner 		/*
102404aa530eSThomas Gleixner 		 * Tell the thread to set its affinity. This is
102504aa530eSThomas Gleixner 		 * important for shared interrupt handlers as we do
102604aa530eSThomas Gleixner 		 * not invoke setup_affinity() for the secondary
102704aa530eSThomas Gleixner 		 * handlers as everything is already set up. Even for
102804aa530eSThomas Gleixner 		 * interrupts marked with IRQF_NO_BALANCE this is
102904aa530eSThomas Gleixner 		 * correct as we want the thread to move to the cpu(s)
103004aa530eSThomas Gleixner 		 * on which the requesting code placed the interrupt.
103104aa530eSThomas Gleixner 		 */
103204aa530eSThomas Gleixner 		set_bit(IRQTF_AFFINITY, &new->thread_flags);
10333aa551c9SThomas Gleixner 	}
10343aa551c9SThomas Gleixner 
10353b8249e7SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
10363b8249e7SThomas Gleixner 		ret = -ENOMEM;
10373b8249e7SThomas Gleixner 		goto out_thread;
10383b8249e7SThomas Gleixner 	}
10393b8249e7SThomas Gleixner 
10403aa551c9SThomas Gleixner 	/*
1041dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1042dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1043dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1044dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1045dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1046dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1047dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1048dc9b229aSThomas Gleixner 	 */
1049dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1050dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1051dc9b229aSThomas Gleixner 
1052dc9b229aSThomas Gleixner 	/*
10531da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
10541da177e4SLinus Torvalds 	 */
1055239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1056f17c7545SIngo Molnar 	old_ptr = &desc->action;
1057f17c7545SIngo Molnar 	old = *old_ptr;
105806fcb0c6SIngo Molnar 	if (old) {
1059e76de9f8SThomas Gleixner 		/*
1060e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1061e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
10623cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
10639d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
10649d591eddSThomas Gleixner 		 * agree on ONESHOT.
1065e76de9f8SThomas Gleixner 		 */
10663cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
10679d591eddSThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
1068f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1069f5163427SDimitri Sivanich 			goto mismatch;
1070f5163427SDimitri Sivanich 
1071f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
10723cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
10733cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1074f5163427SDimitri Sivanich 			goto mismatch;
10751da177e4SLinus Torvalds 
10761da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
10771da177e4SLinus Torvalds 		do {
107852abb700SThomas Gleixner 			/*
107952abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
108052abb700SThomas Gleixner 			 * so we can find the next zero bit for this
108152abb700SThomas Gleixner 			 * new action.
108252abb700SThomas Gleixner 			 */
1083b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1084f17c7545SIngo Molnar 			old_ptr = &old->next;
1085f17c7545SIngo Molnar 			old = *old_ptr;
10861da177e4SLinus Torvalds 		} while (old);
10871da177e4SLinus Torvalds 		shared = 1;
10881da177e4SLinus Torvalds 	}
10891da177e4SLinus Torvalds 
1090b5faba21SThomas Gleixner 	/*
109152abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
109252abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
109352abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1094b5faba21SThomas Gleixner 	 */
109552abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
109652abb700SThomas Gleixner 		/*
109752abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
109852abb700SThomas Gleixner 		 * but who knows.
109952abb700SThomas Gleixner 		 */
110052abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1101b5faba21SThomas Gleixner 			ret = -EBUSY;
1102b5faba21SThomas Gleixner 			goto out_mask;
1103b5faba21SThomas Gleixner 		}
110452abb700SThomas Gleixner 		/*
110552abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
110652abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
110752abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
110852abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
110952abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
111052abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
111152abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
111252abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
111352abb700SThomas Gleixner 		 *
111452abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
111552abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
111652abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
111752abb700SThomas Gleixner 		 * affected hard irq flow handlers
111852abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
111952abb700SThomas Gleixner 		 *
112052abb700SThomas Gleixner 		 * The new action gets the first zero bit of
112152abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
112252abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
112352abb700SThomas Gleixner 		 */
1124b5faba21SThomas Gleixner 		new->thread_mask = 1 << ffz(thread_mask);
11251c6c6952SThomas Gleixner 
1126dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1127dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
11281c6c6952SThomas Gleixner 		/*
11291c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
11301c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
11311c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
11321c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
11331c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
11341c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
11351c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
11361c6c6952SThomas Gleixner 		 *
11371c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
11381c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
11391c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
11401c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
11411c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
11421c6c6952SThomas Gleixner 		 */
114397fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
11441c6c6952SThomas Gleixner 		       irq);
11451c6c6952SThomas Gleixner 		ret = -EINVAL;
11461c6c6952SThomas Gleixner 		goto out_mask;
114752abb700SThomas Gleixner 	}
1148b5faba21SThomas Gleixner 
11491da177e4SLinus Torvalds 	if (!shared) {
1150c1bacbaeSThomas Gleixner 		ret = irq_request_resources(desc);
1151c1bacbaeSThomas Gleixner 		if (ret) {
1152c1bacbaeSThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
1153c1bacbaeSThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
1154c1bacbaeSThomas Gleixner 			goto out_mask;
1155c1bacbaeSThomas Gleixner 		}
1156c1bacbaeSThomas Gleixner 
11573aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
11583aa551c9SThomas Gleixner 
115982736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
116082736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1161f2b662daSDavid Brownell 			ret = __irq_set_trigger(desc, irq,
1162f2b662daSDavid Brownell 					new->flags & IRQF_TRIGGER_MASK);
116382736f4dSUwe Kleine-König 
11643aa551c9SThomas Gleixner 			if (ret)
11653b8249e7SThomas Gleixner 				goto out_mask;
1166091738a2SThomas Gleixner 		}
1167f75d222bSAhmed S. Darwish 
1168009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
116932f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
117032f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
117194d39e1fSThomas Gleixner 
1172a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1173a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1174a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1175a005677bSThomas Gleixner 		}
11766a58fb3bSThomas Gleixner 
1177b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
11783d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1179b25c340cSThomas Gleixner 
11801ccb4e61SThomas Gleixner 		if (irq_settings_can_autoenable(desc))
1181b4bc724eSThomas Gleixner 			irq_startup(desc, true);
118246999238SThomas Gleixner 		else
1183e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1184e76de9f8SThomas Gleixner 			desc->depth = 1;
118518404756SMax Krasnyansky 
1186612e3684SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
1187a005677bSThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
1188a005677bSThomas Gleixner 			irq_settings_set_no_balancing(desc);
1189a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1190a005677bSThomas Gleixner 		}
1191612e3684SThomas Gleixner 
119218404756SMax Krasnyansky 		/* Set default affinity mask once everything is setup */
11933b8249e7SThomas Gleixner 		setup_affinity(irq, desc, mask);
11940c5d1eb7SDavid Brownell 
1195876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1196876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
1197876dbd4cSThomas Gleixner 		unsigned int omsk = irq_settings_get_trigger_mask(desc);
1198876dbd4cSThomas Gleixner 
1199876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1200876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
120197fd75b7SAndrew Morton 			pr_warning("irq %d uses trigger mode %u; requested %u\n",
1202876dbd4cSThomas Gleixner 				   irq, nmsk, omsk);
120394d39e1fSThomas Gleixner 	}
120482736f4dSUwe Kleine-König 
120569ab8494SThomas Gleixner 	new->irq = irq;
1206f17c7545SIngo Molnar 	*old_ptr = new;
120782736f4dSUwe Kleine-König 
1208cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1209cab303beSThomas Gleixner 
12108528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
12118528b0f1SLinus Torvalds 	desc->irq_count = 0;
12128528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
12131adb0850SThomas Gleixner 
12141adb0850SThomas Gleixner 	/*
12151adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
12161adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
12171adb0850SThomas Gleixner 	 */
12187acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
12197acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
12208df2e02cSThomas Gleixner 		__enable_irq(desc, irq);
12211adb0850SThomas Gleixner 	}
12221adb0850SThomas Gleixner 
1223239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
12241da177e4SLinus Torvalds 
122569ab8494SThomas Gleixner 	/*
122669ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
122769ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
122869ab8494SThomas Gleixner 	 */
122969ab8494SThomas Gleixner 	if (new->thread)
123069ab8494SThomas Gleixner 		wake_up_process(new->thread);
123169ab8494SThomas Gleixner 
12322c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
12331da177e4SLinus Torvalds 	new->dir = NULL;
12341da177e4SLinus Torvalds 	register_handler_proc(irq, new);
12354f5058c3SXiaotian Feng 	free_cpumask_var(mask);
12361da177e4SLinus Torvalds 
12371da177e4SLinus Torvalds 	return 0;
1238f5163427SDimitri Sivanich 
1239f5163427SDimitri Sivanich mismatch:
12403cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
124197fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1242f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1243f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1244f5163427SDimitri Sivanich 		dump_stack();
12453f050447SAlan Cox #endif
1246f5d89470SThomas Gleixner 	}
12473aa551c9SThomas Gleixner 	ret = -EBUSY;
12483aa551c9SThomas Gleixner 
12493b8249e7SThomas Gleixner out_mask:
12501c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
12513b8249e7SThomas Gleixner 	free_cpumask_var(mask);
12523b8249e7SThomas Gleixner 
12533aa551c9SThomas Gleixner out_thread:
12543aa551c9SThomas Gleixner 	if (new->thread) {
12553aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
12563aa551c9SThomas Gleixner 
12573aa551c9SThomas Gleixner 		new->thread = NULL;
12583aa551c9SThomas Gleixner 		kthread_stop(t);
12593aa551c9SThomas Gleixner 		put_task_struct(t);
12603aa551c9SThomas Gleixner 	}
1261b6873807SSebastian Andrzej Siewior out_mput:
1262b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
12633aa551c9SThomas Gleixner 	return ret;
12641da177e4SLinus Torvalds }
12651da177e4SLinus Torvalds 
12661da177e4SLinus Torvalds /**
1267d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1268d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1269d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1270d3c60047SThomas Gleixner  *
1271d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1272d3c60047SThomas Gleixner  */
1273d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1274d3c60047SThomas Gleixner {
1275986c011dSDavid Daney 	int retval;
1276d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1277d3c60047SThomas Gleixner 
127831d9d9b6SMarc Zyngier 	if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
127931d9d9b6SMarc Zyngier 		return -EINVAL;
1280986c011dSDavid Daney 	chip_bus_lock(desc);
1281986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1282986c011dSDavid Daney 	chip_bus_sync_unlock(desc);
1283986c011dSDavid Daney 
1284986c011dSDavid Daney 	return retval;
1285d3c60047SThomas Gleixner }
1286eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1287d3c60047SThomas Gleixner 
1288cbf94f06SMagnus Damm /*
1289cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1290cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
12911da177e4SLinus Torvalds  */
1292cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
12931da177e4SLinus Torvalds {
1294d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1295f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
12961da177e4SLinus Torvalds 	unsigned long flags;
12971da177e4SLinus Torvalds 
1298ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
12997d94f7caSYinghai Lu 
13007d94f7caSYinghai Lu 	if (!desc)
1301f21cfb25SMagnus Damm 		return NULL;
13021da177e4SLinus Torvalds 
1303239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1304ae88a23bSIngo Molnar 
1305ae88a23bSIngo Molnar 	/*
1306ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1307ae88a23bSIngo Molnar 	 * one based on the dev_id:
1308ae88a23bSIngo Molnar 	 */
1309f17c7545SIngo Molnar 	action_ptr = &desc->action;
13101da177e4SLinus Torvalds 	for (;;) {
1311f17c7545SIngo Molnar 		action = *action_ptr;
13121da177e4SLinus Torvalds 
1313ae88a23bSIngo Molnar 		if (!action) {
1314ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1315239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1316ae88a23bSIngo Molnar 
1317f21cfb25SMagnus Damm 			return NULL;
1318ae88a23bSIngo Molnar 		}
13191da177e4SLinus Torvalds 
13208316e381SIngo Molnar 		if (action->dev_id == dev_id)
1321ae88a23bSIngo Molnar 			break;
1322f17c7545SIngo Molnar 		action_ptr = &action->next;
1323ae88a23bSIngo Molnar 	}
1324ae88a23bSIngo Molnar 
1325ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1326f17c7545SIngo Molnar 	*action_ptr = action->next;
1327dbce706eSPaolo 'Blaisorblade' Giarrusso 
1328cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1329cab303beSThomas Gleixner 
1330ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1331c1bacbaeSThomas Gleixner 	if (!desc->action) {
133246999238SThomas Gleixner 		irq_shutdown(desc);
1333c1bacbaeSThomas Gleixner 		irq_release_resources(desc);
1334c1bacbaeSThomas Gleixner 	}
13353aa551c9SThomas Gleixner 
1336e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1337e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1338e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1339e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1340e7a297b0SPeter P Waskiewicz Jr #endif
1341e7a297b0SPeter P Waskiewicz Jr 
1342239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1343ae88a23bSIngo Molnar 
13441da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
13451da177e4SLinus Torvalds 
1346ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
13471da177e4SLinus Torvalds 	synchronize_irq(irq);
1348ae88a23bSIngo Molnar 
13491d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
13501d99493bSDavid Woodhouse 	/*
1351ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1352ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1353ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1354ae88a23bSIngo Molnar 	 *
1355ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
1356ae88a23bSIngo Molnar 	 *   'real' IRQ doesn't run in * parallel with our fake. )
13571d99493bSDavid Woodhouse 	 */
13581d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
13591d99493bSDavid Woodhouse 		local_irq_save(flags);
13601d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
13611d99493bSDavid Woodhouse 		local_irq_restore(flags);
13621d99493bSDavid Woodhouse 	}
13631d99493bSDavid Woodhouse #endif
13642d860ad7SLinus Torvalds 
13652d860ad7SLinus Torvalds 	if (action->thread) {
13662d860ad7SLinus Torvalds 		kthread_stop(action->thread);
13672d860ad7SLinus Torvalds 		put_task_struct(action->thread);
13682d860ad7SLinus Torvalds 	}
13692d860ad7SLinus Torvalds 
1370b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
1371f21cfb25SMagnus Damm 	return action;
1372f21cfb25SMagnus Damm }
13731da177e4SLinus Torvalds 
13741da177e4SLinus Torvalds /**
1375cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1376cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1377cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1378cbf94f06SMagnus Damm  *
1379cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1380cbf94f06SMagnus Damm  */
1381cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1382cbf94f06SMagnus Damm {
138331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
138431d9d9b6SMarc Zyngier 
138531d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1386cbf94f06SMagnus Damm 	    __free_irq(irq, act->dev_id);
1387cbf94f06SMagnus Damm }
1388eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1389cbf94f06SMagnus Damm 
1390cbf94f06SMagnus Damm /**
1391f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
13921da177e4SLinus Torvalds  *	@irq: Interrupt line to free
13931da177e4SLinus Torvalds  *	@dev_id: Device identity to free
13941da177e4SLinus Torvalds  *
13951da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
13961da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
13971da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
13981da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
13991da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
14001da177e4SLinus Torvalds  *	have completed.
14011da177e4SLinus Torvalds  *
14021da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
14031da177e4SLinus Torvalds  */
14041da177e4SLinus Torvalds void free_irq(unsigned int irq, void *dev_id)
14051da177e4SLinus Torvalds {
140670aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
140770aedd24SThomas Gleixner 
140831d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
140970aedd24SThomas Gleixner 		return;
141070aedd24SThomas Gleixner 
1411cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1412cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1413cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1414cd7eab44SBen Hutchings #endif
1415cd7eab44SBen Hutchings 
14163876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1417cbf94f06SMagnus Damm 	kfree(__free_irq(irq, dev_id));
14183876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
14191da177e4SLinus Torvalds }
14201da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
14211da177e4SLinus Torvalds 
14221da177e4SLinus Torvalds /**
14233aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
14241da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
14253aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
14263aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1427b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1428b25c340cSThomas Gleixner  *		  primary handler is installed
14293aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
14303aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
14311da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
14321da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
14331da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
14341da177e4SLinus Torvalds  *
14351da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
14361da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
14371da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
14381da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
14391da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
14401da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
14411da177e4SLinus Torvalds  *
14423aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
14436d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
14443aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
14453aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
14463aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
144739a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
14483aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
14493aa551c9SThomas Gleixner  *	shared interrupts.
14503aa551c9SThomas Gleixner  *
14511da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
14521da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
14531da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
14541da177e4SLinus Torvalds  *
14551da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
14561da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
14571da177e4SLinus Torvalds  *
14581da177e4SLinus Torvalds  *	Flags:
14591da177e4SLinus Torvalds  *
14603cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
14610c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
14621da177e4SLinus Torvalds  *
14631da177e4SLinus Torvalds  */
14643aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
14653aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
14663aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
14671da177e4SLinus Torvalds {
14681da177e4SLinus Torvalds 	struct irqaction *action;
146908678b08SYinghai Lu 	struct irq_desc *desc;
1470d3c60047SThomas Gleixner 	int retval;
14711da177e4SLinus Torvalds 
1472470c6623SDavid Brownell 	/*
14731da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
14741da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
14751da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
14761da177e4SLinus Torvalds 	 * logic etc).
14771da177e4SLinus Torvalds 	 */
14783cca53b0SThomas Gleixner 	if ((irqflags & IRQF_SHARED) && !dev_id)
14791da177e4SLinus Torvalds 		return -EINVAL;
14807d94f7caSYinghai Lu 
1481cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
14827d94f7caSYinghai Lu 	if (!desc)
14831da177e4SLinus Torvalds 		return -EINVAL;
14847d94f7caSYinghai Lu 
148531d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
148631d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
14876550c775SThomas Gleixner 		return -EINVAL;
1488b25c340cSThomas Gleixner 
1489b25c340cSThomas Gleixner 	if (!handler) {
1490b25c340cSThomas Gleixner 		if (!thread_fn)
14911da177e4SLinus Torvalds 			return -EINVAL;
1492b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1493b25c340cSThomas Gleixner 	}
14941da177e4SLinus Torvalds 
149545535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
14961da177e4SLinus Torvalds 	if (!action)
14971da177e4SLinus Torvalds 		return -ENOMEM;
14981da177e4SLinus Torvalds 
14991da177e4SLinus Torvalds 	action->handler = handler;
15003aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
15011da177e4SLinus Torvalds 	action->flags = irqflags;
15021da177e4SLinus Torvalds 	action->name = devname;
15031da177e4SLinus Torvalds 	action->dev_id = dev_id;
15041da177e4SLinus Torvalds 
15053876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1506d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
15073876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
150870aedd24SThomas Gleixner 
1509377bf1e4SAnton Vorontsov 	if (retval)
1510377bf1e4SAnton Vorontsov 		kfree(action);
1511377bf1e4SAnton Vorontsov 
15126d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
15136ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1514a304e1b8SDavid Woodhouse 		/*
1515a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
1516a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
1517377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1518377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
1519a304e1b8SDavid Woodhouse 		 */
1520a304e1b8SDavid Woodhouse 		unsigned long flags;
1521a304e1b8SDavid Woodhouse 
1522377bf1e4SAnton Vorontsov 		disable_irq(irq);
1523a304e1b8SDavid Woodhouse 		local_irq_save(flags);
1524377bf1e4SAnton Vorontsov 
1525a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
1526377bf1e4SAnton Vorontsov 
1527a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
1528377bf1e4SAnton Vorontsov 		enable_irq(irq);
1529a304e1b8SDavid Woodhouse 	}
1530a304e1b8SDavid Woodhouse #endif
15311da177e4SLinus Torvalds 	return retval;
15321da177e4SLinus Torvalds }
15333aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
1534ae731f8dSMarc Zyngier 
1535ae731f8dSMarc Zyngier /**
1536ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
1537ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
1538ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
1539ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
1540ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
1541ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
1542ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
1543ae731f8dSMarc Zyngier  *
1544ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
1545ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
1546ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
1547ae731f8dSMarc Zyngier  *	context.
1548ae731f8dSMarc Zyngier  *
1549ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
1550ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1551ae731f8dSMarc Zyngier  */
1552ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1553ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
1554ae731f8dSMarc Zyngier {
1555ae731f8dSMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
1556ae731f8dSMarc Zyngier 	int ret;
1557ae731f8dSMarc Zyngier 
1558ae731f8dSMarc Zyngier 	if (!desc)
1559ae731f8dSMarc Zyngier 		return -EINVAL;
1560ae731f8dSMarc Zyngier 
15611ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
1562ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
1563ae731f8dSMarc Zyngier 					   flags, name, dev_id);
1564ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
1565ae731f8dSMarc Zyngier 	}
1566ae731f8dSMarc Zyngier 
1567ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
1568ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
1569ae731f8dSMarc Zyngier }
1570ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
157131d9d9b6SMarc Zyngier 
15721e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
157331d9d9b6SMarc Zyngier {
157431d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
157531d9d9b6SMarc Zyngier 	unsigned long flags;
157631d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
157731d9d9b6SMarc Zyngier 
157831d9d9b6SMarc Zyngier 	if (!desc)
157931d9d9b6SMarc Zyngier 		return;
158031d9d9b6SMarc Zyngier 
15811e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
15821e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
15831e7c5fd2SMarc Zyngier 		int ret;
15841e7c5fd2SMarc Zyngier 
15851e7c5fd2SMarc Zyngier 		ret = __irq_set_trigger(desc, irq, type);
15861e7c5fd2SMarc Zyngier 
15871e7c5fd2SMarc Zyngier 		if (ret) {
158832cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
15891e7c5fd2SMarc Zyngier 			goto out;
15901e7c5fd2SMarc Zyngier 		}
15911e7c5fd2SMarc Zyngier 	}
15921e7c5fd2SMarc Zyngier 
159331d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
15941e7c5fd2SMarc Zyngier out:
159531d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
159631d9d9b6SMarc Zyngier }
159736a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
159831d9d9b6SMarc Zyngier 
159931d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
160031d9d9b6SMarc Zyngier {
160131d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
160231d9d9b6SMarc Zyngier 	unsigned long flags;
160331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
160431d9d9b6SMarc Zyngier 
160531d9d9b6SMarc Zyngier 	if (!desc)
160631d9d9b6SMarc Zyngier 		return;
160731d9d9b6SMarc Zyngier 
160831d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
160931d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
161031d9d9b6SMarc Zyngier }
161136a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
161231d9d9b6SMarc Zyngier 
161331d9d9b6SMarc Zyngier /*
161431d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
161531d9d9b6SMarc Zyngier  */
161631d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
161731d9d9b6SMarc Zyngier {
161831d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
161931d9d9b6SMarc Zyngier 	struct irqaction *action;
162031d9d9b6SMarc Zyngier 	unsigned long flags;
162131d9d9b6SMarc Zyngier 
162231d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
162331d9d9b6SMarc Zyngier 
162431d9d9b6SMarc Zyngier 	if (!desc)
162531d9d9b6SMarc Zyngier 		return NULL;
162631d9d9b6SMarc Zyngier 
162731d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
162831d9d9b6SMarc Zyngier 
162931d9d9b6SMarc Zyngier 	action = desc->action;
163031d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
163131d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
163231d9d9b6SMarc Zyngier 		goto bad;
163331d9d9b6SMarc Zyngier 	}
163431d9d9b6SMarc Zyngier 
163531d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
163631d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
163731d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
163831d9d9b6SMarc Zyngier 		goto bad;
163931d9d9b6SMarc Zyngier 	}
164031d9d9b6SMarc Zyngier 
164131d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
164231d9d9b6SMarc Zyngier 	desc->action = NULL;
164331d9d9b6SMarc Zyngier 
164431d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
164531d9d9b6SMarc Zyngier 
164631d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
164731d9d9b6SMarc Zyngier 
164831d9d9b6SMarc Zyngier 	module_put(desc->owner);
164931d9d9b6SMarc Zyngier 	return action;
165031d9d9b6SMarc Zyngier 
165131d9d9b6SMarc Zyngier bad:
165231d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
165331d9d9b6SMarc Zyngier 	return NULL;
165431d9d9b6SMarc Zyngier }
165531d9d9b6SMarc Zyngier 
165631d9d9b6SMarc Zyngier /**
165731d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
165831d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
165931d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
166031d9d9b6SMarc Zyngier  *
166131d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
166231d9d9b6SMarc Zyngier  */
166331d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
166431d9d9b6SMarc Zyngier {
166531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
166631d9d9b6SMarc Zyngier 
166731d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
166831d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
166931d9d9b6SMarc Zyngier }
167031d9d9b6SMarc Zyngier 
167131d9d9b6SMarc Zyngier /**
167231d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
167331d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
167431d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
167531d9d9b6SMarc Zyngier  *
167631d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
167731d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
167831d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
167931d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
168031d9d9b6SMarc Zyngier  *
168131d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
168231d9d9b6SMarc Zyngier  */
168331d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
168431d9d9b6SMarc Zyngier {
168531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
168631d9d9b6SMarc Zyngier 
168731d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
168831d9d9b6SMarc Zyngier 		return;
168931d9d9b6SMarc Zyngier 
169031d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
169131d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
169231d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
169331d9d9b6SMarc Zyngier }
169431d9d9b6SMarc Zyngier 
169531d9d9b6SMarc Zyngier /**
169631d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
169731d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
169831d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
169931d9d9b6SMarc Zyngier  *
170031d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
170131d9d9b6SMarc Zyngier  */
170231d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
170331d9d9b6SMarc Zyngier {
170431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
170531d9d9b6SMarc Zyngier 	int retval;
170631d9d9b6SMarc Zyngier 
170731d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
170831d9d9b6SMarc Zyngier 		return -EINVAL;
170931d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
171031d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
171131d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
171231d9d9b6SMarc Zyngier 
171331d9d9b6SMarc Zyngier 	return retval;
171431d9d9b6SMarc Zyngier }
171531d9d9b6SMarc Zyngier 
171631d9d9b6SMarc Zyngier /**
171731d9d9b6SMarc Zyngier  *	request_percpu_irq - allocate a percpu interrupt line
171831d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
171931d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
172031d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
172131d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
172231d9d9b6SMarc Zyngier  *
172331d9d9b6SMarc Zyngier  *	This call allocates interrupt resources, but doesn't
172431d9d9b6SMarc Zyngier  *	automatically enable the interrupt. It has to be done on each
172531d9d9b6SMarc Zyngier  *	CPU using enable_percpu_irq().
172631d9d9b6SMarc Zyngier  *
172731d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
172831d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
172931d9d9b6SMarc Zyngier  *	that variable.
173031d9d9b6SMarc Zyngier  */
173131d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler,
173231d9d9b6SMarc Zyngier 		       const char *devname, void __percpu *dev_id)
173331d9d9b6SMarc Zyngier {
173431d9d9b6SMarc Zyngier 	struct irqaction *action;
173531d9d9b6SMarc Zyngier 	struct irq_desc *desc;
173631d9d9b6SMarc Zyngier 	int retval;
173731d9d9b6SMarc Zyngier 
173831d9d9b6SMarc Zyngier 	if (!dev_id)
173931d9d9b6SMarc Zyngier 		return -EINVAL;
174031d9d9b6SMarc Zyngier 
174131d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
174231d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
174331d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
174431d9d9b6SMarc Zyngier 		return -EINVAL;
174531d9d9b6SMarc Zyngier 
174631d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
174731d9d9b6SMarc Zyngier 	if (!action)
174831d9d9b6SMarc Zyngier 		return -ENOMEM;
174931d9d9b6SMarc Zyngier 
175031d9d9b6SMarc Zyngier 	action->handler = handler;
17512ed0e645SMarc Zyngier 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
175231d9d9b6SMarc Zyngier 	action->name = devname;
175331d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
175431d9d9b6SMarc Zyngier 
175531d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
175631d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
175731d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
175831d9d9b6SMarc Zyngier 
175931d9d9b6SMarc Zyngier 	if (retval)
176031d9d9b6SMarc Zyngier 		kfree(action);
176131d9d9b6SMarc Zyngier 
176231d9d9b6SMarc Zyngier 	return retval;
176331d9d9b6SMarc Zyngier }
1764