xref: /openbmc/linux/kernel/irq/manage.c (revision 9c2555835bb3d34dfac52a0be943dcc4bedd650f)
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 
118*9c255583SThomas Gleixner static bool __irq_can_set_affinity(struct irq_desc *desc)
119e019c249SJiang Liu {
120e019c249SJiang Liu 	if (!desc || !irqd_can_balance(&desc->irq_data) ||
121e019c249SJiang Liu 	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
122*9c255583SThomas Gleixner 		return false;
123*9c255583SThomas Gleixner 	return true;
124e019c249SJiang Liu }
125e019c249SJiang Liu 
126771ee3b0SThomas Gleixner /**
127771ee3b0SThomas Gleixner  *	irq_can_set_affinity - Check if the affinity of a given irq can be set
128771ee3b0SThomas Gleixner  *	@irq:		Interrupt to check
129771ee3b0SThomas Gleixner  *
130771ee3b0SThomas Gleixner  */
131771ee3b0SThomas Gleixner int irq_can_set_affinity(unsigned int irq)
132771ee3b0SThomas Gleixner {
133e019c249SJiang Liu 	return __irq_can_set_affinity(irq_to_desc(irq));
134771ee3b0SThomas Gleixner }
135771ee3b0SThomas Gleixner 
136591d2fb0SThomas Gleixner /**
137*9c255583SThomas Gleixner  * irq_can_set_affinity_usr - Check if affinity of a irq can be set from user space
138*9c255583SThomas Gleixner  * @irq:	Interrupt to check
139*9c255583SThomas Gleixner  *
140*9c255583SThomas Gleixner  * Like irq_can_set_affinity() above, but additionally checks for the
141*9c255583SThomas Gleixner  * AFFINITY_MANAGED flag.
142*9c255583SThomas Gleixner  */
143*9c255583SThomas Gleixner bool irq_can_set_affinity_usr(unsigned int irq)
144*9c255583SThomas Gleixner {
145*9c255583SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
146*9c255583SThomas Gleixner 
147*9c255583SThomas Gleixner 	return __irq_can_set_affinity(desc) &&
148*9c255583SThomas Gleixner 		!irqd_affinity_is_managed(&desc->irq_data);
149*9c255583SThomas Gleixner }
150*9c255583SThomas Gleixner 
151*9c255583SThomas Gleixner /**
152591d2fb0SThomas Gleixner  *	irq_set_thread_affinity - Notify irq threads to adjust affinity
153591d2fb0SThomas Gleixner  *	@desc:		irq descriptor which has affitnity changed
154591d2fb0SThomas Gleixner  *
155591d2fb0SThomas Gleixner  *	We just set IRQTF_AFFINITY and delegate the affinity setting
156591d2fb0SThomas Gleixner  *	to the interrupt thread itself. We can not call
157591d2fb0SThomas Gleixner  *	set_cpus_allowed_ptr() here as we hold desc->lock and this
158591d2fb0SThomas Gleixner  *	code can be called from hard interrupt context.
159591d2fb0SThomas Gleixner  */
160591d2fb0SThomas Gleixner void irq_set_thread_affinity(struct irq_desc *desc)
1613aa551c9SThomas Gleixner {
162f944b5a7SDaniel Lezcano 	struct irqaction *action;
1633aa551c9SThomas Gleixner 
164f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action)
1653aa551c9SThomas Gleixner 		if (action->thread)
166591d2fb0SThomas Gleixner 			set_bit(IRQTF_AFFINITY, &action->thread_flags);
1673aa551c9SThomas Gleixner }
1683aa551c9SThomas Gleixner 
1691fa46f1fSThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ
1700ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data)
1711fa46f1fSThomas Gleixner {
1720ef5ca1eSThomas Gleixner 	return irqd_can_move_in_process_context(data);
1731fa46f1fSThomas Gleixner }
1740ef5ca1eSThomas Gleixner static inline bool irq_move_pending(struct irq_data *data)
1751fa46f1fSThomas Gleixner {
1760ef5ca1eSThomas Gleixner 	return irqd_is_setaffinity_pending(data);
1771fa46f1fSThomas Gleixner }
1781fa46f1fSThomas Gleixner static inline void
1791fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
1801fa46f1fSThomas Gleixner {
1811fa46f1fSThomas Gleixner 	cpumask_copy(desc->pending_mask, mask);
1821fa46f1fSThomas Gleixner }
1831fa46f1fSThomas Gleixner static inline void
1841fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
1851fa46f1fSThomas Gleixner {
1861fa46f1fSThomas Gleixner 	cpumask_copy(mask, desc->pending_mask);
1871fa46f1fSThomas Gleixner }
1881fa46f1fSThomas Gleixner #else
1890ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
190cd22c0e4SThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) { return false; }
1911fa46f1fSThomas Gleixner static inline void
1921fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
1931fa46f1fSThomas Gleixner static inline void
1941fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
1951fa46f1fSThomas Gleixner #endif
1961fa46f1fSThomas Gleixner 
197818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
198818b0f3bSJiang Liu 			bool force)
199818b0f3bSJiang Liu {
200818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
201818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
202818b0f3bSJiang Liu 	int ret;
203818b0f3bSJiang Liu 
20401f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
205818b0f3bSJiang Liu 	switch (ret) {
206818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
2072cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
2089df872faSJiang Liu 		cpumask_copy(desc->irq_common_data.affinity, mask);
209818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
210818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
211818b0f3bSJiang Liu 		ret = 0;
212818b0f3bSJiang Liu 	}
213818b0f3bSJiang Liu 
214818b0f3bSJiang Liu 	return ret;
215818b0f3bSJiang Liu }
216818b0f3bSJiang Liu 
21701f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
21801f8fa4fSThomas Gleixner 			    bool force)
219c2d0c555SDavid Daney {
220c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
221c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
222c2d0c555SDavid Daney 	int ret = 0;
223c2d0c555SDavid Daney 
224c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
225c2d0c555SDavid Daney 		return -EINVAL;
226c2d0c555SDavid Daney 
2270ef5ca1eSThomas Gleixner 	if (irq_can_move_pcntxt(data)) {
22801f8fa4fSThomas Gleixner 		ret = irq_do_set_affinity(data, mask, force);
229c2d0c555SDavid Daney 	} else {
230c2d0c555SDavid Daney 		irqd_set_move_pending(data);
231c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
232c2d0c555SDavid Daney 	}
233c2d0c555SDavid Daney 
234c2d0c555SDavid Daney 	if (desc->affinity_notify) {
235c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
236c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
237c2d0c555SDavid Daney 	}
238c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
239c2d0c555SDavid Daney 
240c2d0c555SDavid Daney 	return ret;
241c2d0c555SDavid Daney }
242c2d0c555SDavid Daney 
24301f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
244771ee3b0SThomas Gleixner {
24508678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
246f6d87f4bSThomas Gleixner 	unsigned long flags;
247c2d0c555SDavid Daney 	int ret;
248771ee3b0SThomas Gleixner 
249c2d0c555SDavid Daney 	if (!desc)
250771ee3b0SThomas Gleixner 		return -EINVAL;
251771ee3b0SThomas Gleixner 
252239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
25301f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
254239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2551fa46f1fSThomas Gleixner 	return ret;
256771ee3b0SThomas Gleixner }
257771ee3b0SThomas Gleixner 
258e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
259e7a297b0SPeter P Waskiewicz Jr {
260e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
26131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
262e7a297b0SPeter P Waskiewicz Jr 
263e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
264e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
265e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
26602725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
267e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
2684fe7ffb7SJesse Brandeburg 	if (m)
269e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
270e7a297b0SPeter P Waskiewicz Jr 	return 0;
271e7a297b0SPeter P Waskiewicz Jr }
272e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
273e7a297b0SPeter P Waskiewicz Jr 
274cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
275cd7eab44SBen Hutchings {
276cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
277cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
278cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
279cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
280cd7eab44SBen Hutchings 	unsigned long flags;
281cd7eab44SBen Hutchings 
2821fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
283cd7eab44SBen Hutchings 		goto out;
284cd7eab44SBen Hutchings 
285cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
2860ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
2871fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
288cd7eab44SBen Hutchings 	else
2899df872faSJiang Liu 		cpumask_copy(cpumask, desc->irq_common_data.affinity);
290cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
291cd7eab44SBen Hutchings 
292cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
293cd7eab44SBen Hutchings 
294cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
295cd7eab44SBen Hutchings out:
296cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
297cd7eab44SBen Hutchings }
298cd7eab44SBen Hutchings 
299cd7eab44SBen Hutchings /**
300cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
301cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
302cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
303cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
304cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
305cd7eab44SBen Hutchings  *
306cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
307cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
308cd7eab44SBen Hutchings  *	freed using free_irq().
309cd7eab44SBen Hutchings  */
310cd7eab44SBen Hutchings int
311cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
312cd7eab44SBen Hutchings {
313cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
314cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
315cd7eab44SBen Hutchings 	unsigned long flags;
316cd7eab44SBen Hutchings 
317cd7eab44SBen Hutchings 	/* The release function is promised process context */
318cd7eab44SBen Hutchings 	might_sleep();
319cd7eab44SBen Hutchings 
320cd7eab44SBen Hutchings 	if (!desc)
321cd7eab44SBen Hutchings 		return -EINVAL;
322cd7eab44SBen Hutchings 
323cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
324cd7eab44SBen Hutchings 	if (notify) {
325cd7eab44SBen Hutchings 		notify->irq = irq;
326cd7eab44SBen Hutchings 		kref_init(&notify->kref);
327cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
328cd7eab44SBen Hutchings 	}
329cd7eab44SBen Hutchings 
330cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
331cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
332cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
333cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
334cd7eab44SBen Hutchings 
335cd7eab44SBen Hutchings 	if (old_notify)
336cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
337cd7eab44SBen Hutchings 
338cd7eab44SBen Hutchings 	return 0;
339cd7eab44SBen Hutchings }
340cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
341cd7eab44SBen Hutchings 
34218404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
34318404756SMax Krasnyansky /*
34418404756SMax Krasnyansky  * Generic version of the affinity autoselector.
34518404756SMax Krasnyansky  */
346a8a98eacSJiang Liu static int setup_affinity(struct irq_desc *desc, struct cpumask *mask)
34718404756SMax Krasnyansky {
348569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
3496783011bSJiang Liu 	int node = irq_desc_get_node(desc);
350569bda8dSThomas Gleixner 
351b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
352e019c249SJiang Liu 	if (!__irq_can_set_affinity(desc))
35318404756SMax Krasnyansky 		return 0;
35418404756SMax Krasnyansky 
355f6d87f4bSThomas Gleixner 	/*
356f6d87f4bSThomas Gleixner 	 * Preserve an userspace affinity setup, but make sure that
357f6d87f4bSThomas Gleixner 	 * one of the targets is online.
358f6d87f4bSThomas Gleixner 	 */
3592bdd1055SThomas Gleixner 	if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
3609df872faSJiang Liu 		if (cpumask_intersects(desc->irq_common_data.affinity,
361569bda8dSThomas Gleixner 				       cpu_online_mask))
3629df872faSJiang Liu 			set = desc->irq_common_data.affinity;
3630c6f8a8bSThomas Gleixner 		else
3642bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3652bdd1055SThomas Gleixner 	}
36618404756SMax Krasnyansky 
3673b8249e7SThomas Gleixner 	cpumask_and(mask, cpu_online_mask, set);
368241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
369241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
370241fc640SPrarit Bhargava 
371241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
372241fc640SPrarit Bhargava 		if (cpumask_intersects(mask, nodemask))
373241fc640SPrarit Bhargava 			cpumask_and(mask, mask, nodemask);
374241fc640SPrarit Bhargava 	}
375818b0f3bSJiang Liu 	irq_do_set_affinity(&desc->irq_data, mask, false);
37618404756SMax Krasnyansky 	return 0;
37718404756SMax Krasnyansky }
378f6d87f4bSThomas Gleixner #else
379a8a98eacSJiang Liu /* Wrapper for ALPHA specific affinity selector magic */
380a8a98eacSJiang Liu static inline int setup_affinity(struct irq_desc *d, struct cpumask *mask)
381f6d87f4bSThomas Gleixner {
382a8a98eacSJiang Liu 	return irq_select_affinity(irq_desc_get_irq(d));
383f6d87f4bSThomas Gleixner }
38418404756SMax Krasnyansky #endif
38518404756SMax Krasnyansky 
386f6d87f4bSThomas Gleixner /*
387f6d87f4bSThomas Gleixner  * Called when affinity is set via /proc/irq
388f6d87f4bSThomas Gleixner  */
3893b8249e7SThomas Gleixner int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
390f6d87f4bSThomas Gleixner {
391f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
392f6d87f4bSThomas Gleixner 	unsigned long flags;
393f6d87f4bSThomas Gleixner 	int ret;
394f6d87f4bSThomas Gleixner 
395239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
396a8a98eacSJiang Liu 	ret = setup_affinity(desc, mask);
397239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
398f6d87f4bSThomas Gleixner 	return ret;
399f6d87f4bSThomas Gleixner }
400f6d87f4bSThomas Gleixner 
401f6d87f4bSThomas Gleixner #else
4023b8249e7SThomas Gleixner static inline int
403a8a98eacSJiang Liu setup_affinity(struct irq_desc *desc, struct cpumask *mask)
404f6d87f4bSThomas Gleixner {
405f6d87f4bSThomas Gleixner 	return 0;
406f6d87f4bSThomas Gleixner }
4071da177e4SLinus Torvalds #endif
4081da177e4SLinus Torvalds 
409fcf1ae2fSFeng Wu /**
410fcf1ae2fSFeng Wu  *	irq_set_vcpu_affinity - Set vcpu affinity for the interrupt
411fcf1ae2fSFeng Wu  *	@irq: interrupt number to set affinity
412fcf1ae2fSFeng Wu  *	@vcpu_info: vCPU specific data
413fcf1ae2fSFeng Wu  *
414fcf1ae2fSFeng Wu  *	This function uses the vCPU specific data to set the vCPU
415fcf1ae2fSFeng Wu  *	affinity for an irq. The vCPU specific data is passed from
416fcf1ae2fSFeng Wu  *	outside, such as KVM. One example code path is as below:
417fcf1ae2fSFeng Wu  *	KVM -> IOMMU -> irq_set_vcpu_affinity().
418fcf1ae2fSFeng Wu  */
419fcf1ae2fSFeng Wu int irq_set_vcpu_affinity(unsigned int irq, void *vcpu_info)
420fcf1ae2fSFeng Wu {
421fcf1ae2fSFeng Wu 	unsigned long flags;
422fcf1ae2fSFeng Wu 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
423fcf1ae2fSFeng Wu 	struct irq_data *data;
424fcf1ae2fSFeng Wu 	struct irq_chip *chip;
425fcf1ae2fSFeng Wu 	int ret = -ENOSYS;
426fcf1ae2fSFeng Wu 
427fcf1ae2fSFeng Wu 	if (!desc)
428fcf1ae2fSFeng Wu 		return -EINVAL;
429fcf1ae2fSFeng Wu 
430fcf1ae2fSFeng Wu 	data = irq_desc_get_irq_data(desc);
431fcf1ae2fSFeng Wu 	chip = irq_data_get_irq_chip(data);
432fcf1ae2fSFeng Wu 	if (chip && chip->irq_set_vcpu_affinity)
433fcf1ae2fSFeng Wu 		ret = chip->irq_set_vcpu_affinity(data, vcpu_info);
434fcf1ae2fSFeng Wu 	irq_put_desc_unlock(desc, flags);
435fcf1ae2fSFeng Wu 
436fcf1ae2fSFeng Wu 	return ret;
437fcf1ae2fSFeng Wu }
438fcf1ae2fSFeng Wu EXPORT_SYMBOL_GPL(irq_set_vcpu_affinity);
439fcf1ae2fSFeng Wu 
44079ff1cdaSJiang Liu void __disable_irq(struct irq_desc *desc)
4410a0c5168SRafael J. Wysocki {
4423aae994fSThomas Gleixner 	if (!desc->depth++)
44387923470SThomas Gleixner 		irq_disable(desc);
4440a0c5168SRafael J. Wysocki }
4450a0c5168SRafael J. Wysocki 
44602725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
44702725e74SThomas Gleixner {
44802725e74SThomas Gleixner 	unsigned long flags;
44931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
45002725e74SThomas Gleixner 
45102725e74SThomas Gleixner 	if (!desc)
45202725e74SThomas Gleixner 		return -EINVAL;
45379ff1cdaSJiang Liu 	__disable_irq(desc);
45402725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
45502725e74SThomas Gleixner 	return 0;
45602725e74SThomas Gleixner }
45702725e74SThomas Gleixner 
4581da177e4SLinus Torvalds /**
4591da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4601da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4611da177e4SLinus Torvalds  *
4621da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4631da177e4SLinus Torvalds  *	nested.
4641da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
4651da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
4661da177e4SLinus Torvalds  *
4671da177e4SLinus Torvalds  *	This function may be called from IRQ context.
4681da177e4SLinus Torvalds  */
4691da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
4701da177e4SLinus Torvalds {
47102725e74SThomas Gleixner 	__disable_irq_nosync(irq);
4721da177e4SLinus Torvalds }
4731da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
4741da177e4SLinus Torvalds 
4751da177e4SLinus Torvalds /**
4761da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
4771da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4781da177e4SLinus Torvalds  *
4791da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
4801da177e4SLinus Torvalds  *	nested.
4811da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
4821da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
4831da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
4841da177e4SLinus Torvalds  *
4851da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
4861da177e4SLinus Torvalds  */
4871da177e4SLinus Torvalds void disable_irq(unsigned int irq)
4881da177e4SLinus Torvalds {
48902725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
4901da177e4SLinus Torvalds 		synchronize_irq(irq);
4911da177e4SLinus Torvalds }
4921da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
4931da177e4SLinus Torvalds 
49402cea395SPeter Zijlstra /**
49502cea395SPeter Zijlstra  *	disable_hardirq - disables an irq and waits for hardirq completion
49602cea395SPeter Zijlstra  *	@irq: Interrupt to disable
49702cea395SPeter Zijlstra  *
49802cea395SPeter Zijlstra  *	Disable the selected interrupt line.  Enables and Disables are
49902cea395SPeter Zijlstra  *	nested.
50002cea395SPeter Zijlstra  *	This function waits for any pending hard IRQ handlers for this
50102cea395SPeter Zijlstra  *	interrupt to complete before returning. If you use this function while
50202cea395SPeter Zijlstra  *	holding a resource the hard IRQ handler may need you will deadlock.
50302cea395SPeter Zijlstra  *
50402cea395SPeter Zijlstra  *	When used to optimistically disable an interrupt from atomic context
50502cea395SPeter Zijlstra  *	the return value must be checked.
50602cea395SPeter Zijlstra  *
50702cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
50802cea395SPeter Zijlstra  *
50902cea395SPeter Zijlstra  *	This function may be called - with care - from IRQ context.
51002cea395SPeter Zijlstra  */
51102cea395SPeter Zijlstra bool disable_hardirq(unsigned int irq)
51202cea395SPeter Zijlstra {
51302cea395SPeter Zijlstra 	if (!__disable_irq_nosync(irq))
51402cea395SPeter Zijlstra 		return synchronize_hardirq(irq);
51502cea395SPeter Zijlstra 
51602cea395SPeter Zijlstra 	return false;
51702cea395SPeter Zijlstra }
51802cea395SPeter Zijlstra EXPORT_SYMBOL_GPL(disable_hardirq);
51902cea395SPeter Zijlstra 
52079ff1cdaSJiang Liu void __enable_irq(struct irq_desc *desc)
5211adb0850SThomas Gleixner {
5221adb0850SThomas Gleixner 	switch (desc->depth) {
5231adb0850SThomas Gleixner 	case 0:
5240a0c5168SRafael J. Wysocki  err_out:
52579ff1cdaSJiang Liu 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n",
52679ff1cdaSJiang Liu 		     irq_desc_get_irq(desc));
5271adb0850SThomas Gleixner 		break;
5281adb0850SThomas Gleixner 	case 1: {
529c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
5300a0c5168SRafael J. Wysocki 			goto err_out;
5311adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
5321ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
5333aae994fSThomas Gleixner 		irq_enable(desc);
5340798abebSJiang Liu 		check_irq_resend(desc);
5351adb0850SThomas Gleixner 		/* fall-through */
5361adb0850SThomas Gleixner 	}
5371adb0850SThomas Gleixner 	default:
5381adb0850SThomas Gleixner 		desc->depth--;
5391adb0850SThomas Gleixner 	}
5401adb0850SThomas Gleixner }
5411adb0850SThomas Gleixner 
5421da177e4SLinus Torvalds /**
5431da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
5441da177e4SLinus Torvalds  *	@irq: Interrupt to enable
5451da177e4SLinus Torvalds  *
5461da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
5471da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
5481da177e4SLinus Torvalds  *	IRQ line is re-enabled.
5491da177e4SLinus Torvalds  *
55070aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
5516b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
5521da177e4SLinus Torvalds  */
5531da177e4SLinus Torvalds void enable_irq(unsigned int irq)
5541da177e4SLinus Torvalds {
5551da177e4SLinus Torvalds 	unsigned long flags;
55631d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5571da177e4SLinus Torvalds 
5587d94f7caSYinghai Lu 	if (!desc)
559c2b5a251SMatthew Wilcox 		return;
56050f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
5612656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
56202725e74SThomas Gleixner 		goto out;
5632656c366SThomas Gleixner 
56479ff1cdaSJiang Liu 	__enable_irq(desc);
56502725e74SThomas Gleixner out:
56602725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
5671da177e4SLinus Torvalds }
5681da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
5691da177e4SLinus Torvalds 
5700c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
5712db87321SUwe Kleine-König {
57208678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
5732db87321SUwe Kleine-König 	int ret = -ENXIO;
5742db87321SUwe Kleine-König 
57560f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
57660f96b41SSantosh Shilimkar 		return 0;
57760f96b41SSantosh Shilimkar 
5782f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
5792f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
5802db87321SUwe Kleine-König 
5812db87321SUwe Kleine-König 	return ret;
5822db87321SUwe Kleine-König }
5832db87321SUwe Kleine-König 
584ba9a2331SThomas Gleixner /**
585a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
586ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
587ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
588ba9a2331SThomas Gleixner  *
58915a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
59015a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
59115a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
59215a647ebSDavid Brownell  *
59315a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
59415a647ebSDavid Brownell  *	states like "suspend to RAM".
595ba9a2331SThomas Gleixner  */
596a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
597ba9a2331SThomas Gleixner {
598ba9a2331SThomas Gleixner 	unsigned long flags;
59931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
6002db87321SUwe Kleine-König 	int ret = 0;
601ba9a2331SThomas Gleixner 
60213863a66SJesper Juhl 	if (!desc)
60313863a66SJesper Juhl 		return -EINVAL;
60413863a66SJesper Juhl 
60515a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
60615a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
60715a647ebSDavid Brownell 	 */
60815a647ebSDavid Brownell 	if (on) {
6092db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
6102db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6112db87321SUwe Kleine-König 			if (ret)
6122db87321SUwe Kleine-König 				desc->wake_depth = 0;
61315a647ebSDavid Brownell 			else
6147f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
6152db87321SUwe Kleine-König 		}
61615a647ebSDavid Brownell 	} else {
61715a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
6187a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
6192db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
6202db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6212db87321SUwe Kleine-König 			if (ret)
6222db87321SUwe Kleine-König 				desc->wake_depth = 1;
62315a647ebSDavid Brownell 			else
6247f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
62515a647ebSDavid Brownell 		}
6262db87321SUwe Kleine-König 	}
62702725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
628ba9a2331SThomas Gleixner 	return ret;
629ba9a2331SThomas Gleixner }
630a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
631ba9a2331SThomas Gleixner 
6321da177e4SLinus Torvalds /*
6331da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
6341da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
6351da177e4SLinus Torvalds  * for driver use.
6361da177e4SLinus Torvalds  */
6371da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
6381da177e4SLinus Torvalds {
639cc8c3b78SThomas Gleixner 	unsigned long flags;
64031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
64102725e74SThomas Gleixner 	int canrequest = 0;
6421da177e4SLinus Torvalds 
6437d94f7caSYinghai Lu 	if (!desc)
6447d94f7caSYinghai Lu 		return 0;
6457d94f7caSYinghai Lu 
64602725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
6472779db8dSBen Hutchings 		if (!desc->action ||
6482779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
64902725e74SThomas Gleixner 			canrequest = 1;
65002725e74SThomas Gleixner 	}
65102725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
65202725e74SThomas Gleixner 	return canrequest;
6531da177e4SLinus Torvalds }
6541da177e4SLinus Torvalds 
655a1ff541aSJiang Liu int __irq_set_trigger(struct irq_desc *desc, unsigned long flags)
65682736f4dSUwe Kleine-König {
6576b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
658d4d5e089SThomas Gleixner 	int ret, unmask = 0;
65982736f4dSUwe Kleine-König 
660b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
66182736f4dSUwe Kleine-König 		/*
66282736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
66382736f4dSUwe Kleine-König 		 * flow-types?
66482736f4dSUwe Kleine-König 		 */
665a1ff541aSJiang Liu 		pr_debug("No set_type function for IRQ %d (%s)\n",
666a1ff541aSJiang Liu 			 irq_desc_get_irq(desc),
66782736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
66882736f4dSUwe Kleine-König 		return 0;
66982736f4dSUwe Kleine-König 	}
67082736f4dSUwe Kleine-König 
671876dbd4cSThomas Gleixner 	flags &= IRQ_TYPE_SENSE_MASK;
672d4d5e089SThomas Gleixner 
673d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
67432f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
675d4d5e089SThomas Gleixner 			mask_irq(desc);
67632f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
677d4d5e089SThomas Gleixner 			unmask = 1;
678d4d5e089SThomas Gleixner 	}
679d4d5e089SThomas Gleixner 
680f2b662daSDavid Brownell 	/* caller masked out all except trigger mode flags */
681b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
68282736f4dSUwe Kleine-König 
683876dbd4cSThomas Gleixner 	switch (ret) {
684876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
6852cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
686876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
687876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
688876dbd4cSThomas Gleixner 
689876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
690876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
691876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
692876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
693876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
694876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
695876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
696876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
697876dbd4cSThomas Gleixner 		}
69846732475SThomas Gleixner 
699d4d5e089SThomas Gleixner 		ret = 0;
7008fff39e0SThomas Gleixner 		break;
701876dbd4cSThomas Gleixner 	default:
70297fd75b7SAndrew Morton 		pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
703a1ff541aSJiang Liu 		       flags, irq_desc_get_irq(desc), chip->irq_set_type);
7040c5d1eb7SDavid Brownell 	}
705d4d5e089SThomas Gleixner 	if (unmask)
706d4d5e089SThomas Gleixner 		unmask_irq(desc);
70782736f4dSUwe Kleine-König 	return ret;
70882736f4dSUwe Kleine-König }
70982736f4dSUwe Kleine-König 
710293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
711293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
712293a7a0aSThomas Gleixner {
713293a7a0aSThomas Gleixner 	unsigned long flags;
714293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
715293a7a0aSThomas Gleixner 
716293a7a0aSThomas Gleixner 	if (!desc)
717293a7a0aSThomas Gleixner 		return -EINVAL;
718293a7a0aSThomas Gleixner 
719293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
720293a7a0aSThomas Gleixner 
721293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
722293a7a0aSThomas Gleixner 	return 0;
723293a7a0aSThomas Gleixner }
724293a7a0aSThomas Gleixner #endif
725293a7a0aSThomas Gleixner 
726b25c340cSThomas Gleixner /*
727b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
728b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
729b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
730b25c340cSThomas Gleixner  */
731b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
732b25c340cSThomas Gleixner {
733b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
734b25c340cSThomas Gleixner }
735b25c340cSThomas Gleixner 
736399b5da2SThomas Gleixner /*
737399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
738399b5da2SThomas Gleixner  * called.
739399b5da2SThomas Gleixner  */
740399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
741399b5da2SThomas Gleixner {
742399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
743399b5da2SThomas Gleixner 	return IRQ_NONE;
744399b5da2SThomas Gleixner }
745399b5da2SThomas Gleixner 
7462a1d3ab8SThomas Gleixner static irqreturn_t irq_forced_secondary_handler(int irq, void *dev_id)
7472a1d3ab8SThomas Gleixner {
7482a1d3ab8SThomas Gleixner 	WARN(1, "Secondary action handler called for irq %d\n", irq);
7492a1d3ab8SThomas Gleixner 	return IRQ_NONE;
7502a1d3ab8SThomas Gleixner }
7512a1d3ab8SThomas Gleixner 
7523aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
7533aa551c9SThomas Gleixner {
7543aa551c9SThomas Gleixner 	set_current_state(TASK_INTERRUPTIBLE);
755f48fe81eSThomas Gleixner 
756550acb19SIdo Yariv 	while (!kthread_should_stop()) {
757550acb19SIdo Yariv 
758f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
759f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
7603aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
7613aa551c9SThomas Gleixner 			return 0;
762f48fe81eSThomas Gleixner 		}
7633aa551c9SThomas Gleixner 		schedule();
764550acb19SIdo Yariv 		set_current_state(TASK_INTERRUPTIBLE);
7653aa551c9SThomas Gleixner 	}
766550acb19SIdo Yariv 	__set_current_state(TASK_RUNNING);
7673aa551c9SThomas Gleixner 	return -1;
7683aa551c9SThomas Gleixner }
7693aa551c9SThomas Gleixner 
770b25c340cSThomas Gleixner /*
771b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
772b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
773b25c340cSThomas Gleixner  * is marked MASKED.
774b25c340cSThomas Gleixner  */
775b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
776f3f79e38SAlexander Gordeev 				 struct irqaction *action)
777b25c340cSThomas Gleixner {
7782a1d3ab8SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT) ||
7792a1d3ab8SThomas Gleixner 	    action->handler == irq_forced_secondary_handler)
780b5faba21SThomas Gleixner 		return;
7810b1adaa0SThomas Gleixner again:
7823876ec9eSThomas Gleixner 	chip_bus_lock(desc);
783239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
7840b1adaa0SThomas Gleixner 
7850b1adaa0SThomas Gleixner 	/*
7860b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
7870b1adaa0SThomas Gleixner 	 * the following scenario:
7880b1adaa0SThomas Gleixner 	 *
7890b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
7900b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
7910b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
792009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
793b5faba21SThomas Gleixner 	 *
794b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
795b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
796b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
797b5faba21SThomas Gleixner 	 * serialization.
7980b1adaa0SThomas Gleixner 	 */
79932f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
8000b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
8013876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
8020b1adaa0SThomas Gleixner 		cpu_relax();
8030b1adaa0SThomas Gleixner 		goto again;
8040b1adaa0SThomas Gleixner 	}
8050b1adaa0SThomas Gleixner 
806b5faba21SThomas Gleixner 	/*
807b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
808b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
809b5faba21SThomas Gleixner 	 * was just set.
810b5faba21SThomas Gleixner 	 */
811f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
812b5faba21SThomas Gleixner 		goto out_unlock;
813b5faba21SThomas Gleixner 
814b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
815b5faba21SThomas Gleixner 
81632f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
81732f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
818328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
81932f4125eSThomas Gleixner 
820b5faba21SThomas Gleixner out_unlock:
821239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
8223876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
823b25c340cSThomas Gleixner }
824b25c340cSThomas Gleixner 
82561f38261SBruno Premont #ifdef CONFIG_SMP
8263aa551c9SThomas Gleixner /*
827b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
828591d2fb0SThomas Gleixner  */
829591d2fb0SThomas Gleixner static void
830591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
831591d2fb0SThomas Gleixner {
832591d2fb0SThomas Gleixner 	cpumask_var_t mask;
83304aa530eSThomas Gleixner 	bool valid = true;
834591d2fb0SThomas Gleixner 
835591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
836591d2fb0SThomas Gleixner 		return;
837591d2fb0SThomas Gleixner 
838591d2fb0SThomas Gleixner 	/*
839591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
840591d2fb0SThomas Gleixner 	 * try again next time
841591d2fb0SThomas Gleixner 	 */
842591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
843591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
844591d2fb0SThomas Gleixner 		return;
845591d2fb0SThomas Gleixner 	}
846591d2fb0SThomas Gleixner 
847239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
84804aa530eSThomas Gleixner 	/*
84904aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
85004aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
85104aa530eSThomas Gleixner 	 */
8529df872faSJiang Liu 	if (desc->irq_common_data.affinity)
8539df872faSJiang Liu 		cpumask_copy(mask, desc->irq_common_data.affinity);
85404aa530eSThomas Gleixner 	else
85504aa530eSThomas Gleixner 		valid = false;
856239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
857591d2fb0SThomas Gleixner 
85804aa530eSThomas Gleixner 	if (valid)
859591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
860591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
861591d2fb0SThomas Gleixner }
86261f38261SBruno Premont #else
86361f38261SBruno Premont static inline void
86461f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
86561f38261SBruno Premont #endif
866591d2fb0SThomas Gleixner 
867591d2fb0SThomas Gleixner /*
8688d32a307SThomas Gleixner  * Interrupts which are not explicitely requested as threaded
8698d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
8708d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
8718d32a307SThomas Gleixner  * side effects.
8728d32a307SThomas Gleixner  */
8733a43e05fSSebastian Andrzej Siewior static irqreturn_t
8748d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
8758d32a307SThomas Gleixner {
8763a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8773a43e05fSSebastian Andrzej Siewior 
8788d32a307SThomas Gleixner 	local_bh_disable();
8793a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
880f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8818d32a307SThomas Gleixner 	local_bh_enable();
8823a43e05fSSebastian Andrzej Siewior 	return ret;
8838d32a307SThomas Gleixner }
8848d32a307SThomas Gleixner 
8858d32a307SThomas Gleixner /*
886f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
8878d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
8888d32a307SThomas Gleixner  * complete.
8898d32a307SThomas Gleixner  */
8903a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
8913a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
8928d32a307SThomas Gleixner {
8933a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8943a43e05fSSebastian Andrzej Siewior 
8953a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
896f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8973a43e05fSSebastian Andrzej Siewior 	return ret;
8988d32a307SThomas Gleixner }
8998d32a307SThomas Gleixner 
9007140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
9017140ea19SIdo Yariv {
902c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
9037140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
9047140ea19SIdo Yariv }
9057140ea19SIdo Yariv 
90667d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
9074d1d61a6SOleg Nesterov {
9084d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
9094d1d61a6SOleg Nesterov 	struct irq_desc *desc;
9104d1d61a6SOleg Nesterov 	struct irqaction *action;
9114d1d61a6SOleg Nesterov 
9124d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
9134d1d61a6SOleg Nesterov 		return;
9144d1d61a6SOleg Nesterov 
9154d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
9164d1d61a6SOleg Nesterov 
917fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
91819af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
9194d1d61a6SOleg Nesterov 
9204d1d61a6SOleg Nesterov 
9214d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
9224d1d61a6SOleg Nesterov 	/*
9234d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
9244d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
9254d1d61a6SOleg Nesterov 	 */
9264d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
9274d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
9284d1d61a6SOleg Nesterov 
9294d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
9304d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
9314d1d61a6SOleg Nesterov }
9324d1d61a6SOleg Nesterov 
9332a1d3ab8SThomas Gleixner static void irq_wake_secondary(struct irq_desc *desc, struct irqaction *action)
9342a1d3ab8SThomas Gleixner {
9352a1d3ab8SThomas Gleixner 	struct irqaction *secondary = action->secondary;
9362a1d3ab8SThomas Gleixner 
9372a1d3ab8SThomas Gleixner 	if (WARN_ON_ONCE(!secondary))
9382a1d3ab8SThomas Gleixner 		return;
9392a1d3ab8SThomas Gleixner 
9402a1d3ab8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
9412a1d3ab8SThomas Gleixner 	__irq_wake_thread(desc, secondary);
9422a1d3ab8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
9432a1d3ab8SThomas Gleixner }
9442a1d3ab8SThomas Gleixner 
9458d32a307SThomas Gleixner /*
9463aa551c9SThomas Gleixner  * Interrupt handler thread
9473aa551c9SThomas Gleixner  */
9483aa551c9SThomas Gleixner static int irq_thread(void *data)
9493aa551c9SThomas Gleixner {
95067d12145SAl Viro 	struct callback_head on_exit_work;
9513aa551c9SThomas Gleixner 	struct irqaction *action = data;
9523aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
9533a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
9543a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
9553aa551c9SThomas Gleixner 
956540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
9578d32a307SThomas Gleixner 					&action->thread_flags))
9588d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
9598d32a307SThomas Gleixner 	else
9608d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
9618d32a307SThomas Gleixner 
96241f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
9634d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
9643aa551c9SThomas Gleixner 
965f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
966f3de44edSSankara Muthukrishnan 
9673aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
9687140ea19SIdo Yariv 		irqreturn_t action_ret;
9693aa551c9SThomas Gleixner 
970591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
971591d2fb0SThomas Gleixner 
9723a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
9731e77d0a1SThomas Gleixner 		if (action_ret == IRQ_HANDLED)
9741e77d0a1SThomas Gleixner 			atomic_inc(&desc->threads_handled);
9752a1d3ab8SThomas Gleixner 		if (action_ret == IRQ_WAKE_THREAD)
9762a1d3ab8SThomas Gleixner 			irq_wake_secondary(desc, action);
9777140ea19SIdo Yariv 
9787140ea19SIdo Yariv 		wake_threads_waitq(desc);
9793aa551c9SThomas Gleixner 	}
9803aa551c9SThomas Gleixner 
9817140ea19SIdo Yariv 	/*
9827140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
9837140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
9847140ea19SIdo Yariv 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
985e04268b0SThomas Gleixner 	 * oneshot mask bit can be set. We cannot verify that as we
986e04268b0SThomas Gleixner 	 * cannot touch the oneshot mask at this point anymore as
987e04268b0SThomas Gleixner 	 * __setup_irq() might have given out currents thread_mask
988e04268b0SThomas Gleixner 	 * again.
9893aa551c9SThomas Gleixner 	 */
9904d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
9913aa551c9SThomas Gleixner 	return 0;
9923aa551c9SThomas Gleixner }
9933aa551c9SThomas Gleixner 
994a92444c6SThomas Gleixner /**
995a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
996a92444c6SThomas Gleixner  *	@irq:		Interrupt line
997a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
998a92444c6SThomas Gleixner  *
999a92444c6SThomas Gleixner  */
1000a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
1001a92444c6SThomas Gleixner {
1002a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1003a92444c6SThomas Gleixner 	struct irqaction *action;
1004a92444c6SThomas Gleixner 	unsigned long flags;
1005a92444c6SThomas Gleixner 
1006a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1007a92444c6SThomas Gleixner 		return;
1008a92444c6SThomas Gleixner 
1009a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1010f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action) {
1011a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
1012a92444c6SThomas Gleixner 			if (action->thread)
1013a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
1014a92444c6SThomas Gleixner 			break;
1015a92444c6SThomas Gleixner 		}
1016a92444c6SThomas Gleixner 	}
1017a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1018a92444c6SThomas Gleixner }
1019a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
1020a92444c6SThomas Gleixner 
10212a1d3ab8SThomas Gleixner static int irq_setup_forced_threading(struct irqaction *new)
10228d32a307SThomas Gleixner {
10238d32a307SThomas Gleixner 	if (!force_irqthreads)
10242a1d3ab8SThomas Gleixner 		return 0;
10258d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
10262a1d3ab8SThomas Gleixner 		return 0;
10278d32a307SThomas Gleixner 
10288d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
10298d32a307SThomas Gleixner 
10302a1d3ab8SThomas Gleixner 	/*
10312a1d3ab8SThomas Gleixner 	 * Handle the case where we have a real primary handler and a
10322a1d3ab8SThomas Gleixner 	 * thread handler. We force thread them as well by creating a
10332a1d3ab8SThomas Gleixner 	 * secondary action.
10342a1d3ab8SThomas Gleixner 	 */
10352a1d3ab8SThomas Gleixner 	if (new->handler != irq_default_primary_handler && new->thread_fn) {
10362a1d3ab8SThomas Gleixner 		/* Allocate the secondary action */
10372a1d3ab8SThomas Gleixner 		new->secondary = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
10382a1d3ab8SThomas Gleixner 		if (!new->secondary)
10392a1d3ab8SThomas Gleixner 			return -ENOMEM;
10402a1d3ab8SThomas Gleixner 		new->secondary->handler = irq_forced_secondary_handler;
10412a1d3ab8SThomas Gleixner 		new->secondary->thread_fn = new->thread_fn;
10422a1d3ab8SThomas Gleixner 		new->secondary->dev_id = new->dev_id;
10432a1d3ab8SThomas Gleixner 		new->secondary->irq = new->irq;
10442a1d3ab8SThomas Gleixner 		new->secondary->name = new->name;
10452a1d3ab8SThomas Gleixner 	}
10462a1d3ab8SThomas Gleixner 	/* Deal with the primary handler */
10478d32a307SThomas Gleixner 	set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
10488d32a307SThomas Gleixner 	new->thread_fn = new->handler;
10498d32a307SThomas Gleixner 	new->handler = irq_default_primary_handler;
10502a1d3ab8SThomas Gleixner 	return 0;
10518d32a307SThomas Gleixner }
10528d32a307SThomas Gleixner 
1053c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
1054c1bacbaeSThomas Gleixner {
1055c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1056c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1057c1bacbaeSThomas Gleixner 
1058c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
1059c1bacbaeSThomas Gleixner }
1060c1bacbaeSThomas Gleixner 
1061c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
1062c1bacbaeSThomas Gleixner {
1063c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1064c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1065c1bacbaeSThomas Gleixner 
1066c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
1067c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
1068c1bacbaeSThomas Gleixner }
1069c1bacbaeSThomas Gleixner 
10702a1d3ab8SThomas Gleixner static int
10712a1d3ab8SThomas Gleixner setup_irq_thread(struct irqaction *new, unsigned int irq, bool secondary)
10722a1d3ab8SThomas Gleixner {
10732a1d3ab8SThomas Gleixner 	struct task_struct *t;
10742a1d3ab8SThomas Gleixner 	struct sched_param param = {
10752a1d3ab8SThomas Gleixner 		.sched_priority = MAX_USER_RT_PRIO/2,
10762a1d3ab8SThomas Gleixner 	};
10772a1d3ab8SThomas Gleixner 
10782a1d3ab8SThomas Gleixner 	if (!secondary) {
10792a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
10802a1d3ab8SThomas Gleixner 				   new->name);
10812a1d3ab8SThomas Gleixner 	} else {
10822a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-s-%s", irq,
10832a1d3ab8SThomas Gleixner 				   new->name);
10842a1d3ab8SThomas Gleixner 		param.sched_priority -= 1;
10852a1d3ab8SThomas Gleixner 	}
10862a1d3ab8SThomas Gleixner 
10872a1d3ab8SThomas Gleixner 	if (IS_ERR(t))
10882a1d3ab8SThomas Gleixner 		return PTR_ERR(t);
10892a1d3ab8SThomas Gleixner 
10902a1d3ab8SThomas Gleixner 	sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
10912a1d3ab8SThomas Gleixner 
10922a1d3ab8SThomas Gleixner 	/*
10932a1d3ab8SThomas Gleixner 	 * We keep the reference to the task struct even if
10942a1d3ab8SThomas Gleixner 	 * the thread dies to avoid that the interrupt code
10952a1d3ab8SThomas Gleixner 	 * references an already freed task_struct.
10962a1d3ab8SThomas Gleixner 	 */
10972a1d3ab8SThomas Gleixner 	get_task_struct(t);
10982a1d3ab8SThomas Gleixner 	new->thread = t;
10992a1d3ab8SThomas Gleixner 	/*
11002a1d3ab8SThomas Gleixner 	 * Tell the thread to set its affinity. This is
11012a1d3ab8SThomas Gleixner 	 * important for shared interrupt handlers as we do
11022a1d3ab8SThomas Gleixner 	 * not invoke setup_affinity() for the secondary
11032a1d3ab8SThomas Gleixner 	 * handlers as everything is already set up. Even for
11042a1d3ab8SThomas Gleixner 	 * interrupts marked with IRQF_NO_BALANCE this is
11052a1d3ab8SThomas Gleixner 	 * correct as we want the thread to move to the cpu(s)
11062a1d3ab8SThomas Gleixner 	 * on which the requesting code placed the interrupt.
11072a1d3ab8SThomas Gleixner 	 */
11082a1d3ab8SThomas Gleixner 	set_bit(IRQTF_AFFINITY, &new->thread_flags);
11092a1d3ab8SThomas Gleixner 	return 0;
11102a1d3ab8SThomas Gleixner }
11112a1d3ab8SThomas Gleixner 
11121da177e4SLinus Torvalds /*
11131da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
11141da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
11151da177e4SLinus Torvalds  */
1116d3c60047SThomas Gleixner static int
1117d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
11181da177e4SLinus Torvalds {
1119f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
1120b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
11213b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
11223b8249e7SThomas Gleixner 	cpumask_var_t mask;
11231da177e4SLinus Torvalds 
11247d94f7caSYinghai Lu 	if (!desc)
1125c2b5a251SMatthew Wilcox 		return -EINVAL;
1126c2b5a251SMatthew Wilcox 
11276b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
11281da177e4SLinus Torvalds 		return -ENOSYS;
1129b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
1130b6873807SSebastian Andrzej Siewior 		return -ENODEV;
11311da177e4SLinus Torvalds 
11322a1d3ab8SThomas Gleixner 	new->irq = irq;
11332a1d3ab8SThomas Gleixner 
11341da177e4SLinus Torvalds 	/*
1135399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
1136399b5da2SThomas Gleixner 	 * thread.
11373aa551c9SThomas Gleixner 	 */
11381ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
1139399b5da2SThomas Gleixner 	if (nested) {
1140b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
1141b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
1142b6873807SSebastian Andrzej Siewior 			goto out_mput;
1143b6873807SSebastian Andrzej Siewior 		}
1144399b5da2SThomas Gleixner 		/*
1145399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
1146399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
1147399b5da2SThomas Gleixner 		 * dummy function which warns when called.
1148399b5da2SThomas Gleixner 		 */
1149399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
11508d32a307SThomas Gleixner 	} else {
11512a1d3ab8SThomas Gleixner 		if (irq_settings_can_thread(desc)) {
11522a1d3ab8SThomas Gleixner 			ret = irq_setup_forced_threading(new);
11532a1d3ab8SThomas Gleixner 			if (ret)
11542a1d3ab8SThomas Gleixner 				goto out_mput;
11552a1d3ab8SThomas Gleixner 		}
1156399b5da2SThomas Gleixner 	}
1157399b5da2SThomas Gleixner 
1158399b5da2SThomas Gleixner 	/*
1159399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
1160399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
1161399b5da2SThomas Gleixner 	 * thread.
1162399b5da2SThomas Gleixner 	 */
1163399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
11642a1d3ab8SThomas Gleixner 		ret = setup_irq_thread(new, irq, false);
11652a1d3ab8SThomas Gleixner 		if (ret)
1166b6873807SSebastian Andrzej Siewior 			goto out_mput;
11672a1d3ab8SThomas Gleixner 		if (new->secondary) {
11682a1d3ab8SThomas Gleixner 			ret = setup_irq_thread(new->secondary, irq, true);
11692a1d3ab8SThomas Gleixner 			if (ret)
11702a1d3ab8SThomas Gleixner 				goto out_thread;
1171b6873807SSebastian Andrzej Siewior 		}
11723aa551c9SThomas Gleixner 	}
11733aa551c9SThomas Gleixner 
11743b8249e7SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
11753b8249e7SThomas Gleixner 		ret = -ENOMEM;
11763b8249e7SThomas Gleixner 		goto out_thread;
11773b8249e7SThomas Gleixner 	}
11783b8249e7SThomas Gleixner 
11793aa551c9SThomas Gleixner 	/*
1180dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1181dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1182dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1183dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1184dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1185dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1186dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1187dc9b229aSThomas Gleixner 	 */
1188dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1189dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1190dc9b229aSThomas Gleixner 
1191dc9b229aSThomas Gleixner 	/*
11921da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
11931da177e4SLinus Torvalds 	 */
1194239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1195f17c7545SIngo Molnar 	old_ptr = &desc->action;
1196f17c7545SIngo Molnar 	old = *old_ptr;
119706fcb0c6SIngo Molnar 	if (old) {
1198e76de9f8SThomas Gleixner 		/*
1199e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1200e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
12013cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
12029d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
12039d591eddSThomas Gleixner 		 * agree on ONESHOT.
1204e76de9f8SThomas Gleixner 		 */
12053cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
12069d591eddSThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) ||
1207f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1208f5163427SDimitri Sivanich 			goto mismatch;
1209f5163427SDimitri Sivanich 
1210f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
12113cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
12123cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1213f5163427SDimitri Sivanich 			goto mismatch;
12141da177e4SLinus Torvalds 
12151da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
12161da177e4SLinus Torvalds 		do {
121752abb700SThomas Gleixner 			/*
121852abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
121952abb700SThomas Gleixner 			 * so we can find the next zero bit for this
122052abb700SThomas Gleixner 			 * new action.
122152abb700SThomas Gleixner 			 */
1222b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1223f17c7545SIngo Molnar 			old_ptr = &old->next;
1224f17c7545SIngo Molnar 			old = *old_ptr;
12251da177e4SLinus Torvalds 		} while (old);
12261da177e4SLinus Torvalds 		shared = 1;
12271da177e4SLinus Torvalds 	}
12281da177e4SLinus Torvalds 
1229b5faba21SThomas Gleixner 	/*
123052abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
123152abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
123252abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1233b5faba21SThomas Gleixner 	 */
123452abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
123552abb700SThomas Gleixner 		/*
123652abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
123752abb700SThomas Gleixner 		 * but who knows.
123852abb700SThomas Gleixner 		 */
123952abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1240b5faba21SThomas Gleixner 			ret = -EBUSY;
1241b5faba21SThomas Gleixner 			goto out_mask;
1242b5faba21SThomas Gleixner 		}
124352abb700SThomas Gleixner 		/*
124452abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
124552abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
124652abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
124752abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
124852abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
124952abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
125052abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
125152abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
125252abb700SThomas Gleixner 		 *
125352abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
125452abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
125552abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
125652abb700SThomas Gleixner 		 * affected hard irq flow handlers
125752abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
125852abb700SThomas Gleixner 		 *
125952abb700SThomas Gleixner 		 * The new action gets the first zero bit of
126052abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
126152abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
126252abb700SThomas Gleixner 		 */
1263b5faba21SThomas Gleixner 		new->thread_mask = 1 << ffz(thread_mask);
12641c6c6952SThomas Gleixner 
1265dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1266dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
12671c6c6952SThomas Gleixner 		/*
12681c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
12691c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
12701c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
12711c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
12721c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
12731c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
12741c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
12751c6c6952SThomas Gleixner 		 *
12761c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
12771c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
12781c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
12791c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
12801c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
12811c6c6952SThomas Gleixner 		 */
128297fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
12831c6c6952SThomas Gleixner 		       irq);
12841c6c6952SThomas Gleixner 		ret = -EINVAL;
12851c6c6952SThomas Gleixner 		goto out_mask;
128652abb700SThomas Gleixner 	}
1287b5faba21SThomas Gleixner 
12881da177e4SLinus Torvalds 	if (!shared) {
1289c1bacbaeSThomas Gleixner 		ret = irq_request_resources(desc);
1290c1bacbaeSThomas Gleixner 		if (ret) {
1291c1bacbaeSThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
1292c1bacbaeSThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
1293c1bacbaeSThomas Gleixner 			goto out_mask;
1294c1bacbaeSThomas Gleixner 		}
1295c1bacbaeSThomas Gleixner 
12963aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
12973aa551c9SThomas Gleixner 
129882736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
129982736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1300a1ff541aSJiang Liu 			ret = __irq_set_trigger(desc,
1301f2b662daSDavid Brownell 						new->flags & IRQF_TRIGGER_MASK);
130282736f4dSUwe Kleine-König 
13033aa551c9SThomas Gleixner 			if (ret)
13043b8249e7SThomas Gleixner 				goto out_mask;
1305091738a2SThomas Gleixner 		}
1306f75d222bSAhmed S. Darwish 
1307009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
130832f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
130932f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
131094d39e1fSThomas Gleixner 
1311a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1312a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1313a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1314a005677bSThomas Gleixner 		}
13156a58fb3bSThomas Gleixner 
1316b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
13173d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1318b25c340cSThomas Gleixner 
13191ccb4e61SThomas Gleixner 		if (irq_settings_can_autoenable(desc))
1320b4bc724eSThomas Gleixner 			irq_startup(desc, true);
132146999238SThomas Gleixner 		else
1322e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1323e76de9f8SThomas Gleixner 			desc->depth = 1;
132418404756SMax Krasnyansky 
1325612e3684SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
1326a005677bSThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
1327a005677bSThomas Gleixner 			irq_settings_set_no_balancing(desc);
1328a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1329a005677bSThomas Gleixner 		}
1330612e3684SThomas Gleixner 
133118404756SMax Krasnyansky 		/* Set default affinity mask once everything is setup */
1332a8a98eacSJiang Liu 		setup_affinity(desc, mask);
13330c5d1eb7SDavid Brownell 
1334876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1335876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
1336876dbd4cSThomas Gleixner 		unsigned int omsk = irq_settings_get_trigger_mask(desc);
1337876dbd4cSThomas Gleixner 
1338876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1339876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
1340a395d6a7SJoe Perches 			pr_warn("irq %d uses trigger mode %u; requested %u\n",
1341876dbd4cSThomas Gleixner 				irq, nmsk, omsk);
134294d39e1fSThomas Gleixner 	}
134382736f4dSUwe Kleine-König 
1344f17c7545SIngo Molnar 	*old_ptr = new;
134582736f4dSUwe Kleine-König 
1346cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1347cab303beSThomas Gleixner 
13488528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
13498528b0f1SLinus Torvalds 	desc->irq_count = 0;
13508528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
13511adb0850SThomas Gleixner 
13521adb0850SThomas Gleixner 	/*
13531adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
13541adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
13551adb0850SThomas Gleixner 	 */
13567acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
13577acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
135879ff1cdaSJiang Liu 		__enable_irq(desc);
13591adb0850SThomas Gleixner 	}
13601adb0850SThomas Gleixner 
1361239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
13621da177e4SLinus Torvalds 
136369ab8494SThomas Gleixner 	/*
136469ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
136569ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
136669ab8494SThomas Gleixner 	 */
136769ab8494SThomas Gleixner 	if (new->thread)
136869ab8494SThomas Gleixner 		wake_up_process(new->thread);
13692a1d3ab8SThomas Gleixner 	if (new->secondary)
13702a1d3ab8SThomas Gleixner 		wake_up_process(new->secondary->thread);
137169ab8494SThomas Gleixner 
13722c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
13731da177e4SLinus Torvalds 	new->dir = NULL;
13741da177e4SLinus Torvalds 	register_handler_proc(irq, new);
13754f5058c3SXiaotian Feng 	free_cpumask_var(mask);
13761da177e4SLinus Torvalds 
13771da177e4SLinus Torvalds 	return 0;
1378f5163427SDimitri Sivanich 
1379f5163427SDimitri Sivanich mismatch:
13803cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
138197fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1382f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1383f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1384f5163427SDimitri Sivanich 		dump_stack();
13853f050447SAlan Cox #endif
1386f5d89470SThomas Gleixner 	}
13873aa551c9SThomas Gleixner 	ret = -EBUSY;
13883aa551c9SThomas Gleixner 
13893b8249e7SThomas Gleixner out_mask:
13901c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
13913b8249e7SThomas Gleixner 	free_cpumask_var(mask);
13923b8249e7SThomas Gleixner 
13933aa551c9SThomas Gleixner out_thread:
13943aa551c9SThomas Gleixner 	if (new->thread) {
13953aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
13963aa551c9SThomas Gleixner 
13973aa551c9SThomas Gleixner 		new->thread = NULL;
13983aa551c9SThomas Gleixner 		kthread_stop(t);
13993aa551c9SThomas Gleixner 		put_task_struct(t);
14003aa551c9SThomas Gleixner 	}
14012a1d3ab8SThomas Gleixner 	if (new->secondary && new->secondary->thread) {
14022a1d3ab8SThomas Gleixner 		struct task_struct *t = new->secondary->thread;
14032a1d3ab8SThomas Gleixner 
14042a1d3ab8SThomas Gleixner 		new->secondary->thread = NULL;
14052a1d3ab8SThomas Gleixner 		kthread_stop(t);
14062a1d3ab8SThomas Gleixner 		put_task_struct(t);
14072a1d3ab8SThomas Gleixner 	}
1408b6873807SSebastian Andrzej Siewior out_mput:
1409b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
14103aa551c9SThomas Gleixner 	return ret;
14111da177e4SLinus Torvalds }
14121da177e4SLinus Torvalds 
14131da177e4SLinus Torvalds /**
1414d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1415d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1416d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1417d3c60047SThomas Gleixner  *
1418d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1419d3c60047SThomas Gleixner  */
1420d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1421d3c60047SThomas Gleixner {
1422986c011dSDavid Daney 	int retval;
1423d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1424d3c60047SThomas Gleixner 
14259b5d585dSJon Hunter 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
142631d9d9b6SMarc Zyngier 		return -EINVAL;
1427986c011dSDavid Daney 	chip_bus_lock(desc);
1428986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1429986c011dSDavid Daney 	chip_bus_sync_unlock(desc);
1430986c011dSDavid Daney 
1431986c011dSDavid Daney 	return retval;
1432d3c60047SThomas Gleixner }
1433eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1434d3c60047SThomas Gleixner 
1435cbf94f06SMagnus Damm /*
1436cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1437cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
14381da177e4SLinus Torvalds  */
1439cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
14401da177e4SLinus Torvalds {
1441d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1442f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
14431da177e4SLinus Torvalds 	unsigned long flags;
14441da177e4SLinus Torvalds 
1445ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
14467d94f7caSYinghai Lu 
14477d94f7caSYinghai Lu 	if (!desc)
1448f21cfb25SMagnus Damm 		return NULL;
14491da177e4SLinus Torvalds 
1450abc7e40cSThomas Gleixner 	chip_bus_lock(desc);
1451239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1452ae88a23bSIngo Molnar 
1453ae88a23bSIngo Molnar 	/*
1454ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1455ae88a23bSIngo Molnar 	 * one based on the dev_id:
1456ae88a23bSIngo Molnar 	 */
1457f17c7545SIngo Molnar 	action_ptr = &desc->action;
14581da177e4SLinus Torvalds 	for (;;) {
1459f17c7545SIngo Molnar 		action = *action_ptr;
14601da177e4SLinus Torvalds 
1461ae88a23bSIngo Molnar 		if (!action) {
1462ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1463239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1464abc7e40cSThomas Gleixner 			chip_bus_sync_unlock(desc);
1465f21cfb25SMagnus Damm 			return NULL;
1466ae88a23bSIngo Molnar 		}
14671da177e4SLinus Torvalds 
14688316e381SIngo Molnar 		if (action->dev_id == dev_id)
1469ae88a23bSIngo Molnar 			break;
1470f17c7545SIngo Molnar 		action_ptr = &action->next;
1471ae88a23bSIngo Molnar 	}
1472ae88a23bSIngo Molnar 
1473ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1474f17c7545SIngo Molnar 	*action_ptr = action->next;
1475dbce706eSPaolo 'Blaisorblade' Giarrusso 
1476cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1477cab303beSThomas Gleixner 
1478ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1479c1bacbaeSThomas Gleixner 	if (!desc->action) {
1480e9849777SThomas Gleixner 		irq_settings_clr_disable_unlazy(desc);
148146999238SThomas Gleixner 		irq_shutdown(desc);
1482c1bacbaeSThomas Gleixner 		irq_release_resources(desc);
1483c1bacbaeSThomas Gleixner 	}
14843aa551c9SThomas Gleixner 
1485e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1486e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1487e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1488e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1489e7a297b0SPeter P Waskiewicz Jr #endif
1490e7a297b0SPeter P Waskiewicz Jr 
1491239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1492abc7e40cSThomas Gleixner 	chip_bus_sync_unlock(desc);
1493ae88a23bSIngo Molnar 
14941da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
14951da177e4SLinus Torvalds 
1496ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
14971da177e4SLinus Torvalds 	synchronize_irq(irq);
1498ae88a23bSIngo Molnar 
14991d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
15001d99493bSDavid Woodhouse 	/*
1501ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1502ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1503ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1504ae88a23bSIngo Molnar 	 *
1505ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
1506ae88a23bSIngo Molnar 	 *   'real' IRQ doesn't run in * parallel with our fake. )
15071d99493bSDavid Woodhouse 	 */
15081d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
15091d99493bSDavid Woodhouse 		local_irq_save(flags);
15101d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
15111d99493bSDavid Woodhouse 		local_irq_restore(flags);
15121d99493bSDavid Woodhouse 	}
15131d99493bSDavid Woodhouse #endif
15142d860ad7SLinus Torvalds 
15152d860ad7SLinus Torvalds 	if (action->thread) {
15162d860ad7SLinus Torvalds 		kthread_stop(action->thread);
15172d860ad7SLinus Torvalds 		put_task_struct(action->thread);
15182a1d3ab8SThomas Gleixner 		if (action->secondary && action->secondary->thread) {
15192a1d3ab8SThomas Gleixner 			kthread_stop(action->secondary->thread);
15202a1d3ab8SThomas Gleixner 			put_task_struct(action->secondary->thread);
15212a1d3ab8SThomas Gleixner 		}
15222d860ad7SLinus Torvalds 	}
15232d860ad7SLinus Torvalds 
1524b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
15252a1d3ab8SThomas Gleixner 	kfree(action->secondary);
1526f21cfb25SMagnus Damm 	return action;
1527f21cfb25SMagnus Damm }
15281da177e4SLinus Torvalds 
15291da177e4SLinus Torvalds /**
1530cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1531cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1532cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1533cbf94f06SMagnus Damm  *
1534cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1535cbf94f06SMagnus Damm  */
1536cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1537cbf94f06SMagnus Damm {
153831d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
153931d9d9b6SMarc Zyngier 
154031d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1541cbf94f06SMagnus Damm 	    __free_irq(irq, act->dev_id);
1542cbf94f06SMagnus Damm }
1543eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1544cbf94f06SMagnus Damm 
1545cbf94f06SMagnus Damm /**
1546f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
15471da177e4SLinus Torvalds  *	@irq: Interrupt line to free
15481da177e4SLinus Torvalds  *	@dev_id: Device identity to free
15491da177e4SLinus Torvalds  *
15501da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
15511da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
15521da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
15531da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
15541da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
15551da177e4SLinus Torvalds  *	have completed.
15561da177e4SLinus Torvalds  *
15571da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
15581da177e4SLinus Torvalds  */
15591da177e4SLinus Torvalds void free_irq(unsigned int irq, void *dev_id)
15601da177e4SLinus Torvalds {
156170aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
156270aedd24SThomas Gleixner 
156331d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
156470aedd24SThomas Gleixner 		return;
156570aedd24SThomas Gleixner 
1566cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1567cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1568cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1569cd7eab44SBen Hutchings #endif
1570cd7eab44SBen Hutchings 
1571cbf94f06SMagnus Damm 	kfree(__free_irq(irq, dev_id));
15721da177e4SLinus Torvalds }
15731da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
15741da177e4SLinus Torvalds 
15751da177e4SLinus Torvalds /**
15763aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
15771da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
15783aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
15793aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1580b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1581b25c340cSThomas Gleixner  *		  primary handler is installed
15823aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
15833aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
15841da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
15851da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
15861da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
15871da177e4SLinus Torvalds  *
15881da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
15891da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
15901da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
15911da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
15921da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
15931da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
15941da177e4SLinus Torvalds  *
15953aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
15966d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
15973aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
15983aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
15993aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
160039a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
16013aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
16023aa551c9SThomas Gleixner  *	shared interrupts.
16033aa551c9SThomas Gleixner  *
16041da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
16051da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
16061da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
16071da177e4SLinus Torvalds  *
16081da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
16091da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
16101da177e4SLinus Torvalds  *
16111da177e4SLinus Torvalds  *	Flags:
16121da177e4SLinus Torvalds  *
16133cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
16140c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
16151da177e4SLinus Torvalds  *
16161da177e4SLinus Torvalds  */
16173aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
16183aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
16193aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
16201da177e4SLinus Torvalds {
16211da177e4SLinus Torvalds 	struct irqaction *action;
162208678b08SYinghai Lu 	struct irq_desc *desc;
1623d3c60047SThomas Gleixner 	int retval;
16241da177e4SLinus Torvalds 
1625e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1626e237a551SChen Fan 		return -ENOTCONN;
1627e237a551SChen Fan 
1628470c6623SDavid Brownell 	/*
16291da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
16301da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
16311da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
16321da177e4SLinus Torvalds 	 * logic etc).
163317f48034SRafael J. Wysocki 	 *
163417f48034SRafael J. Wysocki 	 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and
163517f48034SRafael J. Wysocki 	 * it cannot be set along with IRQF_NO_SUSPEND.
16361da177e4SLinus Torvalds 	 */
163717f48034SRafael J. Wysocki 	if (((irqflags & IRQF_SHARED) && !dev_id) ||
163817f48034SRafael J. Wysocki 	    (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) ||
163917f48034SRafael J. Wysocki 	    ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND)))
16401da177e4SLinus Torvalds 		return -EINVAL;
16417d94f7caSYinghai Lu 
1642cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
16437d94f7caSYinghai Lu 	if (!desc)
16441da177e4SLinus Torvalds 		return -EINVAL;
16457d94f7caSYinghai Lu 
164631d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
164731d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
16486550c775SThomas Gleixner 		return -EINVAL;
1649b25c340cSThomas Gleixner 
1650b25c340cSThomas Gleixner 	if (!handler) {
1651b25c340cSThomas Gleixner 		if (!thread_fn)
16521da177e4SLinus Torvalds 			return -EINVAL;
1653b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1654b25c340cSThomas Gleixner 	}
16551da177e4SLinus Torvalds 
165645535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
16571da177e4SLinus Torvalds 	if (!action)
16581da177e4SLinus Torvalds 		return -ENOMEM;
16591da177e4SLinus Torvalds 
16601da177e4SLinus Torvalds 	action->handler = handler;
16613aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
16621da177e4SLinus Torvalds 	action->flags = irqflags;
16631da177e4SLinus Torvalds 	action->name = devname;
16641da177e4SLinus Torvalds 	action->dev_id = dev_id;
16651da177e4SLinus Torvalds 
16663876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1667d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
16683876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
166970aedd24SThomas Gleixner 
16702a1d3ab8SThomas Gleixner 	if (retval) {
16712a1d3ab8SThomas Gleixner 		kfree(action->secondary);
1672377bf1e4SAnton Vorontsov 		kfree(action);
16732a1d3ab8SThomas Gleixner 	}
1674377bf1e4SAnton Vorontsov 
16756d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
16766ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1677a304e1b8SDavid Woodhouse 		/*
1678a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
1679a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
1680377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1681377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
1682a304e1b8SDavid Woodhouse 		 */
1683a304e1b8SDavid Woodhouse 		unsigned long flags;
1684a304e1b8SDavid Woodhouse 
1685377bf1e4SAnton Vorontsov 		disable_irq(irq);
1686a304e1b8SDavid Woodhouse 		local_irq_save(flags);
1687377bf1e4SAnton Vorontsov 
1688a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
1689377bf1e4SAnton Vorontsov 
1690a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
1691377bf1e4SAnton Vorontsov 		enable_irq(irq);
1692a304e1b8SDavid Woodhouse 	}
1693a304e1b8SDavid Woodhouse #endif
16941da177e4SLinus Torvalds 	return retval;
16951da177e4SLinus Torvalds }
16963aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
1697ae731f8dSMarc Zyngier 
1698ae731f8dSMarc Zyngier /**
1699ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
1700ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
1701ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
1702ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
1703ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
1704ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
1705ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
1706ae731f8dSMarc Zyngier  *
1707ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
1708ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
1709ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
1710ae731f8dSMarc Zyngier  *	context.
1711ae731f8dSMarc Zyngier  *
1712ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
1713ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1714ae731f8dSMarc Zyngier  */
1715ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1716ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
1717ae731f8dSMarc Zyngier {
1718e237a551SChen Fan 	struct irq_desc *desc;
1719ae731f8dSMarc Zyngier 	int ret;
1720ae731f8dSMarc Zyngier 
1721e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1722e237a551SChen Fan 		return -ENOTCONN;
1723e237a551SChen Fan 
1724e237a551SChen Fan 	desc = irq_to_desc(irq);
1725ae731f8dSMarc Zyngier 	if (!desc)
1726ae731f8dSMarc Zyngier 		return -EINVAL;
1727ae731f8dSMarc Zyngier 
17281ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
1729ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
1730ae731f8dSMarc Zyngier 					   flags, name, dev_id);
1731ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
1732ae731f8dSMarc Zyngier 	}
1733ae731f8dSMarc Zyngier 
1734ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
1735ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
1736ae731f8dSMarc Zyngier }
1737ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
173831d9d9b6SMarc Zyngier 
17391e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
174031d9d9b6SMarc Zyngier {
174131d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
174231d9d9b6SMarc Zyngier 	unsigned long flags;
174331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
174431d9d9b6SMarc Zyngier 
174531d9d9b6SMarc Zyngier 	if (!desc)
174631d9d9b6SMarc Zyngier 		return;
174731d9d9b6SMarc Zyngier 
17481e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
17491e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
17501e7c5fd2SMarc Zyngier 		int ret;
17511e7c5fd2SMarc Zyngier 
1752a1ff541aSJiang Liu 		ret = __irq_set_trigger(desc, type);
17531e7c5fd2SMarc Zyngier 
17541e7c5fd2SMarc Zyngier 		if (ret) {
175532cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
17561e7c5fd2SMarc Zyngier 			goto out;
17571e7c5fd2SMarc Zyngier 		}
17581e7c5fd2SMarc Zyngier 	}
17591e7c5fd2SMarc Zyngier 
176031d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
17611e7c5fd2SMarc Zyngier out:
176231d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
176331d9d9b6SMarc Zyngier }
176436a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
176531d9d9b6SMarc Zyngier 
1766f0cb3220SThomas Petazzoni /**
1767f0cb3220SThomas Petazzoni  * irq_percpu_is_enabled - Check whether the per cpu irq is enabled
1768f0cb3220SThomas Petazzoni  * @irq:	Linux irq number to check for
1769f0cb3220SThomas Petazzoni  *
1770f0cb3220SThomas Petazzoni  * Must be called from a non migratable context. Returns the enable
1771f0cb3220SThomas Petazzoni  * state of a per cpu interrupt on the current cpu.
1772f0cb3220SThomas Petazzoni  */
1773f0cb3220SThomas Petazzoni bool irq_percpu_is_enabled(unsigned int irq)
1774f0cb3220SThomas Petazzoni {
1775f0cb3220SThomas Petazzoni 	unsigned int cpu = smp_processor_id();
1776f0cb3220SThomas Petazzoni 	struct irq_desc *desc;
1777f0cb3220SThomas Petazzoni 	unsigned long flags;
1778f0cb3220SThomas Petazzoni 	bool is_enabled;
1779f0cb3220SThomas Petazzoni 
1780f0cb3220SThomas Petazzoni 	desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1781f0cb3220SThomas Petazzoni 	if (!desc)
1782f0cb3220SThomas Petazzoni 		return false;
1783f0cb3220SThomas Petazzoni 
1784f0cb3220SThomas Petazzoni 	is_enabled = cpumask_test_cpu(cpu, desc->percpu_enabled);
1785f0cb3220SThomas Petazzoni 	irq_put_desc_unlock(desc, flags);
1786f0cb3220SThomas Petazzoni 
1787f0cb3220SThomas Petazzoni 	return is_enabled;
1788f0cb3220SThomas Petazzoni }
1789f0cb3220SThomas Petazzoni EXPORT_SYMBOL_GPL(irq_percpu_is_enabled);
1790f0cb3220SThomas Petazzoni 
179131d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
179231d9d9b6SMarc Zyngier {
179331d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
179431d9d9b6SMarc Zyngier 	unsigned long flags;
179531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
179631d9d9b6SMarc Zyngier 
179731d9d9b6SMarc Zyngier 	if (!desc)
179831d9d9b6SMarc Zyngier 		return;
179931d9d9b6SMarc Zyngier 
180031d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
180131d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
180231d9d9b6SMarc Zyngier }
180336a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
180431d9d9b6SMarc Zyngier 
180531d9d9b6SMarc Zyngier /*
180631d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
180731d9d9b6SMarc Zyngier  */
180831d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
180931d9d9b6SMarc Zyngier {
181031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
181131d9d9b6SMarc Zyngier 	struct irqaction *action;
181231d9d9b6SMarc Zyngier 	unsigned long flags;
181331d9d9b6SMarc Zyngier 
181431d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
181531d9d9b6SMarc Zyngier 
181631d9d9b6SMarc Zyngier 	if (!desc)
181731d9d9b6SMarc Zyngier 		return NULL;
181831d9d9b6SMarc Zyngier 
181931d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
182031d9d9b6SMarc Zyngier 
182131d9d9b6SMarc Zyngier 	action = desc->action;
182231d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
182331d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
182431d9d9b6SMarc Zyngier 		goto bad;
182531d9d9b6SMarc Zyngier 	}
182631d9d9b6SMarc Zyngier 
182731d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
182831d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
182931d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
183031d9d9b6SMarc Zyngier 		goto bad;
183131d9d9b6SMarc Zyngier 	}
183231d9d9b6SMarc Zyngier 
183331d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
183431d9d9b6SMarc Zyngier 	desc->action = NULL;
183531d9d9b6SMarc Zyngier 
183631d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
183731d9d9b6SMarc Zyngier 
183831d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
183931d9d9b6SMarc Zyngier 
184031d9d9b6SMarc Zyngier 	module_put(desc->owner);
184131d9d9b6SMarc Zyngier 	return action;
184231d9d9b6SMarc Zyngier 
184331d9d9b6SMarc Zyngier bad:
184431d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
184531d9d9b6SMarc Zyngier 	return NULL;
184631d9d9b6SMarc Zyngier }
184731d9d9b6SMarc Zyngier 
184831d9d9b6SMarc Zyngier /**
184931d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
185031d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
185131d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
185231d9d9b6SMarc Zyngier  *
185331d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
185431d9d9b6SMarc Zyngier  */
185531d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
185631d9d9b6SMarc Zyngier {
185731d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
185831d9d9b6SMarc Zyngier 
185931d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
186031d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
186131d9d9b6SMarc Zyngier }
186231d9d9b6SMarc Zyngier 
186331d9d9b6SMarc Zyngier /**
186431d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
186531d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
186631d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
186731d9d9b6SMarc Zyngier  *
186831d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
186931d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
187031d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
187131d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
187231d9d9b6SMarc Zyngier  *
187331d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
187431d9d9b6SMarc Zyngier  */
187531d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
187631d9d9b6SMarc Zyngier {
187731d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
187831d9d9b6SMarc Zyngier 
187931d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
188031d9d9b6SMarc Zyngier 		return;
188131d9d9b6SMarc Zyngier 
188231d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
188331d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
188431d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
188531d9d9b6SMarc Zyngier }
1886aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(free_percpu_irq);
188731d9d9b6SMarc Zyngier 
188831d9d9b6SMarc Zyngier /**
188931d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
189031d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
189131d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
189231d9d9b6SMarc Zyngier  *
189331d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
189431d9d9b6SMarc Zyngier  */
189531d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
189631d9d9b6SMarc Zyngier {
189731d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
189831d9d9b6SMarc Zyngier 	int retval;
189931d9d9b6SMarc Zyngier 
190031d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
190131d9d9b6SMarc Zyngier 		return -EINVAL;
190231d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
190331d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
190431d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
190531d9d9b6SMarc Zyngier 
190631d9d9b6SMarc Zyngier 	return retval;
190731d9d9b6SMarc Zyngier }
190831d9d9b6SMarc Zyngier 
190931d9d9b6SMarc Zyngier /**
191031d9d9b6SMarc Zyngier  *	request_percpu_irq - allocate a percpu interrupt line
191131d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
191231d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
191331d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
191431d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
191531d9d9b6SMarc Zyngier  *
1916a1b7febdSMaxime Ripard  *	This call allocates interrupt resources and enables the
1917a1b7febdSMaxime Ripard  *	interrupt on the local CPU. If the interrupt is supposed to be
1918a1b7febdSMaxime Ripard  *	enabled on other CPUs, it has to be done on each CPU using
1919a1b7febdSMaxime Ripard  *	enable_percpu_irq().
192031d9d9b6SMarc Zyngier  *
192131d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
192231d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
192331d9d9b6SMarc Zyngier  *	that variable.
192431d9d9b6SMarc Zyngier  */
192531d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler,
192631d9d9b6SMarc Zyngier 		       const char *devname, void __percpu *dev_id)
192731d9d9b6SMarc Zyngier {
192831d9d9b6SMarc Zyngier 	struct irqaction *action;
192931d9d9b6SMarc Zyngier 	struct irq_desc *desc;
193031d9d9b6SMarc Zyngier 	int retval;
193131d9d9b6SMarc Zyngier 
193231d9d9b6SMarc Zyngier 	if (!dev_id)
193331d9d9b6SMarc Zyngier 		return -EINVAL;
193431d9d9b6SMarc Zyngier 
193531d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
193631d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
193731d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
193831d9d9b6SMarc Zyngier 		return -EINVAL;
193931d9d9b6SMarc Zyngier 
194031d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
194131d9d9b6SMarc Zyngier 	if (!action)
194231d9d9b6SMarc Zyngier 		return -ENOMEM;
194331d9d9b6SMarc Zyngier 
194431d9d9b6SMarc Zyngier 	action->handler = handler;
19452ed0e645SMarc Zyngier 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
194631d9d9b6SMarc Zyngier 	action->name = devname;
194731d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
194831d9d9b6SMarc Zyngier 
194931d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
195031d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
195131d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
195231d9d9b6SMarc Zyngier 
195331d9d9b6SMarc Zyngier 	if (retval)
195431d9d9b6SMarc Zyngier 		kfree(action);
195531d9d9b6SMarc Zyngier 
195631d9d9b6SMarc Zyngier 	return retval;
195731d9d9b6SMarc Zyngier }
1958aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(request_percpu_irq);
19591b7047edSMarc Zyngier 
19601b7047edSMarc Zyngier /**
19611b7047edSMarc Zyngier  *	irq_get_irqchip_state - returns the irqchip state of a interrupt.
19621b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
19631b7047edSMarc Zyngier  *	@which: One of IRQCHIP_STATE_* the caller wants to know about
19641b7047edSMarc Zyngier  *	@state: a pointer to a boolean where the state is to be storeed
19651b7047edSMarc Zyngier  *
19661b7047edSMarc Zyngier  *	This call snapshots the internal irqchip state of an
19671b7047edSMarc Zyngier  *	interrupt, returning into @state the bit corresponding to
19681b7047edSMarc Zyngier  *	stage @which
19691b7047edSMarc Zyngier  *
19701b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
19711b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
19721b7047edSMarc Zyngier  */
19731b7047edSMarc Zyngier int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
19741b7047edSMarc Zyngier 			  bool *state)
19751b7047edSMarc Zyngier {
19761b7047edSMarc Zyngier 	struct irq_desc *desc;
19771b7047edSMarc Zyngier 	struct irq_data *data;
19781b7047edSMarc Zyngier 	struct irq_chip *chip;
19791b7047edSMarc Zyngier 	unsigned long flags;
19801b7047edSMarc Zyngier 	int err = -EINVAL;
19811b7047edSMarc Zyngier 
19821b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
19831b7047edSMarc Zyngier 	if (!desc)
19841b7047edSMarc Zyngier 		return err;
19851b7047edSMarc Zyngier 
19861b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
19871b7047edSMarc Zyngier 
19881b7047edSMarc Zyngier 	do {
19891b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
19901b7047edSMarc Zyngier 		if (chip->irq_get_irqchip_state)
19911b7047edSMarc Zyngier 			break;
19921b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
19931b7047edSMarc Zyngier 		data = data->parent_data;
19941b7047edSMarc Zyngier #else
19951b7047edSMarc Zyngier 		data = NULL;
19961b7047edSMarc Zyngier #endif
19971b7047edSMarc Zyngier 	} while (data);
19981b7047edSMarc Zyngier 
19991b7047edSMarc Zyngier 	if (data)
20001b7047edSMarc Zyngier 		err = chip->irq_get_irqchip_state(data, which, state);
20011b7047edSMarc Zyngier 
20021b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
20031b7047edSMarc Zyngier 	return err;
20041b7047edSMarc Zyngier }
20051ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_get_irqchip_state);
20061b7047edSMarc Zyngier 
20071b7047edSMarc Zyngier /**
20081b7047edSMarc Zyngier  *	irq_set_irqchip_state - set the state of a forwarded interrupt.
20091b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
20101b7047edSMarc Zyngier  *	@which: State to be restored (one of IRQCHIP_STATE_*)
20111b7047edSMarc Zyngier  *	@val: Value corresponding to @which
20121b7047edSMarc Zyngier  *
20131b7047edSMarc Zyngier  *	This call sets the internal irqchip state of an interrupt,
20141b7047edSMarc Zyngier  *	depending on the value of @which.
20151b7047edSMarc Zyngier  *
20161b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
20171b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
20181b7047edSMarc Zyngier  */
20191b7047edSMarc Zyngier int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
20201b7047edSMarc Zyngier 			  bool val)
20211b7047edSMarc Zyngier {
20221b7047edSMarc Zyngier 	struct irq_desc *desc;
20231b7047edSMarc Zyngier 	struct irq_data *data;
20241b7047edSMarc Zyngier 	struct irq_chip *chip;
20251b7047edSMarc Zyngier 	unsigned long flags;
20261b7047edSMarc Zyngier 	int err = -EINVAL;
20271b7047edSMarc Zyngier 
20281b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
20291b7047edSMarc Zyngier 	if (!desc)
20301b7047edSMarc Zyngier 		return err;
20311b7047edSMarc Zyngier 
20321b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
20331b7047edSMarc Zyngier 
20341b7047edSMarc Zyngier 	do {
20351b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
20361b7047edSMarc Zyngier 		if (chip->irq_set_irqchip_state)
20371b7047edSMarc Zyngier 			break;
20381b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
20391b7047edSMarc Zyngier 		data = data->parent_data;
20401b7047edSMarc Zyngier #else
20411b7047edSMarc Zyngier 		data = NULL;
20421b7047edSMarc Zyngier #endif
20431b7047edSMarc Zyngier 	} while (data);
20441b7047edSMarc Zyngier 
20451b7047edSMarc Zyngier 	if (data)
20461b7047edSMarc Zyngier 		err = chip->irq_set_irqchip_state(data, which, val);
20471b7047edSMarc Zyngier 
20481b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
20491b7047edSMarc Zyngier 	return err;
20501b7047edSMarc Zyngier }
20511ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_set_irqchip_state);
2052