xref: /openbmc/linux/kernel/irq/manage.c (revision fa07ab72cbb0d843429e61bf179308aed6cbe0dd)
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>
200881e7bdSIngo Molnar #include <linux/sched/task.h>
21ae7e81c0SIngo Molnar #include <uapi/linux/sched/types.h>
224d1d61a6SOleg Nesterov #include <linux/task_work.h>
231da177e4SLinus Torvalds 
241da177e4SLinus Torvalds #include "internals.h"
251da177e4SLinus Torvalds 
268d32a307SThomas Gleixner #ifdef CONFIG_IRQ_FORCED_THREADING
278d32a307SThomas Gleixner __read_mostly bool force_irqthreads;
288d32a307SThomas Gleixner 
298d32a307SThomas Gleixner static int __init setup_forced_irqthreads(char *arg)
308d32a307SThomas Gleixner {
318d32a307SThomas Gleixner 	force_irqthreads = true;
328d32a307SThomas Gleixner 	return 0;
338d32a307SThomas Gleixner }
348d32a307SThomas Gleixner early_param("threadirqs", setup_forced_irqthreads);
358d32a307SThomas Gleixner #endif
368d32a307SThomas Gleixner 
3718258f72SThomas Gleixner static void __synchronize_hardirq(struct irq_desc *desc)
381da177e4SLinus Torvalds {
3932f4125eSThomas Gleixner 	bool inprogress;
401da177e4SLinus Torvalds 
41a98ce5c6SHerbert Xu 	do {
42a98ce5c6SHerbert Xu 		unsigned long flags;
43a98ce5c6SHerbert Xu 
44a98ce5c6SHerbert Xu 		/*
45a98ce5c6SHerbert Xu 		 * Wait until we're out of the critical section.  This might
46a98ce5c6SHerbert Xu 		 * give the wrong answer due to the lack of memory barriers.
47a98ce5c6SHerbert Xu 		 */
4832f4125eSThomas Gleixner 		while (irqd_irq_inprogress(&desc->irq_data))
491da177e4SLinus Torvalds 			cpu_relax();
50a98ce5c6SHerbert Xu 
51a98ce5c6SHerbert Xu 		/* Ok, that indicated we're done: double-check carefully. */
52239007b8SThomas Gleixner 		raw_spin_lock_irqsave(&desc->lock, flags);
5332f4125eSThomas Gleixner 		inprogress = irqd_irq_inprogress(&desc->irq_data);
54239007b8SThomas Gleixner 		raw_spin_unlock_irqrestore(&desc->lock, flags);
55a98ce5c6SHerbert Xu 
56a98ce5c6SHerbert Xu 		/* Oops, that failed? */
5732f4125eSThomas Gleixner 	} while (inprogress);
5818258f72SThomas Gleixner }
593aa551c9SThomas Gleixner 
6018258f72SThomas Gleixner /**
6118258f72SThomas Gleixner  *	synchronize_hardirq - wait for pending hard IRQ handlers (on other CPUs)
6218258f72SThomas Gleixner  *	@irq: interrupt number to wait for
6318258f72SThomas Gleixner  *
6418258f72SThomas Gleixner  *	This function waits for any pending hard IRQ handlers for this
6518258f72SThomas Gleixner  *	interrupt to complete before returning. If you use this
6618258f72SThomas Gleixner  *	function while holding a resource the IRQ handler may need you
6718258f72SThomas Gleixner  *	will deadlock. It does not take associated threaded handlers
6818258f72SThomas Gleixner  *	into account.
6918258f72SThomas Gleixner  *
7018258f72SThomas Gleixner  *	Do not use this for shutdown scenarios where you must be sure
7118258f72SThomas Gleixner  *	that all parts (hardirq and threaded handler) have completed.
7218258f72SThomas Gleixner  *
7302cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
7402cea395SPeter Zijlstra  *
7518258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
763aa551c9SThomas Gleixner  */
7702cea395SPeter Zijlstra bool synchronize_hardirq(unsigned int irq)
7818258f72SThomas Gleixner {
7918258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
8018258f72SThomas Gleixner 
8102cea395SPeter Zijlstra 	if (desc) {
8218258f72SThomas Gleixner 		__synchronize_hardirq(desc);
8302cea395SPeter Zijlstra 		return !atomic_read(&desc->threads_active);
8402cea395SPeter Zijlstra 	}
8502cea395SPeter Zijlstra 
8602cea395SPeter Zijlstra 	return true;
8718258f72SThomas Gleixner }
8818258f72SThomas Gleixner EXPORT_SYMBOL(synchronize_hardirq);
8918258f72SThomas Gleixner 
9018258f72SThomas Gleixner /**
9118258f72SThomas Gleixner  *	synchronize_irq - wait for pending IRQ handlers (on other CPUs)
9218258f72SThomas Gleixner  *	@irq: interrupt number to wait for
9318258f72SThomas Gleixner  *
9418258f72SThomas Gleixner  *	This function waits for any pending IRQ handlers for this interrupt
9518258f72SThomas Gleixner  *	to complete before returning. If you use this function while
9618258f72SThomas Gleixner  *	holding a resource the IRQ handler may need you will deadlock.
9718258f72SThomas Gleixner  *
9818258f72SThomas Gleixner  *	This function may be called - with care - from IRQ context.
9918258f72SThomas Gleixner  */
10018258f72SThomas Gleixner void synchronize_irq(unsigned int irq)
10118258f72SThomas Gleixner {
10218258f72SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
10318258f72SThomas Gleixner 
10418258f72SThomas Gleixner 	if (desc) {
10518258f72SThomas Gleixner 		__synchronize_hardirq(desc);
10618258f72SThomas Gleixner 		/*
10718258f72SThomas Gleixner 		 * We made sure that no hardirq handler is
10818258f72SThomas Gleixner 		 * running. Now verify that no threaded handlers are
10918258f72SThomas Gleixner 		 * active.
11018258f72SThomas Gleixner 		 */
11118258f72SThomas Gleixner 		wait_event(desc->wait_for_threads,
11218258f72SThomas Gleixner 			   !atomic_read(&desc->threads_active));
11318258f72SThomas Gleixner 	}
1141da177e4SLinus Torvalds }
1151da177e4SLinus Torvalds EXPORT_SYMBOL(synchronize_irq);
1161da177e4SLinus Torvalds 
1173aa551c9SThomas Gleixner #ifdef CONFIG_SMP
1183aa551c9SThomas Gleixner cpumask_var_t irq_default_affinity;
1193aa551c9SThomas Gleixner 
1209c255583SThomas Gleixner static bool __irq_can_set_affinity(struct irq_desc *desc)
121e019c249SJiang Liu {
122e019c249SJiang Liu 	if (!desc || !irqd_can_balance(&desc->irq_data) ||
123e019c249SJiang Liu 	    !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity)
1249c255583SThomas Gleixner 		return false;
1259c255583SThomas Gleixner 	return true;
126e019c249SJiang Liu }
127e019c249SJiang Liu 
128771ee3b0SThomas Gleixner /**
129771ee3b0SThomas Gleixner  *	irq_can_set_affinity - Check if the affinity of a given irq can be set
130771ee3b0SThomas Gleixner  *	@irq:		Interrupt to check
131771ee3b0SThomas Gleixner  *
132771ee3b0SThomas Gleixner  */
133771ee3b0SThomas Gleixner int irq_can_set_affinity(unsigned int irq)
134771ee3b0SThomas Gleixner {
135e019c249SJiang Liu 	return __irq_can_set_affinity(irq_to_desc(irq));
136771ee3b0SThomas Gleixner }
137771ee3b0SThomas Gleixner 
138591d2fb0SThomas Gleixner /**
1399c255583SThomas Gleixner  * irq_can_set_affinity_usr - Check if affinity of a irq can be set from user space
1409c255583SThomas Gleixner  * @irq:	Interrupt to check
1419c255583SThomas Gleixner  *
1429c255583SThomas Gleixner  * Like irq_can_set_affinity() above, but additionally checks for the
1439c255583SThomas Gleixner  * AFFINITY_MANAGED flag.
1449c255583SThomas Gleixner  */
1459c255583SThomas Gleixner bool irq_can_set_affinity_usr(unsigned int irq)
1469c255583SThomas Gleixner {
1479c255583SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1489c255583SThomas Gleixner 
1499c255583SThomas Gleixner 	return __irq_can_set_affinity(desc) &&
1509c255583SThomas Gleixner 		!irqd_affinity_is_managed(&desc->irq_data);
1519c255583SThomas Gleixner }
1529c255583SThomas Gleixner 
1539c255583SThomas Gleixner /**
154591d2fb0SThomas Gleixner  *	irq_set_thread_affinity - Notify irq threads to adjust affinity
155591d2fb0SThomas Gleixner  *	@desc:		irq descriptor which has affitnity changed
156591d2fb0SThomas Gleixner  *
157591d2fb0SThomas Gleixner  *	We just set IRQTF_AFFINITY and delegate the affinity setting
158591d2fb0SThomas Gleixner  *	to the interrupt thread itself. We can not call
159591d2fb0SThomas Gleixner  *	set_cpus_allowed_ptr() here as we hold desc->lock and this
160591d2fb0SThomas Gleixner  *	code can be called from hard interrupt context.
161591d2fb0SThomas Gleixner  */
162591d2fb0SThomas Gleixner void irq_set_thread_affinity(struct irq_desc *desc)
1633aa551c9SThomas Gleixner {
164f944b5a7SDaniel Lezcano 	struct irqaction *action;
1653aa551c9SThomas Gleixner 
166f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action)
1673aa551c9SThomas Gleixner 		if (action->thread)
168591d2fb0SThomas Gleixner 			set_bit(IRQTF_AFFINITY, &action->thread_flags);
1693aa551c9SThomas Gleixner }
1703aa551c9SThomas Gleixner 
1711fa46f1fSThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ
1720ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data)
1731fa46f1fSThomas Gleixner {
1740ef5ca1eSThomas Gleixner 	return irqd_can_move_in_process_context(data);
1751fa46f1fSThomas Gleixner }
1760ef5ca1eSThomas Gleixner static inline bool irq_move_pending(struct irq_data *data)
1771fa46f1fSThomas Gleixner {
1780ef5ca1eSThomas Gleixner 	return irqd_is_setaffinity_pending(data);
1791fa46f1fSThomas Gleixner }
1801fa46f1fSThomas Gleixner static inline void
1811fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask)
1821fa46f1fSThomas Gleixner {
1831fa46f1fSThomas Gleixner 	cpumask_copy(desc->pending_mask, mask);
1841fa46f1fSThomas Gleixner }
1851fa46f1fSThomas Gleixner static inline void
1861fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc)
1871fa46f1fSThomas Gleixner {
1881fa46f1fSThomas Gleixner 	cpumask_copy(mask, desc->pending_mask);
1891fa46f1fSThomas Gleixner }
1901fa46f1fSThomas Gleixner #else
1910ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; }
192cd22c0e4SThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) { return false; }
1931fa46f1fSThomas Gleixner static inline void
1941fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { }
1951fa46f1fSThomas Gleixner static inline void
1961fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { }
1971fa46f1fSThomas Gleixner #endif
1981fa46f1fSThomas Gleixner 
199818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
200818b0f3bSJiang Liu 			bool force)
201818b0f3bSJiang Liu {
202818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
203818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
204818b0f3bSJiang Liu 	int ret;
205818b0f3bSJiang Liu 
20601f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
207818b0f3bSJiang Liu 	switch (ret) {
208818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
2092cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
2109df872faSJiang Liu 		cpumask_copy(desc->irq_common_data.affinity, mask);
211818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
212818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
213818b0f3bSJiang Liu 		ret = 0;
214818b0f3bSJiang Liu 	}
215818b0f3bSJiang Liu 
216818b0f3bSJiang Liu 	return ret;
217818b0f3bSJiang Liu }
218818b0f3bSJiang Liu 
21901f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
22001f8fa4fSThomas Gleixner 			    bool force)
221c2d0c555SDavid Daney {
222c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
223c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
224c2d0c555SDavid Daney 	int ret = 0;
225c2d0c555SDavid Daney 
226c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
227c2d0c555SDavid Daney 		return -EINVAL;
228c2d0c555SDavid Daney 
2290ef5ca1eSThomas Gleixner 	if (irq_can_move_pcntxt(data)) {
23001f8fa4fSThomas Gleixner 		ret = irq_do_set_affinity(data, mask, force);
231c2d0c555SDavid Daney 	} else {
232c2d0c555SDavid Daney 		irqd_set_move_pending(data);
233c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
234c2d0c555SDavid Daney 	}
235c2d0c555SDavid Daney 
236c2d0c555SDavid Daney 	if (desc->affinity_notify) {
237c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
238c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
239c2d0c555SDavid Daney 	}
240c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
241c2d0c555SDavid Daney 
242c2d0c555SDavid Daney 	return ret;
243c2d0c555SDavid Daney }
244c2d0c555SDavid Daney 
24501f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
246771ee3b0SThomas Gleixner {
24708678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
248f6d87f4bSThomas Gleixner 	unsigned long flags;
249c2d0c555SDavid Daney 	int ret;
250771ee3b0SThomas Gleixner 
251c2d0c555SDavid Daney 	if (!desc)
252771ee3b0SThomas Gleixner 		return -EINVAL;
253771ee3b0SThomas Gleixner 
254239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
25501f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
256239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2571fa46f1fSThomas Gleixner 	return ret;
258771ee3b0SThomas Gleixner }
259771ee3b0SThomas Gleixner 
260e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
261e7a297b0SPeter P Waskiewicz Jr {
262e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
26331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
264e7a297b0SPeter P Waskiewicz Jr 
265e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
266e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
267e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
26802725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
269e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
2704fe7ffb7SJesse Brandeburg 	if (m)
271e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
272e7a297b0SPeter P Waskiewicz Jr 	return 0;
273e7a297b0SPeter P Waskiewicz Jr }
274e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
275e7a297b0SPeter P Waskiewicz Jr 
276cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
277cd7eab44SBen Hutchings {
278cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
279cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
280cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
281cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
282cd7eab44SBen Hutchings 	unsigned long flags;
283cd7eab44SBen Hutchings 
2841fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
285cd7eab44SBen Hutchings 		goto out;
286cd7eab44SBen Hutchings 
287cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
2880ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
2891fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
290cd7eab44SBen Hutchings 	else
2919df872faSJiang Liu 		cpumask_copy(cpumask, desc->irq_common_data.affinity);
292cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
293cd7eab44SBen Hutchings 
294cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
295cd7eab44SBen Hutchings 
296cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
297cd7eab44SBen Hutchings out:
298cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
299cd7eab44SBen Hutchings }
300cd7eab44SBen Hutchings 
301cd7eab44SBen Hutchings /**
302cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
303cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
304cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
305cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
306cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
307cd7eab44SBen Hutchings  *
308cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
309cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
310cd7eab44SBen Hutchings  *	freed using free_irq().
311cd7eab44SBen Hutchings  */
312cd7eab44SBen Hutchings int
313cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
314cd7eab44SBen Hutchings {
315cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
316cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
317cd7eab44SBen Hutchings 	unsigned long flags;
318cd7eab44SBen Hutchings 
319cd7eab44SBen Hutchings 	/* The release function is promised process context */
320cd7eab44SBen Hutchings 	might_sleep();
321cd7eab44SBen Hutchings 
322cd7eab44SBen Hutchings 	if (!desc)
323cd7eab44SBen Hutchings 		return -EINVAL;
324cd7eab44SBen Hutchings 
325cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
326cd7eab44SBen Hutchings 	if (notify) {
327cd7eab44SBen Hutchings 		notify->irq = irq;
328cd7eab44SBen Hutchings 		kref_init(&notify->kref);
329cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
330cd7eab44SBen Hutchings 	}
331cd7eab44SBen Hutchings 
332cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
333cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
334cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
335cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
336cd7eab44SBen Hutchings 
337cd7eab44SBen Hutchings 	if (old_notify)
338cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
339cd7eab44SBen Hutchings 
340cd7eab44SBen Hutchings 	return 0;
341cd7eab44SBen Hutchings }
342cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
343cd7eab44SBen Hutchings 
34418404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
34518404756SMax Krasnyansky /*
34618404756SMax Krasnyansky  * Generic version of the affinity autoselector.
34718404756SMax Krasnyansky  */
348a8a98eacSJiang Liu static int setup_affinity(struct irq_desc *desc, struct cpumask *mask)
34918404756SMax Krasnyansky {
350569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
3516783011bSJiang Liu 	int node = irq_desc_get_node(desc);
352569bda8dSThomas Gleixner 
353b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
354e019c249SJiang Liu 	if (!__irq_can_set_affinity(desc))
35518404756SMax Krasnyansky 		return 0;
35618404756SMax Krasnyansky 
357f6d87f4bSThomas Gleixner 	/*
3589332ef9dSMasahiro Yamada 	 * Preserve the managed affinity setting and a userspace affinity
35906ee6d57SThomas Gleixner 	 * setup, but make sure that one of the targets is online.
360f6d87f4bSThomas Gleixner 	 */
36106ee6d57SThomas Gleixner 	if (irqd_affinity_is_managed(&desc->irq_data) ||
36206ee6d57SThomas Gleixner 	    irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
3639df872faSJiang Liu 		if (cpumask_intersects(desc->irq_common_data.affinity,
364569bda8dSThomas Gleixner 				       cpu_online_mask))
3659df872faSJiang Liu 			set = desc->irq_common_data.affinity;
3660c6f8a8bSThomas Gleixner 		else
3672bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3682bdd1055SThomas Gleixner 	}
36918404756SMax Krasnyansky 
3703b8249e7SThomas Gleixner 	cpumask_and(mask, cpu_online_mask, set);
371241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
372241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
373241fc640SPrarit Bhargava 
374241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
375241fc640SPrarit Bhargava 		if (cpumask_intersects(mask, nodemask))
376241fc640SPrarit Bhargava 			cpumask_and(mask, mask, nodemask);
377241fc640SPrarit Bhargava 	}
378818b0f3bSJiang Liu 	irq_do_set_affinity(&desc->irq_data, mask, false);
37918404756SMax Krasnyansky 	return 0;
38018404756SMax Krasnyansky }
381f6d87f4bSThomas Gleixner #else
382a8a98eacSJiang Liu /* Wrapper for ALPHA specific affinity selector magic */
383a8a98eacSJiang Liu static inline int setup_affinity(struct irq_desc *d, struct cpumask *mask)
384f6d87f4bSThomas Gleixner {
385a8a98eacSJiang Liu 	return irq_select_affinity(irq_desc_get_irq(d));
386f6d87f4bSThomas Gleixner }
38718404756SMax Krasnyansky #endif
38818404756SMax Krasnyansky 
389f6d87f4bSThomas Gleixner /*
390f6d87f4bSThomas Gleixner  * Called when affinity is set via /proc/irq
391f6d87f4bSThomas Gleixner  */
3923b8249e7SThomas Gleixner int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask)
393f6d87f4bSThomas Gleixner {
394f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
395f6d87f4bSThomas Gleixner 	unsigned long flags;
396f6d87f4bSThomas Gleixner 	int ret;
397f6d87f4bSThomas Gleixner 
398239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
399a8a98eacSJiang Liu 	ret = setup_affinity(desc, mask);
400239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
401f6d87f4bSThomas Gleixner 	return ret;
402f6d87f4bSThomas Gleixner }
403f6d87f4bSThomas Gleixner 
404f6d87f4bSThomas Gleixner #else
4053b8249e7SThomas Gleixner static inline int
406a8a98eacSJiang Liu setup_affinity(struct irq_desc *desc, struct cpumask *mask)
407f6d87f4bSThomas Gleixner {
408f6d87f4bSThomas Gleixner 	return 0;
409f6d87f4bSThomas Gleixner }
4101da177e4SLinus Torvalds #endif
4111da177e4SLinus Torvalds 
412fcf1ae2fSFeng Wu /**
413fcf1ae2fSFeng Wu  *	irq_set_vcpu_affinity - Set vcpu affinity for the interrupt
414fcf1ae2fSFeng Wu  *	@irq: interrupt number to set affinity
415fcf1ae2fSFeng Wu  *	@vcpu_info: vCPU specific data
416fcf1ae2fSFeng Wu  *
417fcf1ae2fSFeng Wu  *	This function uses the vCPU specific data to set the vCPU
418fcf1ae2fSFeng Wu  *	affinity for an irq. The vCPU specific data is passed from
419fcf1ae2fSFeng Wu  *	outside, such as KVM. One example code path is as below:
420fcf1ae2fSFeng Wu  *	KVM -> IOMMU -> irq_set_vcpu_affinity().
421fcf1ae2fSFeng Wu  */
422fcf1ae2fSFeng Wu int irq_set_vcpu_affinity(unsigned int irq, void *vcpu_info)
423fcf1ae2fSFeng Wu {
424fcf1ae2fSFeng Wu 	unsigned long flags;
425fcf1ae2fSFeng Wu 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
426fcf1ae2fSFeng Wu 	struct irq_data *data;
427fcf1ae2fSFeng Wu 	struct irq_chip *chip;
428fcf1ae2fSFeng Wu 	int ret = -ENOSYS;
429fcf1ae2fSFeng Wu 
430fcf1ae2fSFeng Wu 	if (!desc)
431fcf1ae2fSFeng Wu 		return -EINVAL;
432fcf1ae2fSFeng Wu 
433fcf1ae2fSFeng Wu 	data = irq_desc_get_irq_data(desc);
434fcf1ae2fSFeng Wu 	chip = irq_data_get_irq_chip(data);
435fcf1ae2fSFeng Wu 	if (chip && chip->irq_set_vcpu_affinity)
436fcf1ae2fSFeng Wu 		ret = chip->irq_set_vcpu_affinity(data, vcpu_info);
437fcf1ae2fSFeng Wu 	irq_put_desc_unlock(desc, flags);
438fcf1ae2fSFeng Wu 
439fcf1ae2fSFeng Wu 	return ret;
440fcf1ae2fSFeng Wu }
441fcf1ae2fSFeng Wu EXPORT_SYMBOL_GPL(irq_set_vcpu_affinity);
442fcf1ae2fSFeng Wu 
44379ff1cdaSJiang Liu void __disable_irq(struct irq_desc *desc)
4440a0c5168SRafael J. Wysocki {
4453aae994fSThomas Gleixner 	if (!desc->depth++)
44687923470SThomas Gleixner 		irq_disable(desc);
4470a0c5168SRafael J. Wysocki }
4480a0c5168SRafael J. Wysocki 
44902725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
45002725e74SThomas Gleixner {
45102725e74SThomas Gleixner 	unsigned long flags;
45231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
45302725e74SThomas Gleixner 
45402725e74SThomas Gleixner 	if (!desc)
45502725e74SThomas Gleixner 		return -EINVAL;
45679ff1cdaSJiang Liu 	__disable_irq(desc);
45702725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
45802725e74SThomas Gleixner 	return 0;
45902725e74SThomas Gleixner }
46002725e74SThomas Gleixner 
4611da177e4SLinus Torvalds /**
4621da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4631da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4641da177e4SLinus Torvalds  *
4651da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4661da177e4SLinus Torvalds  *	nested.
4671da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
4681da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
4691da177e4SLinus Torvalds  *
4701da177e4SLinus Torvalds  *	This function may be called from IRQ context.
4711da177e4SLinus Torvalds  */
4721da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
4731da177e4SLinus Torvalds {
47402725e74SThomas Gleixner 	__disable_irq_nosync(irq);
4751da177e4SLinus Torvalds }
4761da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
4771da177e4SLinus Torvalds 
4781da177e4SLinus Torvalds /**
4791da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
4801da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4811da177e4SLinus Torvalds  *
4821da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
4831da177e4SLinus Torvalds  *	nested.
4841da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
4851da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
4861da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
4871da177e4SLinus Torvalds  *
4881da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
4891da177e4SLinus Torvalds  */
4901da177e4SLinus Torvalds void disable_irq(unsigned int irq)
4911da177e4SLinus Torvalds {
49202725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
4931da177e4SLinus Torvalds 		synchronize_irq(irq);
4941da177e4SLinus Torvalds }
4951da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
4961da177e4SLinus Torvalds 
49702cea395SPeter Zijlstra /**
49802cea395SPeter Zijlstra  *	disable_hardirq - disables an irq and waits for hardirq completion
49902cea395SPeter Zijlstra  *	@irq: Interrupt to disable
50002cea395SPeter Zijlstra  *
50102cea395SPeter Zijlstra  *	Disable the selected interrupt line.  Enables and Disables are
50202cea395SPeter Zijlstra  *	nested.
50302cea395SPeter Zijlstra  *	This function waits for any pending hard IRQ handlers for this
50402cea395SPeter Zijlstra  *	interrupt to complete before returning. If you use this function while
50502cea395SPeter Zijlstra  *	holding a resource the hard IRQ handler may need you will deadlock.
50602cea395SPeter Zijlstra  *
50702cea395SPeter Zijlstra  *	When used to optimistically disable an interrupt from atomic context
50802cea395SPeter Zijlstra  *	the return value must be checked.
50902cea395SPeter Zijlstra  *
51002cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
51102cea395SPeter Zijlstra  *
51202cea395SPeter Zijlstra  *	This function may be called - with care - from IRQ context.
51302cea395SPeter Zijlstra  */
51402cea395SPeter Zijlstra bool disable_hardirq(unsigned int irq)
51502cea395SPeter Zijlstra {
51602cea395SPeter Zijlstra 	if (!__disable_irq_nosync(irq))
51702cea395SPeter Zijlstra 		return synchronize_hardirq(irq);
51802cea395SPeter Zijlstra 
51902cea395SPeter Zijlstra 	return false;
52002cea395SPeter Zijlstra }
52102cea395SPeter Zijlstra EXPORT_SYMBOL_GPL(disable_hardirq);
52202cea395SPeter Zijlstra 
52379ff1cdaSJiang Liu void __enable_irq(struct irq_desc *desc)
5241adb0850SThomas Gleixner {
5251adb0850SThomas Gleixner 	switch (desc->depth) {
5261adb0850SThomas Gleixner 	case 0:
5270a0c5168SRafael J. Wysocki  err_out:
52879ff1cdaSJiang Liu 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n",
52979ff1cdaSJiang Liu 		     irq_desc_get_irq(desc));
5301adb0850SThomas Gleixner 		break;
5311adb0850SThomas Gleixner 	case 1: {
532c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
5330a0c5168SRafael J. Wysocki 			goto err_out;
5341adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
5351ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
5363aae994fSThomas Gleixner 		irq_enable(desc);
5370798abebSJiang Liu 		check_irq_resend(desc);
5381adb0850SThomas Gleixner 		/* fall-through */
5391adb0850SThomas Gleixner 	}
5401adb0850SThomas Gleixner 	default:
5411adb0850SThomas Gleixner 		desc->depth--;
5421adb0850SThomas Gleixner 	}
5431adb0850SThomas Gleixner }
5441adb0850SThomas Gleixner 
5451da177e4SLinus Torvalds /**
5461da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
5471da177e4SLinus Torvalds  *	@irq: Interrupt to enable
5481da177e4SLinus Torvalds  *
5491da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
5501da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
5511da177e4SLinus Torvalds  *	IRQ line is re-enabled.
5521da177e4SLinus Torvalds  *
55370aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
5546b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
5551da177e4SLinus Torvalds  */
5561da177e4SLinus Torvalds void enable_irq(unsigned int irq)
5571da177e4SLinus Torvalds {
5581da177e4SLinus Torvalds 	unsigned long flags;
55931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5601da177e4SLinus Torvalds 
5617d94f7caSYinghai Lu 	if (!desc)
562c2b5a251SMatthew Wilcox 		return;
56350f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
5642656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
56502725e74SThomas Gleixner 		goto out;
5662656c366SThomas Gleixner 
56779ff1cdaSJiang Liu 	__enable_irq(desc);
56802725e74SThomas Gleixner out:
56902725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
5701da177e4SLinus Torvalds }
5711da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
5721da177e4SLinus Torvalds 
5730c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
5742db87321SUwe Kleine-König {
57508678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
5762db87321SUwe Kleine-König 	int ret = -ENXIO;
5772db87321SUwe Kleine-König 
57860f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
57960f96b41SSantosh Shilimkar 		return 0;
58060f96b41SSantosh Shilimkar 
5812f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
5822f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
5832db87321SUwe Kleine-König 
5842db87321SUwe Kleine-König 	return ret;
5852db87321SUwe Kleine-König }
5862db87321SUwe Kleine-König 
587ba9a2331SThomas Gleixner /**
588a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
589ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
590ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
591ba9a2331SThomas Gleixner  *
59215a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
59315a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
59415a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
59515a647ebSDavid Brownell  *
59615a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
59715a647ebSDavid Brownell  *	states like "suspend to RAM".
598ba9a2331SThomas Gleixner  */
599a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
600ba9a2331SThomas Gleixner {
601ba9a2331SThomas Gleixner 	unsigned long flags;
60231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
6032db87321SUwe Kleine-König 	int ret = 0;
604ba9a2331SThomas Gleixner 
60513863a66SJesper Juhl 	if (!desc)
60613863a66SJesper Juhl 		return -EINVAL;
60713863a66SJesper Juhl 
60815a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
60915a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
61015a647ebSDavid Brownell 	 */
61115a647ebSDavid Brownell 	if (on) {
6122db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
6132db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6142db87321SUwe Kleine-König 			if (ret)
6152db87321SUwe Kleine-König 				desc->wake_depth = 0;
61615a647ebSDavid Brownell 			else
6177f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
6182db87321SUwe Kleine-König 		}
61915a647ebSDavid Brownell 	} else {
62015a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
6217a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
6222db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
6232db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6242db87321SUwe Kleine-König 			if (ret)
6252db87321SUwe Kleine-König 				desc->wake_depth = 1;
62615a647ebSDavid Brownell 			else
6277f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
62815a647ebSDavid Brownell 		}
6292db87321SUwe Kleine-König 	}
63002725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
631ba9a2331SThomas Gleixner 	return ret;
632ba9a2331SThomas Gleixner }
633a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
634ba9a2331SThomas Gleixner 
6351da177e4SLinus Torvalds /*
6361da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
6371da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
6381da177e4SLinus Torvalds  * for driver use.
6391da177e4SLinus Torvalds  */
6401da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
6411da177e4SLinus Torvalds {
642cc8c3b78SThomas Gleixner 	unsigned long flags;
64331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
64402725e74SThomas Gleixner 	int canrequest = 0;
6451da177e4SLinus Torvalds 
6467d94f7caSYinghai Lu 	if (!desc)
6477d94f7caSYinghai Lu 		return 0;
6487d94f7caSYinghai Lu 
64902725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
6502779db8dSBen Hutchings 		if (!desc->action ||
6512779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
65202725e74SThomas Gleixner 			canrequest = 1;
65302725e74SThomas Gleixner 	}
65402725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
65502725e74SThomas Gleixner 	return canrequest;
6561da177e4SLinus Torvalds }
6571da177e4SLinus Torvalds 
658a1ff541aSJiang Liu int __irq_set_trigger(struct irq_desc *desc, unsigned long flags)
65982736f4dSUwe Kleine-König {
6606b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
661d4d5e089SThomas Gleixner 	int ret, unmask = 0;
66282736f4dSUwe Kleine-König 
663b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
66482736f4dSUwe Kleine-König 		/*
66582736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
66682736f4dSUwe Kleine-König 		 * flow-types?
66782736f4dSUwe Kleine-König 		 */
668a1ff541aSJiang Liu 		pr_debug("No set_type function for IRQ %d (%s)\n",
669a1ff541aSJiang Liu 			 irq_desc_get_irq(desc),
67082736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
67182736f4dSUwe Kleine-König 		return 0;
67282736f4dSUwe Kleine-König 	}
67382736f4dSUwe Kleine-König 
674d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
67532f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
676d4d5e089SThomas Gleixner 			mask_irq(desc);
67732f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
678d4d5e089SThomas Gleixner 			unmask = 1;
679d4d5e089SThomas Gleixner 	}
680d4d5e089SThomas Gleixner 
68100b992deSAlexander Kuleshov 	/* Mask all flags except trigger mode */
68200b992deSAlexander Kuleshov 	flags &= IRQ_TYPE_SENSE_MASK;
683b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
68482736f4dSUwe Kleine-König 
685876dbd4cSThomas Gleixner 	switch (ret) {
686876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
6872cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
688876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
689876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
690876dbd4cSThomas Gleixner 
691876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
692876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
693876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
694876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
695876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
696876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
697876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
698876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
699876dbd4cSThomas Gleixner 		}
70046732475SThomas Gleixner 
701d4d5e089SThomas Gleixner 		ret = 0;
7028fff39e0SThomas Gleixner 		break;
703876dbd4cSThomas Gleixner 	default:
70497fd75b7SAndrew Morton 		pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
705a1ff541aSJiang Liu 		       flags, irq_desc_get_irq(desc), chip->irq_set_type);
7060c5d1eb7SDavid Brownell 	}
707d4d5e089SThomas Gleixner 	if (unmask)
708d4d5e089SThomas Gleixner 		unmask_irq(desc);
70982736f4dSUwe Kleine-König 	return ret;
71082736f4dSUwe Kleine-König }
71182736f4dSUwe Kleine-König 
712293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
713293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
714293a7a0aSThomas Gleixner {
715293a7a0aSThomas Gleixner 	unsigned long flags;
716293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
717293a7a0aSThomas Gleixner 
718293a7a0aSThomas Gleixner 	if (!desc)
719293a7a0aSThomas Gleixner 		return -EINVAL;
720293a7a0aSThomas Gleixner 
721293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
722293a7a0aSThomas Gleixner 
723293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
724293a7a0aSThomas Gleixner 	return 0;
725293a7a0aSThomas Gleixner }
7263118dac5SSudip Mukherjee EXPORT_SYMBOL_GPL(irq_set_parent);
727293a7a0aSThomas Gleixner #endif
728293a7a0aSThomas Gleixner 
729b25c340cSThomas Gleixner /*
730b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
731b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
732b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
733b25c340cSThomas Gleixner  */
734b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
735b25c340cSThomas Gleixner {
736b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
737b25c340cSThomas Gleixner }
738b25c340cSThomas Gleixner 
739399b5da2SThomas Gleixner /*
740399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
741399b5da2SThomas Gleixner  * called.
742399b5da2SThomas Gleixner  */
743399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
744399b5da2SThomas Gleixner {
745399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
746399b5da2SThomas Gleixner 	return IRQ_NONE;
747399b5da2SThomas Gleixner }
748399b5da2SThomas Gleixner 
7492a1d3ab8SThomas Gleixner static irqreturn_t irq_forced_secondary_handler(int irq, void *dev_id)
7502a1d3ab8SThomas Gleixner {
7512a1d3ab8SThomas Gleixner 	WARN(1, "Secondary action handler called for irq %d\n", irq);
7522a1d3ab8SThomas Gleixner 	return IRQ_NONE;
7532a1d3ab8SThomas Gleixner }
7542a1d3ab8SThomas Gleixner 
7553aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
7563aa551c9SThomas Gleixner {
7573aa551c9SThomas Gleixner 	set_current_state(TASK_INTERRUPTIBLE);
758f48fe81eSThomas Gleixner 
759550acb19SIdo Yariv 	while (!kthread_should_stop()) {
760550acb19SIdo Yariv 
761f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
762f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
7633aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
7643aa551c9SThomas Gleixner 			return 0;
765f48fe81eSThomas Gleixner 		}
7663aa551c9SThomas Gleixner 		schedule();
767550acb19SIdo Yariv 		set_current_state(TASK_INTERRUPTIBLE);
7683aa551c9SThomas Gleixner 	}
769550acb19SIdo Yariv 	__set_current_state(TASK_RUNNING);
7703aa551c9SThomas Gleixner 	return -1;
7713aa551c9SThomas Gleixner }
7723aa551c9SThomas Gleixner 
773b25c340cSThomas Gleixner /*
774b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
775b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
776b25c340cSThomas Gleixner  * is marked MASKED.
777b25c340cSThomas Gleixner  */
778b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
779f3f79e38SAlexander Gordeev 				 struct irqaction *action)
780b25c340cSThomas Gleixner {
7812a1d3ab8SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT) ||
7822a1d3ab8SThomas Gleixner 	    action->handler == irq_forced_secondary_handler)
783b5faba21SThomas Gleixner 		return;
7840b1adaa0SThomas Gleixner again:
7853876ec9eSThomas Gleixner 	chip_bus_lock(desc);
786239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
7870b1adaa0SThomas Gleixner 
7880b1adaa0SThomas Gleixner 	/*
7890b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
7900b1adaa0SThomas Gleixner 	 * the following scenario:
7910b1adaa0SThomas Gleixner 	 *
7920b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
7930b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
7940b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
795009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
796b5faba21SThomas Gleixner 	 *
797b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
798b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
799b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
800b5faba21SThomas Gleixner 	 * serialization.
8010b1adaa0SThomas Gleixner 	 */
80232f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
8030b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
8043876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
8050b1adaa0SThomas Gleixner 		cpu_relax();
8060b1adaa0SThomas Gleixner 		goto again;
8070b1adaa0SThomas Gleixner 	}
8080b1adaa0SThomas Gleixner 
809b5faba21SThomas Gleixner 	/*
810b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
811b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
812b5faba21SThomas Gleixner 	 * was just set.
813b5faba21SThomas Gleixner 	 */
814f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
815b5faba21SThomas Gleixner 		goto out_unlock;
816b5faba21SThomas Gleixner 
817b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
818b5faba21SThomas Gleixner 
81932f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
82032f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
821328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
82232f4125eSThomas Gleixner 
823b5faba21SThomas Gleixner out_unlock:
824239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
8253876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
826b25c340cSThomas Gleixner }
827b25c340cSThomas Gleixner 
82861f38261SBruno Premont #ifdef CONFIG_SMP
8293aa551c9SThomas Gleixner /*
830b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
831591d2fb0SThomas Gleixner  */
832591d2fb0SThomas Gleixner static void
833591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
834591d2fb0SThomas Gleixner {
835591d2fb0SThomas Gleixner 	cpumask_var_t mask;
83604aa530eSThomas Gleixner 	bool valid = true;
837591d2fb0SThomas Gleixner 
838591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
839591d2fb0SThomas Gleixner 		return;
840591d2fb0SThomas Gleixner 
841591d2fb0SThomas Gleixner 	/*
842591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
843591d2fb0SThomas Gleixner 	 * try again next time
844591d2fb0SThomas Gleixner 	 */
845591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
846591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
847591d2fb0SThomas Gleixner 		return;
848591d2fb0SThomas Gleixner 	}
849591d2fb0SThomas Gleixner 
850239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
85104aa530eSThomas Gleixner 	/*
85204aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
85304aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
85404aa530eSThomas Gleixner 	 */
855d170fe7dSMatthias Kaehlcke 	if (cpumask_available(desc->irq_common_data.affinity))
8569df872faSJiang Liu 		cpumask_copy(mask, desc->irq_common_data.affinity);
85704aa530eSThomas Gleixner 	else
85804aa530eSThomas Gleixner 		valid = false;
859239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
860591d2fb0SThomas Gleixner 
86104aa530eSThomas Gleixner 	if (valid)
862591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
863591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
864591d2fb0SThomas Gleixner }
86561f38261SBruno Premont #else
86661f38261SBruno Premont static inline void
86761f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
86861f38261SBruno Premont #endif
869591d2fb0SThomas Gleixner 
870591d2fb0SThomas Gleixner /*
8718d32a307SThomas Gleixner  * Interrupts which are not explicitely requested as threaded
8728d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
8738d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
8748d32a307SThomas Gleixner  * side effects.
8758d32a307SThomas Gleixner  */
8763a43e05fSSebastian Andrzej Siewior static irqreturn_t
8778d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
8788d32a307SThomas Gleixner {
8793a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8803a43e05fSSebastian Andrzej Siewior 
8818d32a307SThomas Gleixner 	local_bh_disable();
8823a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
883f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8848d32a307SThomas Gleixner 	local_bh_enable();
8853a43e05fSSebastian Andrzej Siewior 	return ret;
8868d32a307SThomas Gleixner }
8878d32a307SThomas Gleixner 
8888d32a307SThomas Gleixner /*
889f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
8908d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
8918d32a307SThomas Gleixner  * complete.
8928d32a307SThomas Gleixner  */
8933a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
8943a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
8958d32a307SThomas Gleixner {
8963a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8973a43e05fSSebastian Andrzej Siewior 
8983a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
899f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
9003a43e05fSSebastian Andrzej Siewior 	return ret;
9018d32a307SThomas Gleixner }
9028d32a307SThomas Gleixner 
9037140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
9047140ea19SIdo Yariv {
905c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
9067140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
9077140ea19SIdo Yariv }
9087140ea19SIdo Yariv 
90967d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
9104d1d61a6SOleg Nesterov {
9114d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
9124d1d61a6SOleg Nesterov 	struct irq_desc *desc;
9134d1d61a6SOleg Nesterov 	struct irqaction *action;
9144d1d61a6SOleg Nesterov 
9154d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
9164d1d61a6SOleg Nesterov 		return;
9174d1d61a6SOleg Nesterov 
9184d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
9194d1d61a6SOleg Nesterov 
920fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
92119af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
9224d1d61a6SOleg Nesterov 
9234d1d61a6SOleg Nesterov 
9244d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
9254d1d61a6SOleg Nesterov 	/*
9264d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
9274d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
9284d1d61a6SOleg Nesterov 	 */
9294d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
9304d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
9314d1d61a6SOleg Nesterov 
9324d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
9334d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
9344d1d61a6SOleg Nesterov }
9354d1d61a6SOleg Nesterov 
9362a1d3ab8SThomas Gleixner static void irq_wake_secondary(struct irq_desc *desc, struct irqaction *action)
9372a1d3ab8SThomas Gleixner {
9382a1d3ab8SThomas Gleixner 	struct irqaction *secondary = action->secondary;
9392a1d3ab8SThomas Gleixner 
9402a1d3ab8SThomas Gleixner 	if (WARN_ON_ONCE(!secondary))
9412a1d3ab8SThomas Gleixner 		return;
9422a1d3ab8SThomas Gleixner 
9432a1d3ab8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
9442a1d3ab8SThomas Gleixner 	__irq_wake_thread(desc, secondary);
9452a1d3ab8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
9462a1d3ab8SThomas Gleixner }
9472a1d3ab8SThomas Gleixner 
9488d32a307SThomas Gleixner /*
9493aa551c9SThomas Gleixner  * Interrupt handler thread
9503aa551c9SThomas Gleixner  */
9513aa551c9SThomas Gleixner static int irq_thread(void *data)
9523aa551c9SThomas Gleixner {
95367d12145SAl Viro 	struct callback_head on_exit_work;
9543aa551c9SThomas Gleixner 	struct irqaction *action = data;
9553aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
9563a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
9573a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
9583aa551c9SThomas Gleixner 
959540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
9608d32a307SThomas Gleixner 					&action->thread_flags))
9618d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
9628d32a307SThomas Gleixner 	else
9638d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
9648d32a307SThomas Gleixner 
96541f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
9664d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
9673aa551c9SThomas Gleixner 
968f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
969f3de44edSSankara Muthukrishnan 
9703aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
9717140ea19SIdo Yariv 		irqreturn_t action_ret;
9723aa551c9SThomas Gleixner 
973591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
974591d2fb0SThomas Gleixner 
9753a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
9761e77d0a1SThomas Gleixner 		if (action_ret == IRQ_HANDLED)
9771e77d0a1SThomas Gleixner 			atomic_inc(&desc->threads_handled);
9782a1d3ab8SThomas Gleixner 		if (action_ret == IRQ_WAKE_THREAD)
9792a1d3ab8SThomas Gleixner 			irq_wake_secondary(desc, action);
9807140ea19SIdo Yariv 
9817140ea19SIdo Yariv 		wake_threads_waitq(desc);
9823aa551c9SThomas Gleixner 	}
9833aa551c9SThomas Gleixner 
9847140ea19SIdo Yariv 	/*
9857140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
9867140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
9877140ea19SIdo Yariv 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
988e04268b0SThomas Gleixner 	 * oneshot mask bit can be set. We cannot verify that as we
989e04268b0SThomas Gleixner 	 * cannot touch the oneshot mask at this point anymore as
990e04268b0SThomas Gleixner 	 * __setup_irq() might have given out currents thread_mask
991e04268b0SThomas Gleixner 	 * again.
9923aa551c9SThomas Gleixner 	 */
9934d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
9943aa551c9SThomas Gleixner 	return 0;
9953aa551c9SThomas Gleixner }
9963aa551c9SThomas Gleixner 
997a92444c6SThomas Gleixner /**
998a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
999a92444c6SThomas Gleixner  *	@irq:		Interrupt line
1000a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
1001a92444c6SThomas Gleixner  *
1002a92444c6SThomas Gleixner  */
1003a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
1004a92444c6SThomas Gleixner {
1005a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1006a92444c6SThomas Gleixner 	struct irqaction *action;
1007a92444c6SThomas Gleixner 	unsigned long flags;
1008a92444c6SThomas Gleixner 
1009a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1010a92444c6SThomas Gleixner 		return;
1011a92444c6SThomas Gleixner 
1012a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1013f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action) {
1014a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
1015a92444c6SThomas Gleixner 			if (action->thread)
1016a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
1017a92444c6SThomas Gleixner 			break;
1018a92444c6SThomas Gleixner 		}
1019a92444c6SThomas Gleixner 	}
1020a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1021a92444c6SThomas Gleixner }
1022a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
1023a92444c6SThomas Gleixner 
10242a1d3ab8SThomas Gleixner static int irq_setup_forced_threading(struct irqaction *new)
10258d32a307SThomas Gleixner {
10268d32a307SThomas Gleixner 	if (!force_irqthreads)
10272a1d3ab8SThomas Gleixner 		return 0;
10288d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
10292a1d3ab8SThomas Gleixner 		return 0;
10308d32a307SThomas Gleixner 
10318d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
10328d32a307SThomas Gleixner 
10332a1d3ab8SThomas Gleixner 	/*
10342a1d3ab8SThomas Gleixner 	 * Handle the case where we have a real primary handler and a
10352a1d3ab8SThomas Gleixner 	 * thread handler. We force thread them as well by creating a
10362a1d3ab8SThomas Gleixner 	 * secondary action.
10372a1d3ab8SThomas Gleixner 	 */
10382a1d3ab8SThomas Gleixner 	if (new->handler != irq_default_primary_handler && new->thread_fn) {
10392a1d3ab8SThomas Gleixner 		/* Allocate the secondary action */
10402a1d3ab8SThomas Gleixner 		new->secondary = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
10412a1d3ab8SThomas Gleixner 		if (!new->secondary)
10422a1d3ab8SThomas Gleixner 			return -ENOMEM;
10432a1d3ab8SThomas Gleixner 		new->secondary->handler = irq_forced_secondary_handler;
10442a1d3ab8SThomas Gleixner 		new->secondary->thread_fn = new->thread_fn;
10452a1d3ab8SThomas Gleixner 		new->secondary->dev_id = new->dev_id;
10462a1d3ab8SThomas Gleixner 		new->secondary->irq = new->irq;
10472a1d3ab8SThomas Gleixner 		new->secondary->name = new->name;
10482a1d3ab8SThomas Gleixner 	}
10492a1d3ab8SThomas Gleixner 	/* Deal with the primary handler */
10508d32a307SThomas Gleixner 	set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
10518d32a307SThomas Gleixner 	new->thread_fn = new->handler;
10528d32a307SThomas Gleixner 	new->handler = irq_default_primary_handler;
10532a1d3ab8SThomas Gleixner 	return 0;
10548d32a307SThomas Gleixner }
10558d32a307SThomas Gleixner 
1056c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
1057c1bacbaeSThomas Gleixner {
1058c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1059c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1060c1bacbaeSThomas Gleixner 
1061c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
1062c1bacbaeSThomas Gleixner }
1063c1bacbaeSThomas Gleixner 
1064c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
1065c1bacbaeSThomas Gleixner {
1066c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1067c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1068c1bacbaeSThomas Gleixner 
1069c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
1070c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
1071c1bacbaeSThomas Gleixner }
1072c1bacbaeSThomas Gleixner 
10732a1d3ab8SThomas Gleixner static int
10742a1d3ab8SThomas Gleixner setup_irq_thread(struct irqaction *new, unsigned int irq, bool secondary)
10752a1d3ab8SThomas Gleixner {
10762a1d3ab8SThomas Gleixner 	struct task_struct *t;
10772a1d3ab8SThomas Gleixner 	struct sched_param param = {
10782a1d3ab8SThomas Gleixner 		.sched_priority = MAX_USER_RT_PRIO/2,
10792a1d3ab8SThomas Gleixner 	};
10802a1d3ab8SThomas Gleixner 
10812a1d3ab8SThomas Gleixner 	if (!secondary) {
10822a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
10832a1d3ab8SThomas Gleixner 				   new->name);
10842a1d3ab8SThomas Gleixner 	} else {
10852a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-s-%s", irq,
10862a1d3ab8SThomas Gleixner 				   new->name);
10872a1d3ab8SThomas Gleixner 		param.sched_priority -= 1;
10882a1d3ab8SThomas Gleixner 	}
10892a1d3ab8SThomas Gleixner 
10902a1d3ab8SThomas Gleixner 	if (IS_ERR(t))
10912a1d3ab8SThomas Gleixner 		return PTR_ERR(t);
10922a1d3ab8SThomas Gleixner 
10932a1d3ab8SThomas Gleixner 	sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
10942a1d3ab8SThomas Gleixner 
10952a1d3ab8SThomas Gleixner 	/*
10962a1d3ab8SThomas Gleixner 	 * We keep the reference to the task struct even if
10972a1d3ab8SThomas Gleixner 	 * the thread dies to avoid that the interrupt code
10982a1d3ab8SThomas Gleixner 	 * references an already freed task_struct.
10992a1d3ab8SThomas Gleixner 	 */
11002a1d3ab8SThomas Gleixner 	get_task_struct(t);
11012a1d3ab8SThomas Gleixner 	new->thread = t;
11022a1d3ab8SThomas Gleixner 	/*
11032a1d3ab8SThomas Gleixner 	 * Tell the thread to set its affinity. This is
11042a1d3ab8SThomas Gleixner 	 * important for shared interrupt handlers as we do
11052a1d3ab8SThomas Gleixner 	 * not invoke setup_affinity() for the secondary
11062a1d3ab8SThomas Gleixner 	 * handlers as everything is already set up. Even for
11072a1d3ab8SThomas Gleixner 	 * interrupts marked with IRQF_NO_BALANCE this is
11082a1d3ab8SThomas Gleixner 	 * correct as we want the thread to move to the cpu(s)
11092a1d3ab8SThomas Gleixner 	 * on which the requesting code placed the interrupt.
11102a1d3ab8SThomas Gleixner 	 */
11112a1d3ab8SThomas Gleixner 	set_bit(IRQTF_AFFINITY, &new->thread_flags);
11122a1d3ab8SThomas Gleixner 	return 0;
11132a1d3ab8SThomas Gleixner }
11142a1d3ab8SThomas Gleixner 
11151da177e4SLinus Torvalds /*
11161da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
11171da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
11181da177e4SLinus Torvalds  */
1119d3c60047SThomas Gleixner static int
1120d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
11211da177e4SLinus Torvalds {
1122f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
1123b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
11243b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
11253b8249e7SThomas Gleixner 	cpumask_var_t mask;
11261da177e4SLinus Torvalds 
11277d94f7caSYinghai Lu 	if (!desc)
1128c2b5a251SMatthew Wilcox 		return -EINVAL;
1129c2b5a251SMatthew Wilcox 
11306b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
11311da177e4SLinus Torvalds 		return -ENOSYS;
1132b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
1133b6873807SSebastian Andrzej Siewior 		return -ENODEV;
11341da177e4SLinus Torvalds 
11352a1d3ab8SThomas Gleixner 	new->irq = irq;
11362a1d3ab8SThomas Gleixner 
11371da177e4SLinus Torvalds 	/*
11384b357daeSJon Hunter 	 * If the trigger type is not specified by the caller,
11394b357daeSJon Hunter 	 * then use the default for this interrupt.
11404b357daeSJon Hunter 	 */
11414b357daeSJon Hunter 	if (!(new->flags & IRQF_TRIGGER_MASK))
11424b357daeSJon Hunter 		new->flags |= irqd_get_trigger_type(&desc->irq_data);
11434b357daeSJon Hunter 
11444b357daeSJon Hunter 	/*
1145399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
1146399b5da2SThomas Gleixner 	 * thread.
11473aa551c9SThomas Gleixner 	 */
11481ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
1149399b5da2SThomas Gleixner 	if (nested) {
1150b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
1151b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
1152b6873807SSebastian Andrzej Siewior 			goto out_mput;
1153b6873807SSebastian Andrzej Siewior 		}
1154399b5da2SThomas Gleixner 		/*
1155399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
1156399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
1157399b5da2SThomas Gleixner 		 * dummy function which warns when called.
1158399b5da2SThomas Gleixner 		 */
1159399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
11608d32a307SThomas Gleixner 	} else {
11612a1d3ab8SThomas Gleixner 		if (irq_settings_can_thread(desc)) {
11622a1d3ab8SThomas Gleixner 			ret = irq_setup_forced_threading(new);
11632a1d3ab8SThomas Gleixner 			if (ret)
11642a1d3ab8SThomas Gleixner 				goto out_mput;
11652a1d3ab8SThomas Gleixner 		}
1166399b5da2SThomas Gleixner 	}
1167399b5da2SThomas Gleixner 
1168399b5da2SThomas Gleixner 	/*
1169399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
1170399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
1171399b5da2SThomas Gleixner 	 * thread.
1172399b5da2SThomas Gleixner 	 */
1173399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
11742a1d3ab8SThomas Gleixner 		ret = setup_irq_thread(new, irq, false);
11752a1d3ab8SThomas Gleixner 		if (ret)
1176b6873807SSebastian Andrzej Siewior 			goto out_mput;
11772a1d3ab8SThomas Gleixner 		if (new->secondary) {
11782a1d3ab8SThomas Gleixner 			ret = setup_irq_thread(new->secondary, irq, true);
11792a1d3ab8SThomas Gleixner 			if (ret)
11802a1d3ab8SThomas Gleixner 				goto out_thread;
1181b6873807SSebastian Andrzej Siewior 		}
11823aa551c9SThomas Gleixner 	}
11833aa551c9SThomas Gleixner 
11843b8249e7SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
11853b8249e7SThomas Gleixner 		ret = -ENOMEM;
11863b8249e7SThomas Gleixner 		goto out_thread;
11873b8249e7SThomas Gleixner 	}
11883b8249e7SThomas Gleixner 
11893aa551c9SThomas Gleixner 	/*
1190dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1191dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1192dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1193dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1194dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1195dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1196dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1197dc9b229aSThomas Gleixner 	 */
1198dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1199dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1200dc9b229aSThomas Gleixner 
1201dc9b229aSThomas Gleixner 	/*
12021da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
12031da177e4SLinus Torvalds 	 */
1204239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1205f17c7545SIngo Molnar 	old_ptr = &desc->action;
1206f17c7545SIngo Molnar 	old = *old_ptr;
120706fcb0c6SIngo Molnar 	if (old) {
1208e76de9f8SThomas Gleixner 		/*
1209e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1210e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
12113cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
12129d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
12139d591eddSThomas Gleixner 		 * agree on ONESHOT.
1214e76de9f8SThomas Gleixner 		 */
1215382bd4deSHans de Goede 		unsigned int oldtype = irqd_get_trigger_type(&desc->irq_data);
1216382bd4deSHans de Goede 
12173cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
1218382bd4deSHans de Goede 		    (oldtype != (new->flags & IRQF_TRIGGER_MASK)) ||
1219f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1220f5163427SDimitri Sivanich 			goto mismatch;
1221f5163427SDimitri Sivanich 
1222f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
12233cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
12243cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1225f5163427SDimitri Sivanich 			goto mismatch;
12261da177e4SLinus Torvalds 
12271da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
12281da177e4SLinus Torvalds 		do {
122952abb700SThomas Gleixner 			/*
123052abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
123152abb700SThomas Gleixner 			 * so we can find the next zero bit for this
123252abb700SThomas Gleixner 			 * new action.
123352abb700SThomas Gleixner 			 */
1234b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1235f17c7545SIngo Molnar 			old_ptr = &old->next;
1236f17c7545SIngo Molnar 			old = *old_ptr;
12371da177e4SLinus Torvalds 		} while (old);
12381da177e4SLinus Torvalds 		shared = 1;
12391da177e4SLinus Torvalds 	}
12401da177e4SLinus Torvalds 
1241b5faba21SThomas Gleixner 	/*
124252abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
124352abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
124452abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1245b5faba21SThomas Gleixner 	 */
124652abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
124752abb700SThomas Gleixner 		/*
124852abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
124952abb700SThomas Gleixner 		 * but who knows.
125052abb700SThomas Gleixner 		 */
125152abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1252b5faba21SThomas Gleixner 			ret = -EBUSY;
1253b5faba21SThomas Gleixner 			goto out_mask;
1254b5faba21SThomas Gleixner 		}
125552abb700SThomas Gleixner 		/*
125652abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
125752abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
125852abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
125952abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
126052abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
126152abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
126252abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
126352abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
126452abb700SThomas Gleixner 		 *
126552abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
126652abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
126752abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
126852abb700SThomas Gleixner 		 * affected hard irq flow handlers
126952abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
127052abb700SThomas Gleixner 		 *
127152abb700SThomas Gleixner 		 * The new action gets the first zero bit of
127252abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
127352abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
127452abb700SThomas Gleixner 		 */
1275b5faba21SThomas Gleixner 		new->thread_mask = 1 << ffz(thread_mask);
12761c6c6952SThomas Gleixner 
1277dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1278dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
12791c6c6952SThomas Gleixner 		/*
12801c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
12811c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
12821c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
12831c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
12841c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
12851c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
12861c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
12871c6c6952SThomas Gleixner 		 *
12881c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
12891c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
12901c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
12911c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
12921c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
12931c6c6952SThomas Gleixner 		 */
129497fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
12951c6c6952SThomas Gleixner 		       irq);
12961c6c6952SThomas Gleixner 		ret = -EINVAL;
12971c6c6952SThomas Gleixner 		goto out_mask;
129852abb700SThomas Gleixner 	}
1299b5faba21SThomas Gleixner 
13001da177e4SLinus Torvalds 	if (!shared) {
1301c1bacbaeSThomas Gleixner 		ret = irq_request_resources(desc);
1302c1bacbaeSThomas Gleixner 		if (ret) {
1303c1bacbaeSThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
1304c1bacbaeSThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
1305c1bacbaeSThomas Gleixner 			goto out_mask;
1306c1bacbaeSThomas Gleixner 		}
1307c1bacbaeSThomas Gleixner 
13083aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
13093aa551c9SThomas Gleixner 
131082736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
131182736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1312a1ff541aSJiang Liu 			ret = __irq_set_trigger(desc,
1313f2b662daSDavid Brownell 						new->flags & IRQF_TRIGGER_MASK);
131482736f4dSUwe Kleine-König 
1315*fa07ab72SHeiner Kallweit 			if (ret) {
1316*fa07ab72SHeiner Kallweit 				irq_release_resources(desc);
13173b8249e7SThomas Gleixner 				goto out_mask;
1318091738a2SThomas Gleixner 			}
1319*fa07ab72SHeiner Kallweit 		}
1320f75d222bSAhmed S. Darwish 
1321009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
132232f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
132332f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
132494d39e1fSThomas Gleixner 
1325a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1326a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1327a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1328a005677bSThomas Gleixner 		}
13296a58fb3bSThomas Gleixner 
1330b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
13313d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1332b25c340cSThomas Gleixner 
13331ccb4e61SThomas Gleixner 		if (irq_settings_can_autoenable(desc))
1334b4bc724eSThomas Gleixner 			irq_startup(desc, true);
133546999238SThomas Gleixner 		else
1336e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1337e76de9f8SThomas Gleixner 			desc->depth = 1;
133818404756SMax Krasnyansky 
1339612e3684SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
1340a005677bSThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
1341a005677bSThomas Gleixner 			irq_settings_set_no_balancing(desc);
1342a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
1343a005677bSThomas Gleixner 		}
1344612e3684SThomas Gleixner 
134518404756SMax Krasnyansky 		/* Set default affinity mask once everything is setup */
1346a8a98eacSJiang Liu 		setup_affinity(desc, mask);
13470c5d1eb7SDavid Brownell 
1348876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1349876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
13507ee7e87dSThomas Gleixner 		unsigned int omsk = irqd_get_trigger_type(&desc->irq_data);
1351876dbd4cSThomas Gleixner 
1352876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1353876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
1354a395d6a7SJoe Perches 			pr_warn("irq %d uses trigger mode %u; requested %u\n",
13557ee7e87dSThomas Gleixner 				irq, omsk, nmsk);
135694d39e1fSThomas Gleixner 	}
135782736f4dSUwe Kleine-König 
1358f17c7545SIngo Molnar 	*old_ptr = new;
135982736f4dSUwe Kleine-König 
1360cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1361cab303beSThomas Gleixner 
13628528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
13638528b0f1SLinus Torvalds 	desc->irq_count = 0;
13648528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
13651adb0850SThomas Gleixner 
13661adb0850SThomas Gleixner 	/*
13671adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
13681adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
13691adb0850SThomas Gleixner 	 */
13707acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
13717acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
137279ff1cdaSJiang Liu 		__enable_irq(desc);
13731adb0850SThomas Gleixner 	}
13741adb0850SThomas Gleixner 
1375239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
13761da177e4SLinus Torvalds 
137769ab8494SThomas Gleixner 	/*
137869ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
137969ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
138069ab8494SThomas Gleixner 	 */
138169ab8494SThomas Gleixner 	if (new->thread)
138269ab8494SThomas Gleixner 		wake_up_process(new->thread);
13832a1d3ab8SThomas Gleixner 	if (new->secondary)
13842a1d3ab8SThomas Gleixner 		wake_up_process(new->secondary->thread);
138569ab8494SThomas Gleixner 
13862c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
13871da177e4SLinus Torvalds 	new->dir = NULL;
13881da177e4SLinus Torvalds 	register_handler_proc(irq, new);
13894f5058c3SXiaotian Feng 	free_cpumask_var(mask);
13901da177e4SLinus Torvalds 
13911da177e4SLinus Torvalds 	return 0;
1392f5163427SDimitri Sivanich 
1393f5163427SDimitri Sivanich mismatch:
13943cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
139597fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1396f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1397f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1398f5163427SDimitri Sivanich 		dump_stack();
13993f050447SAlan Cox #endif
1400f5d89470SThomas Gleixner 	}
14013aa551c9SThomas Gleixner 	ret = -EBUSY;
14023aa551c9SThomas Gleixner 
14033b8249e7SThomas Gleixner out_mask:
14041c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
14053b8249e7SThomas Gleixner 	free_cpumask_var(mask);
14063b8249e7SThomas Gleixner 
14073aa551c9SThomas Gleixner out_thread:
14083aa551c9SThomas Gleixner 	if (new->thread) {
14093aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
14103aa551c9SThomas Gleixner 
14113aa551c9SThomas Gleixner 		new->thread = NULL;
14123aa551c9SThomas Gleixner 		kthread_stop(t);
14133aa551c9SThomas Gleixner 		put_task_struct(t);
14143aa551c9SThomas Gleixner 	}
14152a1d3ab8SThomas Gleixner 	if (new->secondary && new->secondary->thread) {
14162a1d3ab8SThomas Gleixner 		struct task_struct *t = new->secondary->thread;
14172a1d3ab8SThomas Gleixner 
14182a1d3ab8SThomas Gleixner 		new->secondary->thread = NULL;
14192a1d3ab8SThomas Gleixner 		kthread_stop(t);
14202a1d3ab8SThomas Gleixner 		put_task_struct(t);
14212a1d3ab8SThomas Gleixner 	}
1422b6873807SSebastian Andrzej Siewior out_mput:
1423b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
14243aa551c9SThomas Gleixner 	return ret;
14251da177e4SLinus Torvalds }
14261da177e4SLinus Torvalds 
14271da177e4SLinus Torvalds /**
1428d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1429d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1430d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1431d3c60047SThomas Gleixner  *
1432d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1433d3c60047SThomas Gleixner  */
1434d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1435d3c60047SThomas Gleixner {
1436986c011dSDavid Daney 	int retval;
1437d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1438d3c60047SThomas Gleixner 
14399b5d585dSJon Hunter 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
144031d9d9b6SMarc Zyngier 		return -EINVAL;
1441be45beb2SJon Hunter 
1442be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
1443be45beb2SJon Hunter 	if (retval < 0)
1444be45beb2SJon Hunter 		return retval;
1445be45beb2SJon Hunter 
1446986c011dSDavid Daney 	chip_bus_lock(desc);
1447986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1448986c011dSDavid Daney 	chip_bus_sync_unlock(desc);
1449986c011dSDavid Daney 
1450be45beb2SJon Hunter 	if (retval)
1451be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
1452be45beb2SJon Hunter 
1453986c011dSDavid Daney 	return retval;
1454d3c60047SThomas Gleixner }
1455eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1456d3c60047SThomas Gleixner 
1457cbf94f06SMagnus Damm /*
1458cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1459cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
14601da177e4SLinus Torvalds  */
1461cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
14621da177e4SLinus Torvalds {
1463d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1464f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
14651da177e4SLinus Torvalds 	unsigned long flags;
14661da177e4SLinus Torvalds 
1467ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
14687d94f7caSYinghai Lu 
14697d94f7caSYinghai Lu 	if (!desc)
1470f21cfb25SMagnus Damm 		return NULL;
14711da177e4SLinus Torvalds 
1472abc7e40cSThomas Gleixner 	chip_bus_lock(desc);
1473239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1474ae88a23bSIngo Molnar 
1475ae88a23bSIngo Molnar 	/*
1476ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1477ae88a23bSIngo Molnar 	 * one based on the dev_id:
1478ae88a23bSIngo Molnar 	 */
1479f17c7545SIngo Molnar 	action_ptr = &desc->action;
14801da177e4SLinus Torvalds 	for (;;) {
1481f17c7545SIngo Molnar 		action = *action_ptr;
14821da177e4SLinus Torvalds 
1483ae88a23bSIngo Molnar 		if (!action) {
1484ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1485239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1486abc7e40cSThomas Gleixner 			chip_bus_sync_unlock(desc);
1487f21cfb25SMagnus Damm 			return NULL;
1488ae88a23bSIngo Molnar 		}
14891da177e4SLinus Torvalds 
14908316e381SIngo Molnar 		if (action->dev_id == dev_id)
1491ae88a23bSIngo Molnar 			break;
1492f17c7545SIngo Molnar 		action_ptr = &action->next;
1493ae88a23bSIngo Molnar 	}
1494ae88a23bSIngo Molnar 
1495ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1496f17c7545SIngo Molnar 	*action_ptr = action->next;
1497dbce706eSPaolo 'Blaisorblade' Giarrusso 
1498cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1499cab303beSThomas Gleixner 
1500ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1501c1bacbaeSThomas Gleixner 	if (!desc->action) {
1502e9849777SThomas Gleixner 		irq_settings_clr_disable_unlazy(desc);
150346999238SThomas Gleixner 		irq_shutdown(desc);
1504c1bacbaeSThomas Gleixner 		irq_release_resources(desc);
1505c1bacbaeSThomas Gleixner 	}
15063aa551c9SThomas Gleixner 
1507e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1508e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1509e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1510e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1511e7a297b0SPeter P Waskiewicz Jr #endif
1512e7a297b0SPeter P Waskiewicz Jr 
1513239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1514abc7e40cSThomas Gleixner 	chip_bus_sync_unlock(desc);
1515ae88a23bSIngo Molnar 
15161da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
15171da177e4SLinus Torvalds 
1518ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
15191da177e4SLinus Torvalds 	synchronize_irq(irq);
1520ae88a23bSIngo Molnar 
15211d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
15221d99493bSDavid Woodhouse 	/*
1523ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1524ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1525ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1526ae88a23bSIngo Molnar 	 *
1527ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
1528ae88a23bSIngo Molnar 	 *   'real' IRQ doesn't run in * parallel with our fake. )
15291d99493bSDavid Woodhouse 	 */
15301d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
15311d99493bSDavid Woodhouse 		local_irq_save(flags);
15321d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
15331d99493bSDavid Woodhouse 		local_irq_restore(flags);
15341d99493bSDavid Woodhouse 	}
15351d99493bSDavid Woodhouse #endif
15362d860ad7SLinus Torvalds 
15372d860ad7SLinus Torvalds 	if (action->thread) {
15382d860ad7SLinus Torvalds 		kthread_stop(action->thread);
15392d860ad7SLinus Torvalds 		put_task_struct(action->thread);
15402a1d3ab8SThomas Gleixner 		if (action->secondary && action->secondary->thread) {
15412a1d3ab8SThomas Gleixner 			kthread_stop(action->secondary->thread);
15422a1d3ab8SThomas Gleixner 			put_task_struct(action->secondary->thread);
15432a1d3ab8SThomas Gleixner 		}
15442d860ad7SLinus Torvalds 	}
15452d860ad7SLinus Torvalds 
1546be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
1547b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
15482a1d3ab8SThomas Gleixner 	kfree(action->secondary);
1549f21cfb25SMagnus Damm 	return action;
1550f21cfb25SMagnus Damm }
15511da177e4SLinus Torvalds 
15521da177e4SLinus Torvalds /**
1553cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1554cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1555cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1556cbf94f06SMagnus Damm  *
1557cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1558cbf94f06SMagnus Damm  */
1559cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1560cbf94f06SMagnus Damm {
156131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
156231d9d9b6SMarc Zyngier 
156331d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1564cbf94f06SMagnus Damm 		__free_irq(irq, act->dev_id);
1565cbf94f06SMagnus Damm }
1566eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1567cbf94f06SMagnus Damm 
1568cbf94f06SMagnus Damm /**
1569f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
15701da177e4SLinus Torvalds  *	@irq: Interrupt line to free
15711da177e4SLinus Torvalds  *	@dev_id: Device identity to free
15721da177e4SLinus Torvalds  *
15731da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
15741da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
15751da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
15761da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
15771da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
15781da177e4SLinus Torvalds  *	have completed.
15791da177e4SLinus Torvalds  *
15801da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
158125ce4be7SChristoph Hellwig  *
158225ce4be7SChristoph Hellwig  *	Returns the devname argument passed to request_irq.
15831da177e4SLinus Torvalds  */
158425ce4be7SChristoph Hellwig const void *free_irq(unsigned int irq, void *dev_id)
15851da177e4SLinus Torvalds {
158670aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
158725ce4be7SChristoph Hellwig 	struct irqaction *action;
158825ce4be7SChristoph Hellwig 	const char *devname;
158970aedd24SThomas Gleixner 
159031d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
159125ce4be7SChristoph Hellwig 		return NULL;
159270aedd24SThomas Gleixner 
1593cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1594cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1595cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1596cd7eab44SBen Hutchings #endif
1597cd7eab44SBen Hutchings 
159825ce4be7SChristoph Hellwig 	action = __free_irq(irq, dev_id);
159925ce4be7SChristoph Hellwig 	devname = action->name;
160025ce4be7SChristoph Hellwig 	kfree(action);
160125ce4be7SChristoph Hellwig 	return devname;
16021da177e4SLinus Torvalds }
16031da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
16041da177e4SLinus Torvalds 
16051da177e4SLinus Torvalds /**
16063aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
16071da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
16083aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
16093aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1610b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1611b25c340cSThomas Gleixner  *		  primary handler is installed
16123aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
16133aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
16141da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
16151da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
16161da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
16171da177e4SLinus Torvalds  *
16181da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
16191da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
16201da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
16211da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
16221da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
16231da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
16241da177e4SLinus Torvalds  *
16253aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
16266d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
16273aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
16283aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
16293aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
163039a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
16313aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
16323aa551c9SThomas Gleixner  *	shared interrupts.
16333aa551c9SThomas Gleixner  *
16341da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
16351da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
16361da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
16371da177e4SLinus Torvalds  *
16381da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
16391da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
16401da177e4SLinus Torvalds  *
16411da177e4SLinus Torvalds  *	Flags:
16421da177e4SLinus Torvalds  *
16433cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
16440c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
16451da177e4SLinus Torvalds  *
16461da177e4SLinus Torvalds  */
16473aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
16483aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
16493aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
16501da177e4SLinus Torvalds {
16511da177e4SLinus Torvalds 	struct irqaction *action;
165208678b08SYinghai Lu 	struct irq_desc *desc;
1653d3c60047SThomas Gleixner 	int retval;
16541da177e4SLinus Torvalds 
1655e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1656e237a551SChen Fan 		return -ENOTCONN;
1657e237a551SChen Fan 
1658470c6623SDavid Brownell 	/*
16591da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
16601da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
16611da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
16621da177e4SLinus Torvalds 	 * logic etc).
166317f48034SRafael J. Wysocki 	 *
166417f48034SRafael J. Wysocki 	 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and
166517f48034SRafael J. Wysocki 	 * it cannot be set along with IRQF_NO_SUSPEND.
16661da177e4SLinus Torvalds 	 */
166717f48034SRafael J. Wysocki 	if (((irqflags & IRQF_SHARED) && !dev_id) ||
166817f48034SRafael J. Wysocki 	    (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) ||
166917f48034SRafael J. Wysocki 	    ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND)))
16701da177e4SLinus Torvalds 		return -EINVAL;
16717d94f7caSYinghai Lu 
1672cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
16737d94f7caSYinghai Lu 	if (!desc)
16741da177e4SLinus Torvalds 		return -EINVAL;
16757d94f7caSYinghai Lu 
167631d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
167731d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
16786550c775SThomas Gleixner 		return -EINVAL;
1679b25c340cSThomas Gleixner 
1680b25c340cSThomas Gleixner 	if (!handler) {
1681b25c340cSThomas Gleixner 		if (!thread_fn)
16821da177e4SLinus Torvalds 			return -EINVAL;
1683b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1684b25c340cSThomas Gleixner 	}
16851da177e4SLinus Torvalds 
168645535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
16871da177e4SLinus Torvalds 	if (!action)
16881da177e4SLinus Torvalds 		return -ENOMEM;
16891da177e4SLinus Torvalds 
16901da177e4SLinus Torvalds 	action->handler = handler;
16913aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
16921da177e4SLinus Torvalds 	action->flags = irqflags;
16931da177e4SLinus Torvalds 	action->name = devname;
16941da177e4SLinus Torvalds 	action->dev_id = dev_id;
16951da177e4SLinus Torvalds 
1696be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
16974396f46cSShawn Lin 	if (retval < 0) {
16984396f46cSShawn Lin 		kfree(action);
1699be45beb2SJon Hunter 		return retval;
17004396f46cSShawn Lin 	}
1701be45beb2SJon Hunter 
17023876ec9eSThomas Gleixner 	chip_bus_lock(desc);
1703d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
17043876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
170570aedd24SThomas Gleixner 
17062a1d3ab8SThomas Gleixner 	if (retval) {
1707be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
17082a1d3ab8SThomas Gleixner 		kfree(action->secondary);
1709377bf1e4SAnton Vorontsov 		kfree(action);
17102a1d3ab8SThomas Gleixner 	}
1711377bf1e4SAnton Vorontsov 
17126d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
17136ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1714a304e1b8SDavid Woodhouse 		/*
1715a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
1716a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
1717377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1718377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
1719a304e1b8SDavid Woodhouse 		 */
1720a304e1b8SDavid Woodhouse 		unsigned long flags;
1721a304e1b8SDavid Woodhouse 
1722377bf1e4SAnton Vorontsov 		disable_irq(irq);
1723a304e1b8SDavid Woodhouse 		local_irq_save(flags);
1724377bf1e4SAnton Vorontsov 
1725a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
1726377bf1e4SAnton Vorontsov 
1727a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
1728377bf1e4SAnton Vorontsov 		enable_irq(irq);
1729a304e1b8SDavid Woodhouse 	}
1730a304e1b8SDavid Woodhouse #endif
17311da177e4SLinus Torvalds 	return retval;
17321da177e4SLinus Torvalds }
17333aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
1734ae731f8dSMarc Zyngier 
1735ae731f8dSMarc Zyngier /**
1736ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
1737ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
1738ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
1739ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
1740ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
1741ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
1742ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
1743ae731f8dSMarc Zyngier  *
1744ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
1745ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
1746ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
1747ae731f8dSMarc Zyngier  *	context.
1748ae731f8dSMarc Zyngier  *
1749ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
1750ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1751ae731f8dSMarc Zyngier  */
1752ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1753ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
1754ae731f8dSMarc Zyngier {
1755e237a551SChen Fan 	struct irq_desc *desc;
1756ae731f8dSMarc Zyngier 	int ret;
1757ae731f8dSMarc Zyngier 
1758e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1759e237a551SChen Fan 		return -ENOTCONN;
1760e237a551SChen Fan 
1761e237a551SChen Fan 	desc = irq_to_desc(irq);
1762ae731f8dSMarc Zyngier 	if (!desc)
1763ae731f8dSMarc Zyngier 		return -EINVAL;
1764ae731f8dSMarc Zyngier 
17651ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
1766ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
1767ae731f8dSMarc Zyngier 					   flags, name, dev_id);
1768ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
1769ae731f8dSMarc Zyngier 	}
1770ae731f8dSMarc Zyngier 
1771ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
1772ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
1773ae731f8dSMarc Zyngier }
1774ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
177531d9d9b6SMarc Zyngier 
17761e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
177731d9d9b6SMarc Zyngier {
177831d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
177931d9d9b6SMarc Zyngier 	unsigned long flags;
178031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
178131d9d9b6SMarc Zyngier 
178231d9d9b6SMarc Zyngier 	if (!desc)
178331d9d9b6SMarc Zyngier 		return;
178431d9d9b6SMarc Zyngier 
1785f35ad083SMarc Zyngier 	/*
1786f35ad083SMarc Zyngier 	 * If the trigger type is not specified by the caller, then
1787f35ad083SMarc Zyngier 	 * use the default for this interrupt.
1788f35ad083SMarc Zyngier 	 */
17891e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
1790f35ad083SMarc Zyngier 	if (type == IRQ_TYPE_NONE)
1791f35ad083SMarc Zyngier 		type = irqd_get_trigger_type(&desc->irq_data);
1792f35ad083SMarc Zyngier 
17931e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
17941e7c5fd2SMarc Zyngier 		int ret;
17951e7c5fd2SMarc Zyngier 
1796a1ff541aSJiang Liu 		ret = __irq_set_trigger(desc, type);
17971e7c5fd2SMarc Zyngier 
17981e7c5fd2SMarc Zyngier 		if (ret) {
179932cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
18001e7c5fd2SMarc Zyngier 			goto out;
18011e7c5fd2SMarc Zyngier 		}
18021e7c5fd2SMarc Zyngier 	}
18031e7c5fd2SMarc Zyngier 
180431d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
18051e7c5fd2SMarc Zyngier out:
180631d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
180731d9d9b6SMarc Zyngier }
180836a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
180931d9d9b6SMarc Zyngier 
1810f0cb3220SThomas Petazzoni /**
1811f0cb3220SThomas Petazzoni  * irq_percpu_is_enabled - Check whether the per cpu irq is enabled
1812f0cb3220SThomas Petazzoni  * @irq:	Linux irq number to check for
1813f0cb3220SThomas Petazzoni  *
1814f0cb3220SThomas Petazzoni  * Must be called from a non migratable context. Returns the enable
1815f0cb3220SThomas Petazzoni  * state of a per cpu interrupt on the current cpu.
1816f0cb3220SThomas Petazzoni  */
1817f0cb3220SThomas Petazzoni bool irq_percpu_is_enabled(unsigned int irq)
1818f0cb3220SThomas Petazzoni {
1819f0cb3220SThomas Petazzoni 	unsigned int cpu = smp_processor_id();
1820f0cb3220SThomas Petazzoni 	struct irq_desc *desc;
1821f0cb3220SThomas Petazzoni 	unsigned long flags;
1822f0cb3220SThomas Petazzoni 	bool is_enabled;
1823f0cb3220SThomas Petazzoni 
1824f0cb3220SThomas Petazzoni 	desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1825f0cb3220SThomas Petazzoni 	if (!desc)
1826f0cb3220SThomas Petazzoni 		return false;
1827f0cb3220SThomas Petazzoni 
1828f0cb3220SThomas Petazzoni 	is_enabled = cpumask_test_cpu(cpu, desc->percpu_enabled);
1829f0cb3220SThomas Petazzoni 	irq_put_desc_unlock(desc, flags);
1830f0cb3220SThomas Petazzoni 
1831f0cb3220SThomas Petazzoni 	return is_enabled;
1832f0cb3220SThomas Petazzoni }
1833f0cb3220SThomas Petazzoni EXPORT_SYMBOL_GPL(irq_percpu_is_enabled);
1834f0cb3220SThomas Petazzoni 
183531d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
183631d9d9b6SMarc Zyngier {
183731d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
183831d9d9b6SMarc Zyngier 	unsigned long flags;
183931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
184031d9d9b6SMarc Zyngier 
184131d9d9b6SMarc Zyngier 	if (!desc)
184231d9d9b6SMarc Zyngier 		return;
184331d9d9b6SMarc Zyngier 
184431d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
184531d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
184631d9d9b6SMarc Zyngier }
184736a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
184831d9d9b6SMarc Zyngier 
184931d9d9b6SMarc Zyngier /*
185031d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
185131d9d9b6SMarc Zyngier  */
185231d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
185331d9d9b6SMarc Zyngier {
185431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
185531d9d9b6SMarc Zyngier 	struct irqaction *action;
185631d9d9b6SMarc Zyngier 	unsigned long flags;
185731d9d9b6SMarc Zyngier 
185831d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
185931d9d9b6SMarc Zyngier 
186031d9d9b6SMarc Zyngier 	if (!desc)
186131d9d9b6SMarc Zyngier 		return NULL;
186231d9d9b6SMarc Zyngier 
186331d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
186431d9d9b6SMarc Zyngier 
186531d9d9b6SMarc Zyngier 	action = desc->action;
186631d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
186731d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
186831d9d9b6SMarc Zyngier 		goto bad;
186931d9d9b6SMarc Zyngier 	}
187031d9d9b6SMarc Zyngier 
187131d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
187231d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
187331d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
187431d9d9b6SMarc Zyngier 		goto bad;
187531d9d9b6SMarc Zyngier 	}
187631d9d9b6SMarc Zyngier 
187731d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
187831d9d9b6SMarc Zyngier 	desc->action = NULL;
187931d9d9b6SMarc Zyngier 
188031d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
188131d9d9b6SMarc Zyngier 
188231d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
188331d9d9b6SMarc Zyngier 
1884be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
188531d9d9b6SMarc Zyngier 	module_put(desc->owner);
188631d9d9b6SMarc Zyngier 	return action;
188731d9d9b6SMarc Zyngier 
188831d9d9b6SMarc Zyngier bad:
188931d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
189031d9d9b6SMarc Zyngier 	return NULL;
189131d9d9b6SMarc Zyngier }
189231d9d9b6SMarc Zyngier 
189331d9d9b6SMarc Zyngier /**
189431d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
189531d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
189631d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
189731d9d9b6SMarc Zyngier  *
189831d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
189931d9d9b6SMarc Zyngier  */
190031d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
190131d9d9b6SMarc Zyngier {
190231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
190331d9d9b6SMarc Zyngier 
190431d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
190531d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
190631d9d9b6SMarc Zyngier }
190731d9d9b6SMarc Zyngier 
190831d9d9b6SMarc Zyngier /**
190931d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
191031d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
191131d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
191231d9d9b6SMarc Zyngier  *
191331d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
191431d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
191531d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
191631d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
191731d9d9b6SMarc Zyngier  *
191831d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
191931d9d9b6SMarc Zyngier  */
192031d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
192131d9d9b6SMarc Zyngier {
192231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
192331d9d9b6SMarc Zyngier 
192431d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
192531d9d9b6SMarc Zyngier 		return;
192631d9d9b6SMarc Zyngier 
192731d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
192831d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
192931d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
193031d9d9b6SMarc Zyngier }
1931aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(free_percpu_irq);
193231d9d9b6SMarc Zyngier 
193331d9d9b6SMarc Zyngier /**
193431d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
193531d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
193631d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
193731d9d9b6SMarc Zyngier  *
193831d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
193931d9d9b6SMarc Zyngier  */
194031d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
194131d9d9b6SMarc Zyngier {
194231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
194331d9d9b6SMarc Zyngier 	int retval;
194431d9d9b6SMarc Zyngier 
194531d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
194631d9d9b6SMarc Zyngier 		return -EINVAL;
1947be45beb2SJon Hunter 
1948be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
1949be45beb2SJon Hunter 	if (retval < 0)
1950be45beb2SJon Hunter 		return retval;
1951be45beb2SJon Hunter 
195231d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
195331d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
195431d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
195531d9d9b6SMarc Zyngier 
1956be45beb2SJon Hunter 	if (retval)
1957be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
1958be45beb2SJon Hunter 
195931d9d9b6SMarc Zyngier 	return retval;
196031d9d9b6SMarc Zyngier }
196131d9d9b6SMarc Zyngier 
196231d9d9b6SMarc Zyngier /**
196331d9d9b6SMarc Zyngier  *	request_percpu_irq - allocate a percpu interrupt line
196431d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
196531d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
196631d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
196731d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
196831d9d9b6SMarc Zyngier  *
1969a1b7febdSMaxime Ripard  *	This call allocates interrupt resources and enables the
1970a1b7febdSMaxime Ripard  *	interrupt on the local CPU. If the interrupt is supposed to be
1971a1b7febdSMaxime Ripard  *	enabled on other CPUs, it has to be done on each CPU using
1972a1b7febdSMaxime Ripard  *	enable_percpu_irq().
197331d9d9b6SMarc Zyngier  *
197431d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
197531d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
197631d9d9b6SMarc Zyngier  *	that variable.
197731d9d9b6SMarc Zyngier  */
197831d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler,
197931d9d9b6SMarc Zyngier 		       const char *devname, void __percpu *dev_id)
198031d9d9b6SMarc Zyngier {
198131d9d9b6SMarc Zyngier 	struct irqaction *action;
198231d9d9b6SMarc Zyngier 	struct irq_desc *desc;
198331d9d9b6SMarc Zyngier 	int retval;
198431d9d9b6SMarc Zyngier 
198531d9d9b6SMarc Zyngier 	if (!dev_id)
198631d9d9b6SMarc Zyngier 		return -EINVAL;
198731d9d9b6SMarc Zyngier 
198831d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
198931d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
199031d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
199131d9d9b6SMarc Zyngier 		return -EINVAL;
199231d9d9b6SMarc Zyngier 
199331d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
199431d9d9b6SMarc Zyngier 	if (!action)
199531d9d9b6SMarc Zyngier 		return -ENOMEM;
199631d9d9b6SMarc Zyngier 
199731d9d9b6SMarc Zyngier 	action->handler = handler;
19982ed0e645SMarc Zyngier 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
199931d9d9b6SMarc Zyngier 	action->name = devname;
200031d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
200131d9d9b6SMarc Zyngier 
2002be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
20034396f46cSShawn Lin 	if (retval < 0) {
20044396f46cSShawn Lin 		kfree(action);
2005be45beb2SJon Hunter 		return retval;
20064396f46cSShawn Lin 	}
2007be45beb2SJon Hunter 
200831d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
200931d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
201031d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
201131d9d9b6SMarc Zyngier 
2012be45beb2SJon Hunter 	if (retval) {
2013be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
201431d9d9b6SMarc Zyngier 		kfree(action);
2015be45beb2SJon Hunter 	}
201631d9d9b6SMarc Zyngier 
201731d9d9b6SMarc Zyngier 	return retval;
201831d9d9b6SMarc Zyngier }
2019aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(request_percpu_irq);
20201b7047edSMarc Zyngier 
20211b7047edSMarc Zyngier /**
20221b7047edSMarc Zyngier  *	irq_get_irqchip_state - returns the irqchip state of a interrupt.
20231b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
20241b7047edSMarc Zyngier  *	@which: One of IRQCHIP_STATE_* the caller wants to know about
20251b7047edSMarc Zyngier  *	@state: a pointer to a boolean where the state is to be storeed
20261b7047edSMarc Zyngier  *
20271b7047edSMarc Zyngier  *	This call snapshots the internal irqchip state of an
20281b7047edSMarc Zyngier  *	interrupt, returning into @state the bit corresponding to
20291b7047edSMarc Zyngier  *	stage @which
20301b7047edSMarc Zyngier  *
20311b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
20321b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
20331b7047edSMarc Zyngier  */
20341b7047edSMarc Zyngier int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
20351b7047edSMarc Zyngier 			  bool *state)
20361b7047edSMarc Zyngier {
20371b7047edSMarc Zyngier 	struct irq_desc *desc;
20381b7047edSMarc Zyngier 	struct irq_data *data;
20391b7047edSMarc Zyngier 	struct irq_chip *chip;
20401b7047edSMarc Zyngier 	unsigned long flags;
20411b7047edSMarc Zyngier 	int err = -EINVAL;
20421b7047edSMarc Zyngier 
20431b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
20441b7047edSMarc Zyngier 	if (!desc)
20451b7047edSMarc Zyngier 		return err;
20461b7047edSMarc Zyngier 
20471b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
20481b7047edSMarc Zyngier 
20491b7047edSMarc Zyngier 	do {
20501b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
20511b7047edSMarc Zyngier 		if (chip->irq_get_irqchip_state)
20521b7047edSMarc Zyngier 			break;
20531b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
20541b7047edSMarc Zyngier 		data = data->parent_data;
20551b7047edSMarc Zyngier #else
20561b7047edSMarc Zyngier 		data = NULL;
20571b7047edSMarc Zyngier #endif
20581b7047edSMarc Zyngier 	} while (data);
20591b7047edSMarc Zyngier 
20601b7047edSMarc Zyngier 	if (data)
20611b7047edSMarc Zyngier 		err = chip->irq_get_irqchip_state(data, which, state);
20621b7047edSMarc Zyngier 
20631b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
20641b7047edSMarc Zyngier 	return err;
20651b7047edSMarc Zyngier }
20661ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_get_irqchip_state);
20671b7047edSMarc Zyngier 
20681b7047edSMarc Zyngier /**
20691b7047edSMarc Zyngier  *	irq_set_irqchip_state - set the state of a forwarded interrupt.
20701b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
20711b7047edSMarc Zyngier  *	@which: State to be restored (one of IRQCHIP_STATE_*)
20721b7047edSMarc Zyngier  *	@val: Value corresponding to @which
20731b7047edSMarc Zyngier  *
20741b7047edSMarc Zyngier  *	This call sets the internal irqchip state of an interrupt,
20751b7047edSMarc Zyngier  *	depending on the value of @which.
20761b7047edSMarc Zyngier  *
20771b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
20781b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
20791b7047edSMarc Zyngier  */
20801b7047edSMarc Zyngier int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
20811b7047edSMarc Zyngier 			  bool val)
20821b7047edSMarc Zyngier {
20831b7047edSMarc Zyngier 	struct irq_desc *desc;
20841b7047edSMarc Zyngier 	struct irq_data *data;
20851b7047edSMarc Zyngier 	struct irq_chip *chip;
20861b7047edSMarc Zyngier 	unsigned long flags;
20871b7047edSMarc Zyngier 	int err = -EINVAL;
20881b7047edSMarc Zyngier 
20891b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
20901b7047edSMarc Zyngier 	if (!desc)
20911b7047edSMarc Zyngier 		return err;
20921b7047edSMarc Zyngier 
20931b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
20941b7047edSMarc Zyngier 
20951b7047edSMarc Zyngier 	do {
20961b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
20971b7047edSMarc Zyngier 		if (chip->irq_set_irqchip_state)
20981b7047edSMarc Zyngier 			break;
20991b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
21001b7047edSMarc Zyngier 		data = data->parent_data;
21011b7047edSMarc Zyngier #else
21021b7047edSMarc Zyngier 		data = NULL;
21031b7047edSMarc Zyngier #endif
21041b7047edSMarc Zyngier 	} while (data);
21051b7047edSMarc Zyngier 
21061b7047edSMarc Zyngier 	if (data)
21071b7047edSMarc Zyngier 		err = chip->irq_set_irqchip_state(data, which, val);
21081b7047edSMarc Zyngier 
21091b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
21101b7047edSMarc Zyngier 	return err;
21111b7047edSMarc Zyngier }
21121ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_set_irqchip_state);
2113