xref: /openbmc/linux/kernel/irq/manage.c (revision 1b7047edfcfb257f69e306c9afbab150cb987717)
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  *
7102cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
7202cea395SPeter Zijlstra  *
7318258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
743aa551c9SThomas Gleixner  */
7502cea395SPeter Zijlstra bool synchronize_hardirq(unsigned int irq)
7618258f72SThomas Gleixner {
7718258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
7818258f72SThomas Gleixner 
7902cea395SPeter Zijlstra 	if (desc) {
8018258f72SThomas Gleixner 		__synchronize_hardirq(desc);
8102cea395SPeter Zijlstra 		return !atomic_read(&desc->threads_active);
8202cea395SPeter Zijlstra 	}
8302cea395SPeter Zijlstra 
8402cea395SPeter Zijlstra 	return true;
8518258f72SThomas Gleixner }
8618258f72SThomas Gleixner EXPORT_SYMBOL(synchronize_hardirq);
8718258f72SThomas Gleixner 
8818258f72SThomas Gleixner /**
8918258f72SThomas Gleixner  *	synchronize_irq - wait for pending IRQ handlers (on other CPUs)
9018258f72SThomas Gleixner  *	@irq: interrupt number to wait for
9118258f72SThomas Gleixner  *
9218258f72SThomas Gleixner  *	This function waits for any pending IRQ handlers for this interrupt
9318258f72SThomas Gleixner  *	to complete before returning. If you use this function while
9418258f72SThomas Gleixner  *	holding a resource the IRQ handler may need you will deadlock.
9518258f72SThomas Gleixner  *
9618258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
9718258f72SThomas Gleixner  */
9818258f72SThomas Gleixner void synchronize_irq(unsigned int irq)
9918258f72SThomas Gleixner {
10018258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
10118258f72SThomas Gleixner 
10218258f72SThomas Gleixner 	if (desc) {
10318258f72SThomas Gleixner 		__synchronize_hardirq(desc);
10418258f72SThomas Gleixner 		/*
10518258f72SThomas Gleixner 		 * We made sure that no hardirq handler is
10618258f72SThomas Gleixner 		 * running. Now verify that no threaded handlers are
10718258f72SThomas Gleixner 		 * active.
10818258f72SThomas Gleixner 		 */
10918258f72SThomas Gleixner 		wait_event(desc->wait_for_threads,
11018258f72SThomas Gleixner 			   !atomic_read(&desc->threads_active));
11118258f72SThomas Gleixner 	}
1121da177e4SLinus Torvalds }
1131da177e4SLinus Torvalds EXPORT_SYMBOL(synchronize_irq);
1141da177e4SLinus Torvalds 
1153aa551c9SThomas Gleixner #ifdef CONFIG_SMP
1163aa551c9SThomas Gleixner cpumask_var_t irq_default_affinity;
1173aa551c9SThomas Gleixner 
118771ee3b0SThomas Gleixner /**
119771ee3b0SThomas Gleixner  *	irq_can_set_affinity - Check if the affinity of a given irq can be set
120771ee3b0SThomas Gleixner  *	@irq:		Interrupt to check
121771ee3b0SThomas Gleixner  *
122771ee3b0SThomas Gleixner  */
123771ee3b0SThomas Gleixner int irq_can_set_affinity(unsigned int irq)
124771ee3b0SThomas Gleixner {
12508678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
126771ee3b0SThomas Gleixner 
127bce43032SThomas Gleixner 	if (!desc || !irqd_can_balance(&desc->irq_data) ||
128bce43032SThomas Gleixner 	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
129771ee3b0SThomas Gleixner 		return 0;
130771ee3b0SThomas Gleixner 
131771ee3b0SThomas Gleixner 	return 1;
132771ee3b0SThomas Gleixner }
133771ee3b0SThomas Gleixner 
134591d2fb0SThomas Gleixner /**
135591d2fb0SThomas Gleixner  *	irq_set_thread_affinity - Notify irq threads to adjust affinity
136591d2fb0SThomas Gleixner  *	@desc:		irq descriptor which has affitnity changed
137591d2fb0SThomas Gleixner  *
138591d2fb0SThomas Gleixner  *	We just set IRQTF_AFFINITY and delegate the affinity setting
139591d2fb0SThomas Gleixner  *	to the interrupt thread itself. We can not call
140591d2fb0SThomas Gleixner  *	set_cpus_allowed_ptr() here as we hold desc->lock and this
141591d2fb0SThomas Gleixner  *	code can be called from hard interrupt context.
142591d2fb0SThomas Gleixner  */
143591d2fb0SThomas Gleixner void irq_set_thread_affinity(struct irq_desc *desc)
1443aa551c9SThomas Gleixner {
1453aa551c9SThomas Gleixner 	struct irqaction *action = desc->action;
1463aa551c9SThomas Gleixner 
1473aa551c9SThomas Gleixner 	while (action) {
1483aa551c9SThomas Gleixner 		if (action->thread)
149591d2fb0SThomas Gleixner 			set_bit(IRQTF_AFFINITY, &action->thread_flags);
1503aa551c9SThomas Gleixner 		action = action->next;
1513aa551c9SThomas Gleixner 	}
1523aa551c9SThomas Gleixner }
1533aa551c9SThomas Gleixner 
1541fa46f1fSThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ
1550ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data)
1561fa46f1fSThomas Gleixner {
1570ef5ca1eSThomas Gleixner 	return irqd_can_move_in_process_context(data);
1581fa46f1fSThomas Gleixner }
1590ef5ca1eSThomas Gleixner static inline bool irq_move_pending(struct irq_data *data)
1601fa46f1fSThomas Gleixner {
1610ef5ca1eSThomas Gleixner 	return irqd_is_setaffinity_pending(data);
1621fa46f1fSThomas Gleixner }
1631fa46f1fSThomas Gleixner static inline void
1641fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
1651fa46f1fSThomas Gleixner {
1661fa46f1fSThomas Gleixner 	cpumask_copy(desc->pending_mask, mask);
1671fa46f1fSThomas Gleixner }
1681fa46f1fSThomas Gleixner static inline void
1691fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
1701fa46f1fSThomas Gleixner {
1711fa46f1fSThomas Gleixner 	cpumask_copy(mask, desc->pending_mask);
1721fa46f1fSThomas Gleixner }
1731fa46f1fSThomas Gleixner #else
1740ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
175cd22c0e4SThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) { return false; }
1761fa46f1fSThomas Gleixner static inline void
1771fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
1781fa46f1fSThomas Gleixner static inline void
1791fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
1801fa46f1fSThomas Gleixner #endif
1811fa46f1fSThomas Gleixner 
182818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
183818b0f3bSJiang Liu 			bool force)
184818b0f3bSJiang Liu {
185818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
186818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
187818b0f3bSJiang Liu 	int ret;
188818b0f3bSJiang Liu 
18901f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
190818b0f3bSJiang Liu 	switch (ret) {
191818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
1922cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
193818b0f3bSJiang Liu 		cpumask_copy(data->affinity, mask);
194818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
195818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
196818b0f3bSJiang Liu 		ret = 0;
197818b0f3bSJiang Liu 	}
198818b0f3bSJiang Liu 
199818b0f3bSJiang Liu 	return ret;
200818b0f3bSJiang Liu }
201818b0f3bSJiang Liu 
20201f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
20301f8fa4fSThomas Gleixner 			    bool force)
204c2d0c555SDavid Daney {
205c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
206c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
207c2d0c555SDavid Daney 	int ret = 0;
208c2d0c555SDavid Daney 
209c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
210c2d0c555SDavid Daney 		return -EINVAL;
211c2d0c555SDavid Daney 
2120ef5ca1eSThomas Gleixner 	if (irq_can_move_pcntxt(data)) {
21301f8fa4fSThomas Gleixner 		ret = irq_do_set_affinity(data, mask, force);
214c2d0c555SDavid Daney 	} else {
215c2d0c555SDavid Daney 		irqd_set_move_pending(data);
216c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
217c2d0c555SDavid Daney 	}
218c2d0c555SDavid Daney 
219c2d0c555SDavid Daney 	if (desc->affinity_notify) {
220c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
221c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
222c2d0c555SDavid Daney 	}
223c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
224c2d0c555SDavid Daney 
225c2d0c555SDavid Daney 	return ret;
226c2d0c555SDavid Daney }
227c2d0c555SDavid Daney 
22801f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
229771ee3b0SThomas Gleixner {
23008678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
231f6d87f4bSThomas Gleixner 	unsigned long flags;
232c2d0c555SDavid Daney 	int ret;
233771ee3b0SThomas Gleixner 
234c2d0c555SDavid Daney 	if (!desc)
235771ee3b0SThomas Gleixner 		return -EINVAL;
236771ee3b0SThomas Gleixner 
237239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
23801f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
239239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2401fa46f1fSThomas Gleixner 	return ret;
241771ee3b0SThomas Gleixner }
242771ee3b0SThomas Gleixner 
243e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
244e7a297b0SPeter P Waskiewicz Jr {
245e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
24631d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
247e7a297b0SPeter P Waskiewicz Jr 
248e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
249e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
250e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
25102725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
252e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
2534fe7ffb7SJesse Brandeburg 	if (m)
254e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
255e7a297b0SPeter P Waskiewicz Jr 	return 0;
256e7a297b0SPeter P Waskiewicz Jr }
257e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
258e7a297b0SPeter P Waskiewicz Jr 
259cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
260cd7eab44SBen Hutchings {
261cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
262cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
263cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
264cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
265cd7eab44SBen Hutchings 	unsigned long flags;
266cd7eab44SBen Hutchings 
2671fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
268cd7eab44SBen Hutchings 		goto out;
269cd7eab44SBen Hutchings 
270cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
2710ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
2721fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
273cd7eab44SBen Hutchings 	else
2741fb0ef31SThomas Gleixner 		cpumask_copy(cpumask, desc->irq_data.affinity);
275cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
276cd7eab44SBen Hutchings 
277cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
278cd7eab44SBen Hutchings 
279cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
280cd7eab44SBen Hutchings out:
281cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
282cd7eab44SBen Hutchings }
283cd7eab44SBen Hutchings 
284cd7eab44SBen Hutchings /**
285cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
286cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
287cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
288cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
289cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
290cd7eab44SBen Hutchings  *
291cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
292cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
293cd7eab44SBen Hutchings  *	freed using free_irq().
294cd7eab44SBen Hutchings  */
295cd7eab44SBen Hutchings int
296cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
297cd7eab44SBen Hutchings {
298cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
299cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
300cd7eab44SBen Hutchings 	unsigned long flags;
301cd7eab44SBen Hutchings 
302cd7eab44SBen Hutchings 	/* The release function is promised process context */
303cd7eab44SBen Hutchings 	might_sleep();
304cd7eab44SBen Hutchings 
305cd7eab44SBen Hutchings 	if (!desc)
306cd7eab44SBen Hutchings 		return -EINVAL;
307cd7eab44SBen Hutchings 
308cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
309cd7eab44SBen Hutchings 	if (notify) {
310cd7eab44SBen Hutchings 		notify->irq = irq;
311cd7eab44SBen Hutchings 		kref_init(&notify->kref);
312cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
313cd7eab44SBen Hutchings 	}
314cd7eab44SBen Hutchings 
315cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
316cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
317cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
318cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
319cd7eab44SBen Hutchings 
320cd7eab44SBen Hutchings 	if (old_notify)
321cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
322cd7eab44SBen Hutchings 
323cd7eab44SBen Hutchings 	return 0;
324cd7eab44SBen Hutchings }
325cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
326cd7eab44SBen Hutchings 
32718404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
32818404756SMax Krasnyansky /*
32918404756SMax Krasnyansky  * Generic version of the affinity autoselector.
33018404756SMax Krasnyansky  */
3313b8249e7SThomas Gleixner static int
3323b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
33318404756SMax Krasnyansky {
334569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
335818b0f3bSJiang Liu 	int node = desc->irq_data.node;
336569bda8dSThomas Gleixner 
337b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
33818404756SMax Krasnyansky 	if (!irq_can_set_affinity(irq))
33918404756SMax Krasnyansky 		return 0;
34018404756SMax Krasnyansky 
341f6d87f4bSThomas Gleixner 	/*
342f6d87f4bSThomas Gleixner 	 * Preserve an userspace affinity setup, but make sure that
343f6d87f4bSThomas Gleixner 	 * one of the targets is online.
344f6d87f4bSThomas Gleixner 	 */
3452bdd1055SThomas Gleixner 	if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
346569bda8dSThomas Gleixner 		if (cpumask_intersects(desc->irq_data.affinity,
347569bda8dSThomas Gleixner 				       cpu_online_mask))
348569bda8dSThomas Gleixner 			set = desc->irq_data.affinity;
3490c6f8a8bSThomas Gleixner 		else
3502bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3512bdd1055SThomas Gleixner 	}
35218404756SMax Krasnyansky 
3533b8249e7SThomas Gleixner 	cpumask_and(mask, cpu_online_mask, set);
354241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
355241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
356241fc640SPrarit Bhargava 
357241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
358241fc640SPrarit Bhargava 		if (cpumask_intersects(mask, nodemask))
359241fc640SPrarit Bhargava 			cpumask_and(mask, mask, nodemask);
360241fc640SPrarit Bhargava 	}
361818b0f3bSJiang Liu 	irq_do_set_affinity(&desc->irq_data, mask, false);
36218404756SMax Krasnyansky 	return 0;
36318404756SMax Krasnyansky }
364f6d87f4bSThomas Gleixner #else
3653b8249e7SThomas Gleixner static inline int
3663b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask)
367f6d87f4bSThomas Gleixner {
368f6d87f4bSThomas Gleixner 	return irq_select_affinity(irq);
369f6d87f4bSThomas Gleixner }
37018404756SMax Krasnyansky #endif
37118404756SMax Krasnyansky 
372f6d87f4bSThomas Gleixner /*
373f6d87f4bSThomas Gleixner  * Called when affinity is set via /proc/irq
374f6d87f4bSThomas Gleixner  */
3753b8249e7SThomas Gleixner int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
376f6d87f4bSThomas Gleixner {
377f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
378f6d87f4bSThomas Gleixner 	unsigned long flags;
379f6d87f4bSThomas Gleixner 	int ret;
380f6d87f4bSThomas Gleixner 
381239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
3823b8249e7SThomas Gleixner 	ret = setup_affinity(irq, desc, mask);
383239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
384f6d87f4bSThomas Gleixner 	return ret;
385f6d87f4bSThomas Gleixner }
386f6d87f4bSThomas Gleixner 
387f6d87f4bSThomas Gleixner #else
3883b8249e7SThomas Gleixner static inline int
3893b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask)
390f6d87f4bSThomas Gleixner {
391f6d87f4bSThomas Gleixner 	return 0;
392f6d87f4bSThomas Gleixner }
3931da177e4SLinus Torvalds #endif
3941da177e4SLinus Torvalds 
3958df2e02cSThomas Gleixner void __disable_irq(struct irq_desc *desc, unsigned int irq)
3960a0c5168SRafael J. Wysocki {
3973aae994fSThomas Gleixner 	if (!desc->depth++)
39887923470SThomas Gleixner 		irq_disable(desc);
3990a0c5168SRafael J. Wysocki }
4000a0c5168SRafael J. Wysocki 
40102725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
40202725e74SThomas Gleixner {
40302725e74SThomas Gleixner 	unsigned long flags;
40431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
40502725e74SThomas Gleixner 
40602725e74SThomas Gleixner 	if (!desc)
40702725e74SThomas Gleixner 		return -EINVAL;
4088df2e02cSThomas Gleixner 	__disable_irq(desc, irq);
40902725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
41002725e74SThomas Gleixner 	return 0;
41102725e74SThomas Gleixner }
41202725e74SThomas Gleixner 
4131da177e4SLinus Torvalds /**
4141da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4151da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4161da177e4SLinus Torvalds  *
4171da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4181da177e4SLinus Torvalds  *	nested.
4191da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
4201da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
4211da177e4SLinus Torvalds  *
4221da177e4SLinus Torvalds  *	This function may be called from IRQ context.
4231da177e4SLinus Torvalds  */
4241da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
4251da177e4SLinus Torvalds {
42602725e74SThomas Gleixner 	__disable_irq_nosync(irq);
4271da177e4SLinus Torvalds }
4281da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds /**
4311da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
4321da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4331da177e4SLinus Torvalds  *
4341da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
4351da177e4SLinus Torvalds  *	nested.
4361da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
4371da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
4381da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
4391da177e4SLinus Torvalds  *
4401da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
4411da177e4SLinus Torvalds  */
4421da177e4SLinus Torvalds void disable_irq(unsigned int irq)
4431da177e4SLinus Torvalds {
44402725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
4451da177e4SLinus Torvalds 		synchronize_irq(irq);
4461da177e4SLinus Torvalds }
4471da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
4481da177e4SLinus Torvalds 
44902cea395SPeter Zijlstra /**
45002cea395SPeter Zijlstra  *	disable_hardirq - disables an irq and waits for hardirq completion
45102cea395SPeter Zijlstra  *	@irq: Interrupt to disable
45202cea395SPeter Zijlstra  *
45302cea395SPeter Zijlstra  *	Disable the selected interrupt line.  Enables and Disables are
45402cea395SPeter Zijlstra  *	nested.
45502cea395SPeter Zijlstra  *	This function waits for any pending hard IRQ handlers for this
45602cea395SPeter Zijlstra  *	interrupt to complete before returning. If you use this function while
45702cea395SPeter Zijlstra  *	holding a resource the hard IRQ handler may need you will deadlock.
45802cea395SPeter Zijlstra  *
45902cea395SPeter Zijlstra  *	When used to optimistically disable an interrupt from atomic context
46002cea395SPeter Zijlstra  *	the return value must be checked.
46102cea395SPeter Zijlstra  *
46202cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
46302cea395SPeter Zijlstra  *
46402cea395SPeter Zijlstra  *	This function may be called - with care - from IRQ context.
46502cea395SPeter Zijlstra  */
46602cea395SPeter Zijlstra bool disable_hardirq(unsigned int irq)
46702cea395SPeter Zijlstra {
46802cea395SPeter Zijlstra 	if (!__disable_irq_nosync(irq))
46902cea395SPeter Zijlstra 		return synchronize_hardirq(irq);
47002cea395SPeter Zijlstra 
47102cea395SPeter Zijlstra 	return false;
47202cea395SPeter Zijlstra }
47302cea395SPeter Zijlstra EXPORT_SYMBOL_GPL(disable_hardirq);
47402cea395SPeter Zijlstra 
4758df2e02cSThomas Gleixner void __enable_irq(struct irq_desc *desc, unsigned int irq)
4761adb0850SThomas Gleixner {
4771adb0850SThomas Gleixner 	switch (desc->depth) {
4781adb0850SThomas Gleixner 	case 0:
4790a0c5168SRafael J. Wysocki  err_out:
480b8c512f6SArjan van de Ven 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
4811adb0850SThomas Gleixner 		break;
4821adb0850SThomas Gleixner 	case 1: {
483c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
4840a0c5168SRafael J. Wysocki 			goto err_out;
4851adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
4861ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
4873aae994fSThomas Gleixner 		irq_enable(desc);
4881adb0850SThomas Gleixner 		check_irq_resend(desc, irq);
4891adb0850SThomas Gleixner 		/* fall-through */
4901adb0850SThomas Gleixner 	}
4911adb0850SThomas Gleixner 	default:
4921adb0850SThomas Gleixner 		desc->depth--;
4931adb0850SThomas Gleixner 	}
4941adb0850SThomas Gleixner }
4951adb0850SThomas Gleixner 
4961da177e4SLinus Torvalds /**
4971da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
4981da177e4SLinus Torvalds  *	@irq: Interrupt to enable
4991da177e4SLinus Torvalds  *
5001da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
5011da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
5021da177e4SLinus Torvalds  *	IRQ line is re-enabled.
5031da177e4SLinus Torvalds  *
50470aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
5056b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
5061da177e4SLinus Torvalds  */
5071da177e4SLinus Torvalds void enable_irq(unsigned int irq)
5081da177e4SLinus Torvalds {
5091da177e4SLinus Torvalds 	unsigned long flags;
51031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5111da177e4SLinus Torvalds 
5127d94f7caSYinghai Lu 	if (!desc)
513c2b5a251SMatthew Wilcox 		return;
51450f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
5152656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
51602725e74SThomas Gleixner 		goto out;
5172656c366SThomas Gleixner 
5188df2e02cSThomas Gleixner 	__enable_irq(desc, irq);
51902725e74SThomas Gleixner out:
52002725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
5211da177e4SLinus Torvalds }
5221da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
5231da177e4SLinus Torvalds 
5240c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
5252db87321SUwe Kleine-König {
52608678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
5272db87321SUwe Kleine-König 	int ret = -ENXIO;
5282db87321SUwe Kleine-König 
52960f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
53060f96b41SSantosh Shilimkar 		return 0;
53160f96b41SSantosh Shilimkar 
5322f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
5332f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
5342db87321SUwe Kleine-König 
5352db87321SUwe Kleine-König 	return ret;
5362db87321SUwe Kleine-König }
5372db87321SUwe Kleine-König 
538ba9a2331SThomas Gleixner /**
539a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
540ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
541ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
542ba9a2331SThomas Gleixner  *
54315a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
54415a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
54515a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
54615a647ebSDavid Brownell  *
54715a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
54815a647ebSDavid Brownell  *	states like "suspend to RAM".
549ba9a2331SThomas Gleixner  */
550a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
551ba9a2331SThomas Gleixner {
552ba9a2331SThomas Gleixner 	unsigned long flags;
55331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5542db87321SUwe Kleine-König 	int ret = 0;
555ba9a2331SThomas Gleixner 
55613863a66SJesper Juhl 	if (!desc)
55713863a66SJesper Juhl 		return -EINVAL;
55813863a66SJesper Juhl 
55915a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
56015a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
56115a647ebSDavid Brownell 	 */
56215a647ebSDavid Brownell 	if (on) {
5632db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
5642db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5652db87321SUwe Kleine-König 			if (ret)
5662db87321SUwe Kleine-König 				desc->wake_depth = 0;
56715a647ebSDavid Brownell 			else
5687f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
5692db87321SUwe Kleine-König 		}
57015a647ebSDavid Brownell 	} else {
57115a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
5727a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
5732db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
5742db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5752db87321SUwe Kleine-König 			if (ret)
5762db87321SUwe Kleine-König 				desc->wake_depth = 1;
57715a647ebSDavid Brownell 			else
5787f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
57915a647ebSDavid Brownell 		}
5802db87321SUwe Kleine-König 	}
58102725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
582ba9a2331SThomas Gleixner 	return ret;
583ba9a2331SThomas Gleixner }
584a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
585ba9a2331SThomas Gleixner 
5861da177e4SLinus Torvalds /*
5871da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
5881da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
5891da177e4SLinus Torvalds  * for driver use.
5901da177e4SLinus Torvalds  */
5911da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
5921da177e4SLinus Torvalds {
593cc8c3b78SThomas Gleixner 	unsigned long flags;
59431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
59502725e74SThomas Gleixner 	int canrequest = 0;
5961da177e4SLinus Torvalds 
5977d94f7caSYinghai Lu 	if (!desc)
5987d94f7caSYinghai Lu 		return 0;
5997d94f7caSYinghai Lu 
60002725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
6012779db8dSBen Hutchings 		if (!desc->action ||
6022779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
60302725e74SThomas Gleixner 			canrequest = 1;
60402725e74SThomas Gleixner 	}
60502725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
60602725e74SThomas Gleixner 	return canrequest;
6071da177e4SLinus Torvalds }
6081da177e4SLinus Torvalds 
6090c5d1eb7SDavid Brownell int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
61082736f4dSUwe Kleine-König 		      unsigned long flags)
61182736f4dSUwe Kleine-König {
6126b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
613d4d5e089SThomas Gleixner 	int ret, unmask = 0;
61482736f4dSUwe Kleine-König 
615b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
61682736f4dSUwe Kleine-König 		/*
61782736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
61882736f4dSUwe Kleine-König 		 * flow-types?
61982736f4dSUwe Kleine-König 		 */
62097fd75b7SAndrew Morton 		pr_debug("No set_type function for IRQ %d (%s)\n", irq,
62182736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
62282736f4dSUwe Kleine-König 		return 0;
62382736f4dSUwe Kleine-König 	}
62482736f4dSUwe Kleine-König 
625876dbd4cSThomas Gleixner 	flags &= IRQ_TYPE_SENSE_MASK;
626d4d5e089SThomas Gleixner 
627d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
62832f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
629d4d5e089SThomas Gleixner 			mask_irq(desc);
63032f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
631d4d5e089SThomas Gleixner 			unmask = 1;
632d4d5e089SThomas Gleixner 	}
633d4d5e089SThomas Gleixner 
634f2b662daSDavid Brownell 	/* caller masked out all except trigger mode flags */
635b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
63682736f4dSUwe Kleine-König 
637876dbd4cSThomas Gleixner 	switch (ret) {
638876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
6392cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
640876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
641876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
642876dbd4cSThomas Gleixner 
643876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
644876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
645876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
646876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
647876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
648876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
649876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
650876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
651876dbd4cSThomas Gleixner 		}
65246732475SThomas Gleixner 
653d4d5e089SThomas Gleixner 		ret = 0;
6548fff39e0SThomas Gleixner 		break;
655876dbd4cSThomas Gleixner 	default:
65697fd75b7SAndrew Morton 		pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
657876dbd4cSThomas Gleixner 		       flags, irq, chip->irq_set_type);
6580c5d1eb7SDavid Brownell 	}
659d4d5e089SThomas Gleixner 	if (unmask)
660d4d5e089SThomas Gleixner 		unmask_irq(desc);
66182736f4dSUwe Kleine-König 	return ret;
66282736f4dSUwe Kleine-König }
66382736f4dSUwe Kleine-König 
664293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
665293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
666293a7a0aSThomas Gleixner {
667293a7a0aSThomas Gleixner 	unsigned long flags;
668293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
669293a7a0aSThomas Gleixner 
670293a7a0aSThomas Gleixner 	if (!desc)
671293a7a0aSThomas Gleixner 		return -EINVAL;
672293a7a0aSThomas Gleixner 
673293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
674293a7a0aSThomas Gleixner 
675293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
676293a7a0aSThomas Gleixner 	return 0;
677293a7a0aSThomas Gleixner }
678293a7a0aSThomas Gleixner #endif
679293a7a0aSThomas Gleixner 
680b25c340cSThomas Gleixner /*
681b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
682b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
683b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
684b25c340cSThomas Gleixner  */
685b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
686b25c340cSThomas Gleixner {
687b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
688b25c340cSThomas Gleixner }
689b25c340cSThomas Gleixner 
690399b5da2SThomas Gleixner /*
691399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
692399b5da2SThomas Gleixner  * called.
693399b5da2SThomas Gleixner  */
694399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
695399b5da2SThomas Gleixner {
696399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
697399b5da2SThomas Gleixner 	return IRQ_NONE;
698399b5da2SThomas Gleixner }
699399b5da2SThomas Gleixner 
7003aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
7013aa551c9SThomas Gleixner {
7023aa551c9SThomas Gleixner 	set_current_state(TASK_INTERRUPTIBLE);
703f48fe81eSThomas Gleixner 
704550acb19SIdo Yariv 	while (!kthread_should_stop()) {
705550acb19SIdo Yariv 
706f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
707f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
7083aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
7093aa551c9SThomas Gleixner 			return 0;
710f48fe81eSThomas Gleixner 		}
7113aa551c9SThomas Gleixner 		schedule();
712550acb19SIdo Yariv 		set_current_state(TASK_INTERRUPTIBLE);
7133aa551c9SThomas Gleixner 	}
714550acb19SIdo Yariv 	__set_current_state(TASK_RUNNING);
7153aa551c9SThomas Gleixner 	return -1;
7163aa551c9SThomas Gleixner }
7173aa551c9SThomas Gleixner 
718b25c340cSThomas Gleixner /*
719b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
720b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
721b25c340cSThomas Gleixner  * is marked MASKED.
722b25c340cSThomas Gleixner  */
723b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
724f3f79e38SAlexander Gordeev 				 struct irqaction *action)
725b25c340cSThomas Gleixner {
726b5faba21SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT))
727b5faba21SThomas Gleixner 		return;
7280b1adaa0SThomas Gleixner again:
7293876ec9eSThomas Gleixner 	chip_bus_lock(desc);
730239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
7310b1adaa0SThomas Gleixner 
7320b1adaa0SThomas Gleixner 	/*
7330b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
7340b1adaa0SThomas Gleixner 	 * the following scenario:
7350b1adaa0SThomas Gleixner 	 *
7360b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
7370b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
7380b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
739009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
740b5faba21SThomas Gleixner 	 *
741b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
742b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
743b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
744b5faba21SThomas Gleixner 	 * serialization.
7450b1adaa0SThomas Gleixner 	 */
74632f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
7470b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
7483876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
7490b1adaa0SThomas Gleixner 		cpu_relax();
7500b1adaa0SThomas Gleixner 		goto again;
7510b1adaa0SThomas Gleixner 	}
7520b1adaa0SThomas Gleixner 
753b5faba21SThomas Gleixner 	/*
754b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
755b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
756b5faba21SThomas Gleixner 	 * was just set.
757b5faba21SThomas Gleixner 	 */
758f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
759b5faba21SThomas Gleixner 		goto out_unlock;
760b5faba21SThomas Gleixner 
761b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
762b5faba21SThomas Gleixner 
76332f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
76432f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
765328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
76632f4125eSThomas Gleixner 
767b5faba21SThomas Gleixner out_unlock:
768239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
7693876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
770b25c340cSThomas Gleixner }
771b25c340cSThomas Gleixner 
77261f38261SBruno Premont #ifdef CONFIG_SMP
7733aa551c9SThomas Gleixner /*
774b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
775591d2fb0SThomas Gleixner  */
776591d2fb0SThomas Gleixner static void
777591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
778591d2fb0SThomas Gleixner {
779591d2fb0SThomas Gleixner 	cpumask_var_t mask;
78004aa530eSThomas Gleixner 	bool valid = true;
781591d2fb0SThomas Gleixner 
782591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
783591d2fb0SThomas Gleixner 		return;
784591d2fb0SThomas Gleixner 
785591d2fb0SThomas Gleixner 	/*
786591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
787591d2fb0SThomas Gleixner 	 * try again next time
788591d2fb0SThomas Gleixner 	 */
789591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
790591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
791591d2fb0SThomas Gleixner 		return;
792591d2fb0SThomas Gleixner 	}
793591d2fb0SThomas Gleixner 
794239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
79504aa530eSThomas Gleixner 	/*
79604aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
79704aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
79804aa530eSThomas Gleixner 	 */
79904aa530eSThomas Gleixner 	if (desc->irq_data.affinity)
8006b8ff312SThomas Gleixner 		cpumask_copy(mask, desc->irq_data.affinity);
80104aa530eSThomas Gleixner 	else
80204aa530eSThomas Gleixner 		valid = false;
803239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
804591d2fb0SThomas Gleixner 
80504aa530eSThomas Gleixner 	if (valid)
806591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
807591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
808591d2fb0SThomas Gleixner }
80961f38261SBruno Premont #else
81061f38261SBruno Premont static inline void
81161f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
81261f38261SBruno Premont #endif
813591d2fb0SThomas Gleixner 
814591d2fb0SThomas Gleixner /*
8158d32a307SThomas Gleixner  * Interrupts which are not explicitely requested as threaded
8168d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
8178d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
8188d32a307SThomas Gleixner  * side effects.
8198d32a307SThomas Gleixner  */
8203a43e05fSSebastian Andrzej Siewior static irqreturn_t
8218d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
8228d32a307SThomas Gleixner {
8233a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8243a43e05fSSebastian Andrzej Siewior 
8258d32a307SThomas Gleixner 	local_bh_disable();
8263a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
827f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8288d32a307SThomas Gleixner 	local_bh_enable();
8293a43e05fSSebastian Andrzej Siewior 	return ret;
8308d32a307SThomas Gleixner }
8318d32a307SThomas Gleixner 
8328d32a307SThomas Gleixner /*
833f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
8348d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
8358d32a307SThomas Gleixner  * complete.
8368d32a307SThomas Gleixner  */
8373a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
8383a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
8398d32a307SThomas Gleixner {
8403a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8413a43e05fSSebastian Andrzej Siewior 
8423a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
843f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8443a43e05fSSebastian Andrzej Siewior 	return ret;
8458d32a307SThomas Gleixner }
8468d32a307SThomas Gleixner 
8477140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
8487140ea19SIdo Yariv {
849c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
8507140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
8517140ea19SIdo Yariv }
8527140ea19SIdo Yariv 
85367d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
8544d1d61a6SOleg Nesterov {
8554d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
8564d1d61a6SOleg Nesterov 	struct irq_desc *desc;
8574d1d61a6SOleg Nesterov 	struct irqaction *action;
8584d1d61a6SOleg Nesterov 
8594d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
8604d1d61a6SOleg Nesterov 		return;
8614d1d61a6SOleg Nesterov 
8624d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
8634d1d61a6SOleg Nesterov 
864fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
86519af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
8664d1d61a6SOleg Nesterov 
8674d1d61a6SOleg Nesterov 
8684d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
8694d1d61a6SOleg Nesterov 	/*
8704d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
8714d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
8724d1d61a6SOleg Nesterov 	 */
8734d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
8744d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
8754d1d61a6SOleg Nesterov 
8764d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
8774d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
8784d1d61a6SOleg Nesterov }
8794d1d61a6SOleg Nesterov 
8808d32a307SThomas Gleixner /*
8813aa551c9SThomas Gleixner  * Interrupt handler thread
8823aa551c9SThomas Gleixner  */
8833aa551c9SThomas Gleixner static int irq_thread(void *data)
8843aa551c9SThomas Gleixner {
88567d12145SAl Viro 	struct callback_head on_exit_work;
8863aa551c9SThomas Gleixner 	struct irqaction *action = data;
8873aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
8883a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
8893a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
8903aa551c9SThomas Gleixner 
891540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
8928d32a307SThomas Gleixner 					&action->thread_flags))
8938d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
8948d32a307SThomas Gleixner 	else
8958d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
8968d32a307SThomas Gleixner 
89741f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
8984d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
8993aa551c9SThomas Gleixner 
900f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
901f3de44edSSankara Muthukrishnan 
9023aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
9037140ea19SIdo Yariv 		irqreturn_t action_ret;
9043aa551c9SThomas Gleixner 
905591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
906591d2fb0SThomas Gleixner 
9073a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
9081e77d0a1SThomas Gleixner 		if (action_ret == IRQ_HANDLED)
9091e77d0a1SThomas Gleixner 			atomic_inc(&desc->threads_handled);
9107140ea19SIdo Yariv 
9117140ea19SIdo Yariv 		wake_threads_waitq(desc);
9123aa551c9SThomas Gleixner 	}
9133aa551c9SThomas Gleixner 
9147140ea19SIdo Yariv 	/*
9157140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
9167140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
9177140ea19SIdo Yariv 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
918e04268b0SThomas Gleixner 	 * oneshot mask bit can be set. We cannot verify that as we
919e04268b0SThomas Gleixner 	 * cannot touch the oneshot mask at this point anymore as
920e04268b0SThomas Gleixner 	 * __setup_irq() might have given out currents thread_mask
921e04268b0SThomas Gleixner 	 * again.
9223aa551c9SThomas Gleixner 	 */
9234d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
9243aa551c9SThomas Gleixner 	return 0;
9253aa551c9SThomas Gleixner }
9263aa551c9SThomas Gleixner 
927a92444c6SThomas Gleixner /**
928a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
929a92444c6SThomas Gleixner  *	@irq:		Interrupt line
930a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
931a92444c6SThomas Gleixner  *
932a92444c6SThomas Gleixner  */
933a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
934a92444c6SThomas Gleixner {
935a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
936a92444c6SThomas Gleixner 	struct irqaction *action;
937a92444c6SThomas Gleixner 	unsigned long flags;
938a92444c6SThomas Gleixner 
939a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
940a92444c6SThomas Gleixner 		return;
941a92444c6SThomas Gleixner 
942a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
943a92444c6SThomas Gleixner 	for (action = desc->action; action; action = action->next) {
944a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
945a92444c6SThomas Gleixner 			if (action->thread)
946a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
947a92444c6SThomas Gleixner 			break;
948a92444c6SThomas Gleixner 		}
949a92444c6SThomas Gleixner 	}
950a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
951a92444c6SThomas Gleixner }
952a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
953a92444c6SThomas Gleixner 
9548d32a307SThomas Gleixner static void irq_setup_forced_threading(struct irqaction *new)
9558d32a307SThomas Gleixner {
9568d32a307SThomas Gleixner 	if (!force_irqthreads)
9578d32a307SThomas Gleixner 		return;
9588d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
9598d32a307SThomas Gleixner 		return;
9608d32a307SThomas Gleixner 
9618d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
9628d32a307SThomas Gleixner 
9638d32a307SThomas Gleixner 	if (!new->thread_fn) {
9648d32a307SThomas Gleixner 		set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
9658d32a307SThomas Gleixner 		new->thread_fn = new->handler;
9668d32a307SThomas Gleixner 		new->handler = irq_default_primary_handler;
9678d32a307SThomas Gleixner 	}
9688d32a307SThomas Gleixner }
9698d32a307SThomas Gleixner 
970c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
971c1bacbaeSThomas Gleixner {
972c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
973c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
974c1bacbaeSThomas Gleixner 
975c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
976c1bacbaeSThomas Gleixner }
977c1bacbaeSThomas Gleixner 
978c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
979c1bacbaeSThomas Gleixner {
980c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
981c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
982c1bacbaeSThomas Gleixner 
983c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
984c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
985c1bacbaeSThomas Gleixner }
986c1bacbaeSThomas Gleixner 
9871da177e4SLinus Torvalds /*
9881da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
9891da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
9901da177e4SLinus Torvalds  */
991d3c60047SThomas Gleixner static int
992d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
9931da177e4SLinus Torvalds {
994f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
995b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
9963b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
9973b8249e7SThomas Gleixner 	cpumask_var_t mask;
9981da177e4SLinus Torvalds 
9997d94f7caSYinghai Lu 	if (!desc)
1000c2b5a251SMatthew Wilcox 		return -EINVAL;
1001c2b5a251SMatthew Wilcox 
10026b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
10031da177e4SLinus Torvalds 		return -ENOSYS;
1004b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
1005b6873807SSebastian Andrzej Siewior 		return -ENODEV;
10061da177e4SLinus Torvalds 
10071da177e4SLinus Torvalds 	/*
1008399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
1009399b5da2SThomas Gleixner 	 * thread.
10103aa551c9SThomas Gleixner 	 */
10111ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
1012399b5da2SThomas Gleixner 	if (nested) {
1013b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
1014b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
1015b6873807SSebastian Andrzej Siewior 			goto out_mput;
1016b6873807SSebastian Andrzej Siewior 		}
1017399b5da2SThomas Gleixner 		/*
1018399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
1019399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
1020399b5da2SThomas Gleixner 		 * dummy function which warns when called.
1021399b5da2SThomas Gleixner 		 */
1022399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
10238d32a307SThomas Gleixner 	} else {
10247f1b1244SPaul Mundt 		if (irq_settings_can_thread(desc))
10258d32a307SThomas Gleixner 			irq_setup_forced_threading(new);
1026399b5da2SThomas Gleixner 	}
1027399b5da2SThomas Gleixner 
1028399b5da2SThomas Gleixner 	/*
1029399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
1030399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
1031399b5da2SThomas Gleixner 	 * thread.
1032399b5da2SThomas Gleixner 	 */
1033399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
10343aa551c9SThomas Gleixner 		struct task_struct *t;
1035ee238713SIvo Sieben 		static const struct sched_param param = {
1036ee238713SIvo Sieben 			.sched_priority = MAX_USER_RT_PRIO/2,
1037ee238713SIvo Sieben 		};
10383aa551c9SThomas Gleixner 
10393aa551c9SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
10403aa551c9SThomas Gleixner 				   new->name);
1041b6873807SSebastian Andrzej Siewior 		if (IS_ERR(t)) {
1042b6873807SSebastian Andrzej Siewior 			ret = PTR_ERR(t);
1043b6873807SSebastian Andrzej Siewior 			goto out_mput;
1044b6873807SSebastian Andrzej Siewior 		}
1045ee238713SIvo Sieben 
1046bbfe65c2SThomas Pfaff 		sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
1047ee238713SIvo Sieben 
10483aa551c9SThomas Gleixner 		/*
10493aa551c9SThomas Gleixner 		 * We keep the reference to the task struct even if
10503aa551c9SThomas Gleixner 		 * the thread dies to avoid that the interrupt code
10513aa551c9SThomas Gleixner 		 * references an already freed task_struct.
10523aa551c9SThomas Gleixner 		 */
10533aa551c9SThomas Gleixner 		get_task_struct(t);
10543aa551c9SThomas Gleixner 		new->thread = t;
105504aa530eSThomas Gleixner 		/*
105604aa530eSThomas Gleixner 		 * Tell the thread to set its affinity. This is
105704aa530eSThomas Gleixner 		 * important for shared interrupt handlers as we do
105804aa530eSThomas Gleixner 		 * not invoke setup_affinity() for the secondary
105904aa530eSThomas Gleixner 		 * handlers as everything is already set up. Even for
106004aa530eSThomas Gleixner 		 * interrupts marked with IRQF_NO_BALANCE this is
106104aa530eSThomas Gleixner 		 * correct as we want the thread to move to the cpu(s)
106204aa530eSThomas Gleixner 		 * on which the requesting code placed the interrupt.
106304aa530eSThomas Gleixner 		 */
106404aa530eSThomas Gleixner 		set_bit(IRQTF_AFFINITY, &new->thread_flags);
10653aa551c9SThomas Gleixner 	}
10663aa551c9SThomas Gleixner 
10673b8249e7SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
10683b8249e7SThomas Gleixner 		ret = -ENOMEM;
10693b8249e7SThomas Gleixner 		goto out_thread;
10703b8249e7SThomas Gleixner 	}
10713b8249e7SThomas Gleixner 
10723aa551c9SThomas Gleixner 	/*
1073dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1074dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1075dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1076dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1077dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1078dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1079dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1080dc9b229aSThomas Gleixner 	 */
1081dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1082dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1083dc9b229aSThomas Gleixner 
1084dc9b229aSThomas Gleixner 	/*
10851da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
10861da177e4SLinus Torvalds 	 */
1087239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1088f17c7545SIngo Molnar 	old_ptr = &desc->action;
1089f17c7545SIngo Molnar 	old = *old_ptr;
109006fcb0c6SIngo Molnar 	if (old) {
1091e76de9f8SThomas Gleixner 		/*
1092e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1093e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
10943cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
10959d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
10969d591eddSThomas Gleixner 		 * agree on ONESHOT.
1097e76de9f8SThomas Gleixner 		 */
10983cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
10999d591eddSThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
1100f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1101f5163427SDimitri Sivanich 			goto mismatch;
1102f5163427SDimitri Sivanich 
1103f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
11043cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
11053cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1106f5163427SDimitri Sivanich 			goto mismatch;
11071da177e4SLinus Torvalds 
11081da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
11091da177e4SLinus Torvalds 		do {
111052abb700SThomas Gleixner 			/*
111152abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
111252abb700SThomas Gleixner 			 * so we can find the next zero bit for this
111352abb700SThomas Gleixner 			 * new action.
111452abb700SThomas Gleixner 			 */
1115b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1116f17c7545SIngo Molnar 			old_ptr = &old->next;
1117f17c7545SIngo Molnar 			old = *old_ptr;
11181da177e4SLinus Torvalds 		} while (old);
11191da177e4SLinus Torvalds 		shared = 1;
11201da177e4SLinus Torvalds 	}
11211da177e4SLinus Torvalds 
1122b5faba21SThomas Gleixner 	/*
112352abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
112452abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
112552abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1126b5faba21SThomas Gleixner 	 */
112752abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
112852abb700SThomas Gleixner 		/*
112952abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
113052abb700SThomas Gleixner 		 * but who knows.
113152abb700SThomas Gleixner 		 */
113252abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1133b5faba21SThomas Gleixner 			ret = -EBUSY;
1134b5faba21SThomas Gleixner 			goto out_mask;
1135b5faba21SThomas Gleixner 		}
113652abb700SThomas Gleixner 		/*
113752abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
113852abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
113952abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
114052abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
114152abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
114252abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
114352abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
114452abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
114552abb700SThomas Gleixner 		 *
114652abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
114752abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
114852abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
114952abb700SThomas Gleixner 		 * affected hard irq flow handlers
115052abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
115152abb700SThomas Gleixner 		 *
115252abb700SThomas Gleixner 		 * The new action gets the first zero bit of
115352abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
115452abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
115552abb700SThomas Gleixner 		 */
1156b5faba21SThomas Gleixner 		new->thread_mask = 1 << ffz(thread_mask);
11571c6c6952SThomas Gleixner 
1158dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1159dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
11601c6c6952SThomas Gleixner 		/*
11611c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
11621c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
11631c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
11641c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
11651c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
11661c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
11671c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
11681c6c6952SThomas Gleixner 		 *
11691c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
11701c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
11711c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
11721c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
11731c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
11741c6c6952SThomas Gleixner 		 */
117597fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
11761c6c6952SThomas Gleixner 		       irq);
11771c6c6952SThomas Gleixner 		ret = -EINVAL;
11781c6c6952SThomas Gleixner 		goto out_mask;
117952abb700SThomas Gleixner 	}
1180b5faba21SThomas Gleixner 
11811da177e4SLinus Torvalds 	if (!shared) {
1182c1bacbaeSThomas Gleixner 		ret = irq_request_resources(desc);
1183c1bacbaeSThomas Gleixner 		if (ret) {
1184c1bacbaeSThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
1185c1bacbaeSThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
1186c1bacbaeSThomas Gleixner 			goto out_mask;
1187c1bacbaeSThomas Gleixner 		}
1188c1bacbaeSThomas Gleixner 
11893aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
11903aa551c9SThomas Gleixner 
119182736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
119282736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1193f2b662daSDavid Brownell 			ret = __irq_set_trigger(desc, irq,
1194f2b662daSDavid Brownell 					new->flags & IRQF_TRIGGER_MASK);
119582736f4dSUwe Kleine-König 
11963aa551c9SThomas Gleixner 			if (ret)
11973b8249e7SThomas Gleixner 				goto out_mask;
1198091738a2SThomas Gleixner 		}
1199f75d222bSAhmed S. Darwish 
1200009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
120132f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
120232f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
120394d39e1fSThomas Gleixner 
1204a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1205a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1206a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1207a005677bSThomas Gleixner 		}
12086a58fb3bSThomas Gleixner 
1209b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
12103d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1211b25c340cSThomas Gleixner 
12121ccb4e61SThomas Gleixner 		if (irq_settings_can_autoenable(desc))
1213b4bc724eSThomas Gleixner 			irq_startup(desc, true);
121446999238SThomas Gleixner 		else
1215e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1216e76de9f8SThomas Gleixner 			desc->depth = 1;
121718404756SMax Krasnyansky 
1218612e3684SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
1219a005677bSThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
1220a005677bSThomas Gleixner 			irq_settings_set_no_balancing(desc);
1221a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1222a005677bSThomas Gleixner 		}
1223612e3684SThomas Gleixner 
122418404756SMax Krasnyansky 		/* Set default affinity mask once everything is setup */
12253b8249e7SThomas Gleixner 		setup_affinity(irq, desc, mask);
12260c5d1eb7SDavid Brownell 
1227876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1228876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
1229876dbd4cSThomas Gleixner 		unsigned int omsk = irq_settings_get_trigger_mask(desc);
1230876dbd4cSThomas Gleixner 
1231876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1232876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
123397fd75b7SAndrew Morton 			pr_warning("irq %d uses trigger mode %u; requested %u\n",
1234876dbd4cSThomas Gleixner 				   irq, nmsk, omsk);
123594d39e1fSThomas Gleixner 	}
123682736f4dSUwe Kleine-König 
123769ab8494SThomas Gleixner 	new->irq = irq;
1238f17c7545SIngo Molnar 	*old_ptr = new;
123982736f4dSUwe Kleine-König 
1240cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1241cab303beSThomas Gleixner 
12428528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
12438528b0f1SLinus Torvalds 	desc->irq_count = 0;
12448528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
12451adb0850SThomas Gleixner 
12461adb0850SThomas Gleixner 	/*
12471adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
12481adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
12491adb0850SThomas Gleixner 	 */
12507acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
12517acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
12528df2e02cSThomas Gleixner 		__enable_irq(desc, irq);
12531adb0850SThomas Gleixner 	}
12541adb0850SThomas Gleixner 
1255239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
12561da177e4SLinus Torvalds 
125769ab8494SThomas Gleixner 	/*
125869ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
125969ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
126069ab8494SThomas Gleixner 	 */
126169ab8494SThomas Gleixner 	if (new->thread)
126269ab8494SThomas Gleixner 		wake_up_process(new->thread);
126369ab8494SThomas Gleixner 
12642c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
12651da177e4SLinus Torvalds 	new->dir = NULL;
12661da177e4SLinus Torvalds 	register_handler_proc(irq, new);
12674f5058c3SXiaotian Feng 	free_cpumask_var(mask);
12681da177e4SLinus Torvalds 
12691da177e4SLinus Torvalds 	return 0;
1270f5163427SDimitri Sivanich 
1271f5163427SDimitri Sivanich mismatch:
12723cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
127397fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1274f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1275f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1276f5163427SDimitri Sivanich 		dump_stack();
12773f050447SAlan Cox #endif
1278f5d89470SThomas Gleixner 	}
12793aa551c9SThomas Gleixner 	ret = -EBUSY;
12803aa551c9SThomas Gleixner 
12813b8249e7SThomas Gleixner out_mask:
12821c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
12833b8249e7SThomas Gleixner 	free_cpumask_var(mask);
12843b8249e7SThomas Gleixner 
12853aa551c9SThomas Gleixner out_thread:
12863aa551c9SThomas Gleixner 	if (new->thread) {
12873aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
12883aa551c9SThomas Gleixner 
12893aa551c9SThomas Gleixner 		new->thread = NULL;
12903aa551c9SThomas Gleixner 		kthread_stop(t);
12913aa551c9SThomas Gleixner 		put_task_struct(t);
12923aa551c9SThomas Gleixner 	}
1293b6873807SSebastian Andrzej Siewior out_mput:
1294b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
12953aa551c9SThomas Gleixner 	return ret;
12961da177e4SLinus Torvalds }
12971da177e4SLinus Torvalds 
12981da177e4SLinus Torvalds /**
1299d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1300d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1301d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1302d3c60047SThomas Gleixner  *
1303d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1304d3c60047SThomas Gleixner  */
1305d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1306d3c60047SThomas Gleixner {
1307986c011dSDavid Daney 	int retval;
1308d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1309d3c60047SThomas Gleixner 
131031d9d9b6SMarc Zyngier 	if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
131131d9d9b6SMarc Zyngier 		return -EINVAL;
1312986c011dSDavid Daney 	chip_bus_lock(desc);
1313986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1314986c011dSDavid Daney 	chip_bus_sync_unlock(desc);
1315986c011dSDavid Daney 
1316986c011dSDavid Daney 	return retval;
1317d3c60047SThomas Gleixner }
1318eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1319d3c60047SThomas Gleixner 
1320cbf94f06SMagnus Damm /*
1321cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1322cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
13231da177e4SLinus Torvalds  */
1324cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
13251da177e4SLinus Torvalds {
1326d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1327f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
13281da177e4SLinus Torvalds 	unsigned long flags;
13291da177e4SLinus Torvalds 
1330ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
13317d94f7caSYinghai Lu 
13327d94f7caSYinghai Lu 	if (!desc)
1333f21cfb25SMagnus Damm 		return NULL;
13341da177e4SLinus Torvalds 
1335239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1336ae88a23bSIngo Molnar 
1337ae88a23bSIngo Molnar 	/*
1338ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1339ae88a23bSIngo Molnar 	 * one based on the dev_id:
1340ae88a23bSIngo Molnar 	 */
1341f17c7545SIngo Molnar 	action_ptr = &desc->action;
13421da177e4SLinus Torvalds 	for (;;) {
1343f17c7545SIngo Molnar 		action = *action_ptr;
13441da177e4SLinus Torvalds 
1345ae88a23bSIngo Molnar 		if (!action) {
1346ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1347239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1348ae88a23bSIngo Molnar 
1349f21cfb25SMagnus Damm 			return NULL;
1350ae88a23bSIngo Molnar 		}
13511da177e4SLinus Torvalds 
13528316e381SIngo Molnar 		if (action->dev_id == dev_id)
1353ae88a23bSIngo Molnar 			break;
1354f17c7545SIngo Molnar 		action_ptr = &action->next;
1355ae88a23bSIngo Molnar 	}
1356ae88a23bSIngo Molnar 
1357ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1358f17c7545SIngo Molnar 	*action_ptr = action->next;
1359dbce706eSPaolo 'Blaisorblade' Giarrusso 
1360cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1361cab303beSThomas Gleixner 
1362ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1363c1bacbaeSThomas Gleixner 	if (!desc->action) {
136446999238SThomas Gleixner 		irq_shutdown(desc);
1365c1bacbaeSThomas Gleixner 		irq_release_resources(desc);
1366c1bacbaeSThomas Gleixner 	}
13673aa551c9SThomas Gleixner 
1368e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1369e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1370e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1371e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1372e7a297b0SPeter P Waskiewicz Jr #endif
1373e7a297b0SPeter P Waskiewicz Jr 
1374239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1375ae88a23bSIngo Molnar 
13761da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
13771da177e4SLinus Torvalds 
1378ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
13791da177e4SLinus Torvalds 	synchronize_irq(irq);
1380ae88a23bSIngo Molnar 
13811d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
13821d99493bSDavid Woodhouse 	/*
1383ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1384ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1385ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1386ae88a23bSIngo Molnar 	 *
1387ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
1388ae88a23bSIngo Molnar 	 *   'real' IRQ doesn't run in * parallel with our fake. )
13891d99493bSDavid Woodhouse 	 */
13901d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
13911d99493bSDavid Woodhouse 		local_irq_save(flags);
13921d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
13931d99493bSDavid Woodhouse 		local_irq_restore(flags);
13941d99493bSDavid Woodhouse 	}
13951d99493bSDavid Woodhouse #endif
13962d860ad7SLinus Torvalds 
13972d860ad7SLinus Torvalds 	if (action->thread) {
13982d860ad7SLinus Torvalds 		kthread_stop(action->thread);
13992d860ad7SLinus Torvalds 		put_task_struct(action->thread);
14002d860ad7SLinus Torvalds 	}
14012d860ad7SLinus Torvalds 
1402b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
1403f21cfb25SMagnus Damm 	return action;
1404f21cfb25SMagnus Damm }
14051da177e4SLinus Torvalds 
14061da177e4SLinus Torvalds /**
1407cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1408cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1409cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1410cbf94f06SMagnus Damm  *
1411cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1412cbf94f06SMagnus Damm  */
1413cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1414cbf94f06SMagnus Damm {
141531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
141631d9d9b6SMarc Zyngier 
141731d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1418cbf94f06SMagnus Damm 	    __free_irq(irq, act->dev_id);
1419cbf94f06SMagnus Damm }
1420eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1421cbf94f06SMagnus Damm 
1422cbf94f06SMagnus Damm /**
1423f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
14241da177e4SLinus Torvalds  *	@irq: Interrupt line to free
14251da177e4SLinus Torvalds  *	@dev_id: Device identity to free
14261da177e4SLinus Torvalds  *
14271da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
14281da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
14291da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
14301da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
14311da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
14321da177e4SLinus Torvalds  *	have completed.
14331da177e4SLinus Torvalds  *
14341da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
14351da177e4SLinus Torvalds  */
14361da177e4SLinus Torvalds void free_irq(unsigned int irq, void *dev_id)
14371da177e4SLinus Torvalds {
143870aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
143970aedd24SThomas Gleixner 
144031d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
144170aedd24SThomas Gleixner 		return;
144270aedd24SThomas Gleixner 
1443cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1444cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1445cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1446cd7eab44SBen Hutchings #endif
1447cd7eab44SBen Hutchings 
14483876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1449cbf94f06SMagnus Damm 	kfree(__free_irq(irq, dev_id));
14503876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
14511da177e4SLinus Torvalds }
14521da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
14531da177e4SLinus Torvalds 
14541da177e4SLinus Torvalds /**
14553aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
14561da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
14573aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
14583aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1459b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1460b25c340cSThomas Gleixner  *		  primary handler is installed
14613aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
14623aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
14631da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
14641da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
14651da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
14661da177e4SLinus Torvalds  *
14671da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
14681da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
14691da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
14701da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
14711da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
14721da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
14731da177e4SLinus Torvalds  *
14743aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
14756d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
14763aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
14773aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
14783aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
147939a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
14803aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
14813aa551c9SThomas Gleixner  *	shared interrupts.
14823aa551c9SThomas Gleixner  *
14831da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
14841da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
14851da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
14861da177e4SLinus Torvalds  *
14871da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
14881da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
14891da177e4SLinus Torvalds  *
14901da177e4SLinus Torvalds  *	Flags:
14911da177e4SLinus Torvalds  *
14923cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
14930c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
14941da177e4SLinus Torvalds  *
14951da177e4SLinus Torvalds  */
14963aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
14973aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
14983aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
14991da177e4SLinus Torvalds {
15001da177e4SLinus Torvalds 	struct irqaction *action;
150108678b08SYinghai Lu 	struct irq_desc *desc;
1502d3c60047SThomas Gleixner 	int retval;
15031da177e4SLinus Torvalds 
1504470c6623SDavid Brownell 	/*
15051da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
15061da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
15071da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
15081da177e4SLinus Torvalds 	 * logic etc).
150917f48034SRafael J. Wysocki 	 *
151017f48034SRafael J. Wysocki 	 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and
151117f48034SRafael J. Wysocki 	 * it cannot be set along with IRQF_NO_SUSPEND.
15121da177e4SLinus Torvalds 	 */
151317f48034SRafael J. Wysocki 	if (((irqflags & IRQF_SHARED) && !dev_id) ||
151417f48034SRafael J. Wysocki 	    (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) ||
151517f48034SRafael J. Wysocki 	    ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND)))
15161da177e4SLinus Torvalds 		return -EINVAL;
15177d94f7caSYinghai Lu 
1518cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
15197d94f7caSYinghai Lu 	if (!desc)
15201da177e4SLinus Torvalds 		return -EINVAL;
15217d94f7caSYinghai Lu 
152231d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
152331d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
15246550c775SThomas Gleixner 		return -EINVAL;
1525b25c340cSThomas Gleixner 
1526b25c340cSThomas Gleixner 	if (!handler) {
1527b25c340cSThomas Gleixner 		if (!thread_fn)
15281da177e4SLinus Torvalds 			return -EINVAL;
1529b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1530b25c340cSThomas Gleixner 	}
15311da177e4SLinus Torvalds 
153245535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
15331da177e4SLinus Torvalds 	if (!action)
15341da177e4SLinus Torvalds 		return -ENOMEM;
15351da177e4SLinus Torvalds 
15361da177e4SLinus Torvalds 	action->handler = handler;
15373aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
15381da177e4SLinus Torvalds 	action->flags = irqflags;
15391da177e4SLinus Torvalds 	action->name = devname;
15401da177e4SLinus Torvalds 	action->dev_id = dev_id;
15411da177e4SLinus Torvalds 
15423876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1543d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
15443876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
154570aedd24SThomas Gleixner 
1546377bf1e4SAnton Vorontsov 	if (retval)
1547377bf1e4SAnton Vorontsov 		kfree(action);
1548377bf1e4SAnton Vorontsov 
15496d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
15506ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1551a304e1b8SDavid Woodhouse 		/*
1552a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
1553a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
1554377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1555377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
1556a304e1b8SDavid Woodhouse 		 */
1557a304e1b8SDavid Woodhouse 		unsigned long flags;
1558a304e1b8SDavid Woodhouse 
1559377bf1e4SAnton Vorontsov 		disable_irq(irq);
1560a304e1b8SDavid Woodhouse 		local_irq_save(flags);
1561377bf1e4SAnton Vorontsov 
1562a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
1563377bf1e4SAnton Vorontsov 
1564a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
1565377bf1e4SAnton Vorontsov 		enable_irq(irq);
1566a304e1b8SDavid Woodhouse 	}
1567a304e1b8SDavid Woodhouse #endif
15681da177e4SLinus Torvalds 	return retval;
15691da177e4SLinus Torvalds }
15703aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
1571ae731f8dSMarc Zyngier 
1572ae731f8dSMarc Zyngier /**
1573ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
1574ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
1575ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
1576ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
1577ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
1578ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
1579ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
1580ae731f8dSMarc Zyngier  *
1581ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
1582ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
1583ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
1584ae731f8dSMarc Zyngier  *	context.
1585ae731f8dSMarc Zyngier  *
1586ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
1587ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1588ae731f8dSMarc Zyngier  */
1589ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1590ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
1591ae731f8dSMarc Zyngier {
1592ae731f8dSMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
1593ae731f8dSMarc Zyngier 	int ret;
1594ae731f8dSMarc Zyngier 
1595ae731f8dSMarc Zyngier 	if (!desc)
1596ae731f8dSMarc Zyngier 		return -EINVAL;
1597ae731f8dSMarc Zyngier 
15981ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
1599ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
1600ae731f8dSMarc Zyngier 					   flags, name, dev_id);
1601ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
1602ae731f8dSMarc Zyngier 	}
1603ae731f8dSMarc Zyngier 
1604ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
1605ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
1606ae731f8dSMarc Zyngier }
1607ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
160831d9d9b6SMarc Zyngier 
16091e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
161031d9d9b6SMarc Zyngier {
161131d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
161231d9d9b6SMarc Zyngier 	unsigned long flags;
161331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
161431d9d9b6SMarc Zyngier 
161531d9d9b6SMarc Zyngier 	if (!desc)
161631d9d9b6SMarc Zyngier 		return;
161731d9d9b6SMarc Zyngier 
16181e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
16191e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
16201e7c5fd2SMarc Zyngier 		int ret;
16211e7c5fd2SMarc Zyngier 
16221e7c5fd2SMarc Zyngier 		ret = __irq_set_trigger(desc, irq, type);
16231e7c5fd2SMarc Zyngier 
16241e7c5fd2SMarc Zyngier 		if (ret) {
162532cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
16261e7c5fd2SMarc Zyngier 			goto out;
16271e7c5fd2SMarc Zyngier 		}
16281e7c5fd2SMarc Zyngier 	}
16291e7c5fd2SMarc Zyngier 
163031d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
16311e7c5fd2SMarc Zyngier out:
163231d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
163331d9d9b6SMarc Zyngier }
163436a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
163531d9d9b6SMarc Zyngier 
163631d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
163731d9d9b6SMarc Zyngier {
163831d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
163931d9d9b6SMarc Zyngier 	unsigned long flags;
164031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
164131d9d9b6SMarc Zyngier 
164231d9d9b6SMarc Zyngier 	if (!desc)
164331d9d9b6SMarc Zyngier 		return;
164431d9d9b6SMarc Zyngier 
164531d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
164631d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
164731d9d9b6SMarc Zyngier }
164836a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
164931d9d9b6SMarc Zyngier 
165031d9d9b6SMarc Zyngier /*
165131d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
165231d9d9b6SMarc Zyngier  */
165331d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
165431d9d9b6SMarc Zyngier {
165531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
165631d9d9b6SMarc Zyngier 	struct irqaction *action;
165731d9d9b6SMarc Zyngier 	unsigned long flags;
165831d9d9b6SMarc Zyngier 
165931d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
166031d9d9b6SMarc Zyngier 
166131d9d9b6SMarc Zyngier 	if (!desc)
166231d9d9b6SMarc Zyngier 		return NULL;
166331d9d9b6SMarc Zyngier 
166431d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
166531d9d9b6SMarc Zyngier 
166631d9d9b6SMarc Zyngier 	action = desc->action;
166731d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
166831d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
166931d9d9b6SMarc Zyngier 		goto bad;
167031d9d9b6SMarc Zyngier 	}
167131d9d9b6SMarc Zyngier 
167231d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
167331d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
167431d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
167531d9d9b6SMarc Zyngier 		goto bad;
167631d9d9b6SMarc Zyngier 	}
167731d9d9b6SMarc Zyngier 
167831d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
167931d9d9b6SMarc Zyngier 	desc->action = NULL;
168031d9d9b6SMarc Zyngier 
168131d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
168231d9d9b6SMarc Zyngier 
168331d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
168431d9d9b6SMarc Zyngier 
168531d9d9b6SMarc Zyngier 	module_put(desc->owner);
168631d9d9b6SMarc Zyngier 	return action;
168731d9d9b6SMarc Zyngier 
168831d9d9b6SMarc Zyngier bad:
168931d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
169031d9d9b6SMarc Zyngier 	return NULL;
169131d9d9b6SMarc Zyngier }
169231d9d9b6SMarc Zyngier 
169331d9d9b6SMarc Zyngier /**
169431d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
169531d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
169631d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
169731d9d9b6SMarc Zyngier  *
169831d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
169931d9d9b6SMarc Zyngier  */
170031d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
170131d9d9b6SMarc Zyngier {
170231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
170331d9d9b6SMarc Zyngier 
170431d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
170531d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
170631d9d9b6SMarc Zyngier }
170731d9d9b6SMarc Zyngier 
170831d9d9b6SMarc Zyngier /**
170931d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
171031d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
171131d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
171231d9d9b6SMarc Zyngier  *
171331d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
171431d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
171531d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
171631d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
171731d9d9b6SMarc Zyngier  *
171831d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
171931d9d9b6SMarc Zyngier  */
172031d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
172131d9d9b6SMarc Zyngier {
172231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
172331d9d9b6SMarc Zyngier 
172431d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
172531d9d9b6SMarc Zyngier 		return;
172631d9d9b6SMarc Zyngier 
172731d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
172831d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
172931d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
173031d9d9b6SMarc Zyngier }
173131d9d9b6SMarc Zyngier 
173231d9d9b6SMarc Zyngier /**
173331d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
173431d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
173531d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
173631d9d9b6SMarc Zyngier  *
173731d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
173831d9d9b6SMarc Zyngier  */
173931d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
174031d9d9b6SMarc Zyngier {
174131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
174231d9d9b6SMarc Zyngier 	int retval;
174331d9d9b6SMarc Zyngier 
174431d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
174531d9d9b6SMarc Zyngier 		return -EINVAL;
174631d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
174731d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
174831d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
174931d9d9b6SMarc Zyngier 
175031d9d9b6SMarc Zyngier 	return retval;
175131d9d9b6SMarc Zyngier }
175231d9d9b6SMarc Zyngier 
175331d9d9b6SMarc Zyngier /**
175431d9d9b6SMarc Zyngier  *	request_percpu_irq - allocate a percpu interrupt line
175531d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
175631d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
175731d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
175831d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
175931d9d9b6SMarc Zyngier  *
176031d9d9b6SMarc Zyngier  *	This call allocates interrupt resources, but doesn't
176131d9d9b6SMarc Zyngier  *	automatically enable the interrupt. It has to be done on each
176231d9d9b6SMarc Zyngier  *	CPU using enable_percpu_irq().
176331d9d9b6SMarc Zyngier  *
176431d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
176531d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
176631d9d9b6SMarc Zyngier  *	that variable.
176731d9d9b6SMarc Zyngier  */
176831d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler,
176931d9d9b6SMarc Zyngier 		       const char *devname, void __percpu *dev_id)
177031d9d9b6SMarc Zyngier {
177131d9d9b6SMarc Zyngier 	struct irqaction *action;
177231d9d9b6SMarc Zyngier 	struct irq_desc *desc;
177331d9d9b6SMarc Zyngier 	int retval;
177431d9d9b6SMarc Zyngier 
177531d9d9b6SMarc Zyngier 	if (!dev_id)
177631d9d9b6SMarc Zyngier 		return -EINVAL;
177731d9d9b6SMarc Zyngier 
177831d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
177931d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
178031d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
178131d9d9b6SMarc Zyngier 		return -EINVAL;
178231d9d9b6SMarc Zyngier 
178331d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
178431d9d9b6SMarc Zyngier 	if (!action)
178531d9d9b6SMarc Zyngier 		return -ENOMEM;
178631d9d9b6SMarc Zyngier 
178731d9d9b6SMarc Zyngier 	action->handler = handler;
17882ed0e645SMarc Zyngier 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
178931d9d9b6SMarc Zyngier 	action->name = devname;
179031d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
179131d9d9b6SMarc Zyngier 
179231d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
179331d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
179431d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
179531d9d9b6SMarc Zyngier 
179631d9d9b6SMarc Zyngier 	if (retval)
179731d9d9b6SMarc Zyngier 		kfree(action);
179831d9d9b6SMarc Zyngier 
179931d9d9b6SMarc Zyngier 	return retval;
180031d9d9b6SMarc Zyngier }
1801*1b7047edSMarc Zyngier 
1802*1b7047edSMarc Zyngier /**
1803*1b7047edSMarc Zyngier  *	irq_get_irqchip_state - returns the irqchip state of a interrupt.
1804*1b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
1805*1b7047edSMarc Zyngier  *	@which: One of IRQCHIP_STATE_* the caller wants to know about
1806*1b7047edSMarc Zyngier  *	@state: a pointer to a boolean where the state is to be storeed
1807*1b7047edSMarc Zyngier  *
1808*1b7047edSMarc Zyngier  *	This call snapshots the internal irqchip state of an
1809*1b7047edSMarc Zyngier  *	interrupt, returning into @state the bit corresponding to
1810*1b7047edSMarc Zyngier  *	stage @which
1811*1b7047edSMarc Zyngier  *
1812*1b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
1813*1b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
1814*1b7047edSMarc Zyngier  */
1815*1b7047edSMarc Zyngier int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
1816*1b7047edSMarc Zyngier 			  bool *state)
1817*1b7047edSMarc Zyngier {
1818*1b7047edSMarc Zyngier 	struct irq_desc *desc;
1819*1b7047edSMarc Zyngier 	struct irq_data *data;
1820*1b7047edSMarc Zyngier 	struct irq_chip *chip;
1821*1b7047edSMarc Zyngier 	unsigned long flags;
1822*1b7047edSMarc Zyngier 	int err = -EINVAL;
1823*1b7047edSMarc Zyngier 
1824*1b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
1825*1b7047edSMarc Zyngier 	if (!desc)
1826*1b7047edSMarc Zyngier 		return err;
1827*1b7047edSMarc Zyngier 
1828*1b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
1829*1b7047edSMarc Zyngier 
1830*1b7047edSMarc Zyngier 	do {
1831*1b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
1832*1b7047edSMarc Zyngier 		if (chip->irq_get_irqchip_state)
1833*1b7047edSMarc Zyngier 			break;
1834*1b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1835*1b7047edSMarc Zyngier 		data = data->parent_data;
1836*1b7047edSMarc Zyngier #else
1837*1b7047edSMarc Zyngier 		data = NULL;
1838*1b7047edSMarc Zyngier #endif
1839*1b7047edSMarc Zyngier 	} while (data);
1840*1b7047edSMarc Zyngier 
1841*1b7047edSMarc Zyngier 	if (data)
1842*1b7047edSMarc Zyngier 		err = chip->irq_get_irqchip_state(data, which, state);
1843*1b7047edSMarc Zyngier 
1844*1b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
1845*1b7047edSMarc Zyngier 	return err;
1846*1b7047edSMarc Zyngier }
1847*1b7047edSMarc Zyngier 
1848*1b7047edSMarc Zyngier /**
1849*1b7047edSMarc Zyngier  *	irq_set_irqchip_state - set the state of a forwarded interrupt.
1850*1b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
1851*1b7047edSMarc Zyngier  *	@which: State to be restored (one of IRQCHIP_STATE_*)
1852*1b7047edSMarc Zyngier  *	@val: Value corresponding to @which
1853*1b7047edSMarc Zyngier  *
1854*1b7047edSMarc Zyngier  *	This call sets the internal irqchip state of an interrupt,
1855*1b7047edSMarc Zyngier  *	depending on the value of @which.
1856*1b7047edSMarc Zyngier  *
1857*1b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
1858*1b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
1859*1b7047edSMarc Zyngier  */
1860*1b7047edSMarc Zyngier int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
1861*1b7047edSMarc Zyngier 			  bool val)
1862*1b7047edSMarc Zyngier {
1863*1b7047edSMarc Zyngier 	struct irq_desc *desc;
1864*1b7047edSMarc Zyngier 	struct irq_data *data;
1865*1b7047edSMarc Zyngier 	struct irq_chip *chip;
1866*1b7047edSMarc Zyngier 	unsigned long flags;
1867*1b7047edSMarc Zyngier 	int err = -EINVAL;
1868*1b7047edSMarc Zyngier 
1869*1b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
1870*1b7047edSMarc Zyngier 	if (!desc)
1871*1b7047edSMarc Zyngier 		return err;
1872*1b7047edSMarc Zyngier 
1873*1b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
1874*1b7047edSMarc Zyngier 
1875*1b7047edSMarc Zyngier 	do {
1876*1b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
1877*1b7047edSMarc Zyngier 		if (chip->irq_set_irqchip_state)
1878*1b7047edSMarc Zyngier 			break;
1879*1b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1880*1b7047edSMarc Zyngier 		data = data->parent_data;
1881*1b7047edSMarc Zyngier #else
1882*1b7047edSMarc Zyngier 		data = NULL;
1883*1b7047edSMarc Zyngier #endif
1884*1b7047edSMarc Zyngier 	} while (data);
1885*1b7047edSMarc Zyngier 
1886*1b7047edSMarc Zyngier 	if (data)
1887*1b7047edSMarc Zyngier 		err = chip->irq_set_irqchip_state(data, which, val);
1888*1b7047edSMarc Zyngier 
1889*1b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
1890*1b7047edSMarc Zyngier 	return err;
1891*1b7047edSMarc Zyngier }
1892