xref: /openbmc/linux/kernel/irq/manage.c (revision 2343877fbda701599653e63f8dcc318aa1bf15ee)
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 
171818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
172818b0f3bSJiang Liu 			bool force)
173818b0f3bSJiang Liu {
174818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
175818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
176818b0f3bSJiang Liu 	int ret;
177818b0f3bSJiang Liu 
17801f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
179818b0f3bSJiang Liu 	switch (ret) {
180818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
1812cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
1829df872faSJiang Liu 		cpumask_copy(desc->irq_common_data.affinity, mask);
183818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
184818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
185818b0f3bSJiang Liu 		ret = 0;
186818b0f3bSJiang Liu 	}
187818b0f3bSJiang Liu 
188818b0f3bSJiang Liu 	return ret;
189818b0f3bSJiang Liu }
190818b0f3bSJiang Liu 
19101f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
19201f8fa4fSThomas Gleixner 			    bool force)
193c2d0c555SDavid Daney {
194c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
195c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
196c2d0c555SDavid Daney 	int ret = 0;
197c2d0c555SDavid Daney 
198c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
199c2d0c555SDavid Daney 		return -EINVAL;
200c2d0c555SDavid Daney 
2010ef5ca1eSThomas Gleixner 	if (irq_can_move_pcntxt(data)) {
20201f8fa4fSThomas Gleixner 		ret = irq_do_set_affinity(data, mask, force);
203c2d0c555SDavid Daney 	} else {
204c2d0c555SDavid Daney 		irqd_set_move_pending(data);
205c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
206c2d0c555SDavid Daney 	}
207c2d0c555SDavid Daney 
208c2d0c555SDavid Daney 	if (desc->affinity_notify) {
209c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
210c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
211c2d0c555SDavid Daney 	}
212c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
213c2d0c555SDavid Daney 
214c2d0c555SDavid Daney 	return ret;
215c2d0c555SDavid Daney }
216c2d0c555SDavid Daney 
21701f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
218771ee3b0SThomas Gleixner {
21908678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
220f6d87f4bSThomas Gleixner 	unsigned long flags;
221c2d0c555SDavid Daney 	int ret;
222771ee3b0SThomas Gleixner 
223c2d0c555SDavid Daney 	if (!desc)
224771ee3b0SThomas Gleixner 		return -EINVAL;
225771ee3b0SThomas Gleixner 
226239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
22701f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
228239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2291fa46f1fSThomas Gleixner 	return ret;
230771ee3b0SThomas Gleixner }
231771ee3b0SThomas Gleixner 
232e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
233e7a297b0SPeter P Waskiewicz Jr {
234e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
23531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
236e7a297b0SPeter P Waskiewicz Jr 
237e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
238e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
239e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
24002725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
241e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
2424fe7ffb7SJesse Brandeburg 	if (m)
243e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
244e7a297b0SPeter P Waskiewicz Jr 	return 0;
245e7a297b0SPeter P Waskiewicz Jr }
246e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
247e7a297b0SPeter P Waskiewicz Jr 
248cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
249cd7eab44SBen Hutchings {
250cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
251cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
252cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
253cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
254cd7eab44SBen Hutchings 	unsigned long flags;
255cd7eab44SBen Hutchings 
2561fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
257cd7eab44SBen Hutchings 		goto out;
258cd7eab44SBen Hutchings 
259cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
2600ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
2611fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
262cd7eab44SBen Hutchings 	else
2639df872faSJiang Liu 		cpumask_copy(cpumask, desc->irq_common_data.affinity);
264cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
265cd7eab44SBen Hutchings 
266cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
267cd7eab44SBen Hutchings 
268cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
269cd7eab44SBen Hutchings out:
270cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
271cd7eab44SBen Hutchings }
272cd7eab44SBen Hutchings 
273cd7eab44SBen Hutchings /**
274cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
275cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
276cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
277cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
278cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
279cd7eab44SBen Hutchings  *
280cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
281cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
282cd7eab44SBen Hutchings  *	freed using free_irq().
283cd7eab44SBen Hutchings  */
284cd7eab44SBen Hutchings int
285cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
286cd7eab44SBen Hutchings {
287cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
288cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
289cd7eab44SBen Hutchings 	unsigned long flags;
290cd7eab44SBen Hutchings 
291cd7eab44SBen Hutchings 	/* The release function is promised process context */
292cd7eab44SBen Hutchings 	might_sleep();
293cd7eab44SBen Hutchings 
294cd7eab44SBen Hutchings 	if (!desc)
295cd7eab44SBen Hutchings 		return -EINVAL;
296cd7eab44SBen Hutchings 
297cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
298cd7eab44SBen Hutchings 	if (notify) {
299cd7eab44SBen Hutchings 		notify->irq = irq;
300cd7eab44SBen Hutchings 		kref_init(&notify->kref);
301cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
302cd7eab44SBen Hutchings 	}
303cd7eab44SBen Hutchings 
304cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
305cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
306cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
307cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
308cd7eab44SBen Hutchings 
309cd7eab44SBen Hutchings 	if (old_notify)
310cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
311cd7eab44SBen Hutchings 
312cd7eab44SBen Hutchings 	return 0;
313cd7eab44SBen Hutchings }
314cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
315cd7eab44SBen Hutchings 
31618404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
31718404756SMax Krasnyansky /*
31818404756SMax Krasnyansky  * Generic version of the affinity autoselector.
31918404756SMax Krasnyansky  */
32043564bd9SThomas Gleixner int irq_setup_affinity(struct irq_desc *desc)
32118404756SMax Krasnyansky {
322569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
323cba4235eSThomas Gleixner 	int ret, node = irq_desc_get_node(desc);
324cba4235eSThomas Gleixner 	static DEFINE_RAW_SPINLOCK(mask_lock);
325cba4235eSThomas Gleixner 	static struct cpumask mask;
326569bda8dSThomas Gleixner 
327b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
328e019c249SJiang Liu 	if (!__irq_can_set_affinity(desc))
32918404756SMax Krasnyansky 		return 0;
33018404756SMax Krasnyansky 
331cba4235eSThomas Gleixner 	raw_spin_lock(&mask_lock);
332f6d87f4bSThomas Gleixner 	/*
3339332ef9dSMasahiro Yamada 	 * Preserve the managed affinity setting and a userspace affinity
33406ee6d57SThomas Gleixner 	 * setup, but make sure that one of the targets is online.
335f6d87f4bSThomas Gleixner 	 */
33606ee6d57SThomas Gleixner 	if (irqd_affinity_is_managed(&desc->irq_data) ||
33706ee6d57SThomas Gleixner 	    irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
3389df872faSJiang Liu 		if (cpumask_intersects(desc->irq_common_data.affinity,
339569bda8dSThomas Gleixner 				       cpu_online_mask))
3409df872faSJiang Liu 			set = desc->irq_common_data.affinity;
3410c6f8a8bSThomas Gleixner 		else
3422bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3432bdd1055SThomas Gleixner 	}
34418404756SMax Krasnyansky 
345cba4235eSThomas Gleixner 	cpumask_and(&mask, cpu_online_mask, set);
346241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
347241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
348241fc640SPrarit Bhargava 
349241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
350cba4235eSThomas Gleixner 		if (cpumask_intersects(&mask, nodemask))
351cba4235eSThomas Gleixner 			cpumask_and(&mask, &mask, nodemask);
352241fc640SPrarit Bhargava 	}
353cba4235eSThomas Gleixner 	ret = irq_do_set_affinity(&desc->irq_data, &mask, false);
354cba4235eSThomas Gleixner 	raw_spin_unlock(&mask_lock);
355cba4235eSThomas Gleixner 	return ret;
35618404756SMax Krasnyansky }
357f6d87f4bSThomas Gleixner #else
358a8a98eacSJiang Liu /* Wrapper for ALPHA specific affinity selector magic */
359cba4235eSThomas Gleixner int irq_setup_affinity(struct irq_desc *desc)
360f6d87f4bSThomas Gleixner {
361cba4235eSThomas Gleixner 	return irq_select_affinity(irq_desc_get_irq(desc));
362f6d87f4bSThomas Gleixner }
36318404756SMax Krasnyansky #endif
36418404756SMax Krasnyansky 
365f6d87f4bSThomas Gleixner /*
366cba4235eSThomas Gleixner  * Called when a bogus affinity is set via /proc/irq
367f6d87f4bSThomas Gleixner  */
368cba4235eSThomas Gleixner int irq_select_affinity_usr(unsigned int irq)
369f6d87f4bSThomas Gleixner {
370f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
371f6d87f4bSThomas Gleixner 	unsigned long flags;
372f6d87f4bSThomas Gleixner 	int ret;
373f6d87f4bSThomas Gleixner 
374239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
375cba4235eSThomas Gleixner 	ret = irq_setup_affinity(desc);
376239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
377f6d87f4bSThomas Gleixner 	return ret;
378f6d87f4bSThomas Gleixner }
3791da177e4SLinus Torvalds #endif
3801da177e4SLinus Torvalds 
381fcf1ae2fSFeng Wu /**
382fcf1ae2fSFeng Wu  *	irq_set_vcpu_affinity - Set vcpu affinity for the interrupt
383fcf1ae2fSFeng Wu  *	@irq: interrupt number to set affinity
384fcf1ae2fSFeng Wu  *	@vcpu_info: vCPU specific data
385fcf1ae2fSFeng Wu  *
386fcf1ae2fSFeng Wu  *	This function uses the vCPU specific data to set the vCPU
387fcf1ae2fSFeng Wu  *	affinity for an irq. The vCPU specific data is passed from
388fcf1ae2fSFeng Wu  *	outside, such as KVM. One example code path is as below:
389fcf1ae2fSFeng Wu  *	KVM -> IOMMU -> irq_set_vcpu_affinity().
390fcf1ae2fSFeng Wu  */
391fcf1ae2fSFeng Wu int irq_set_vcpu_affinity(unsigned int irq, void *vcpu_info)
392fcf1ae2fSFeng Wu {
393fcf1ae2fSFeng Wu 	unsigned long flags;
394fcf1ae2fSFeng Wu 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
395fcf1ae2fSFeng Wu 	struct irq_data *data;
396fcf1ae2fSFeng Wu 	struct irq_chip *chip;
397fcf1ae2fSFeng Wu 	int ret = -ENOSYS;
398fcf1ae2fSFeng Wu 
399fcf1ae2fSFeng Wu 	if (!desc)
400fcf1ae2fSFeng Wu 		return -EINVAL;
401fcf1ae2fSFeng Wu 
402fcf1ae2fSFeng Wu 	data = irq_desc_get_irq_data(desc);
403fcf1ae2fSFeng Wu 	chip = irq_data_get_irq_chip(data);
404fcf1ae2fSFeng Wu 	if (chip && chip->irq_set_vcpu_affinity)
405fcf1ae2fSFeng Wu 		ret = chip->irq_set_vcpu_affinity(data, vcpu_info);
406fcf1ae2fSFeng Wu 	irq_put_desc_unlock(desc, flags);
407fcf1ae2fSFeng Wu 
408fcf1ae2fSFeng Wu 	return ret;
409fcf1ae2fSFeng Wu }
410fcf1ae2fSFeng Wu EXPORT_SYMBOL_GPL(irq_set_vcpu_affinity);
411fcf1ae2fSFeng Wu 
41279ff1cdaSJiang Liu void __disable_irq(struct irq_desc *desc)
4130a0c5168SRafael J. Wysocki {
4143aae994fSThomas Gleixner 	if (!desc->depth++)
41587923470SThomas Gleixner 		irq_disable(desc);
4160a0c5168SRafael J. Wysocki }
4170a0c5168SRafael J. Wysocki 
41802725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
41902725e74SThomas Gleixner {
42002725e74SThomas Gleixner 	unsigned long flags;
42131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
42202725e74SThomas Gleixner 
42302725e74SThomas Gleixner 	if (!desc)
42402725e74SThomas Gleixner 		return -EINVAL;
42579ff1cdaSJiang Liu 	__disable_irq(desc);
42602725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
42702725e74SThomas Gleixner 	return 0;
42802725e74SThomas Gleixner }
42902725e74SThomas Gleixner 
4301da177e4SLinus Torvalds /**
4311da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4321da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4331da177e4SLinus Torvalds  *
4341da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4351da177e4SLinus Torvalds  *	nested.
4361da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
4371da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
4381da177e4SLinus Torvalds  *
4391da177e4SLinus Torvalds  *	This function may be called from IRQ context.
4401da177e4SLinus Torvalds  */
4411da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
4421da177e4SLinus Torvalds {
44302725e74SThomas Gleixner 	__disable_irq_nosync(irq);
4441da177e4SLinus Torvalds }
4451da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
4461da177e4SLinus Torvalds 
4471da177e4SLinus Torvalds /**
4481da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
4491da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4501da177e4SLinus Torvalds  *
4511da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
4521da177e4SLinus Torvalds  *	nested.
4531da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
4541da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
4551da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
4561da177e4SLinus Torvalds  *
4571da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
4581da177e4SLinus Torvalds  */
4591da177e4SLinus Torvalds void disable_irq(unsigned int irq)
4601da177e4SLinus Torvalds {
46102725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
4621da177e4SLinus Torvalds 		synchronize_irq(irq);
4631da177e4SLinus Torvalds }
4641da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
4651da177e4SLinus Torvalds 
46602cea395SPeter Zijlstra /**
46702cea395SPeter Zijlstra  *	disable_hardirq - disables an irq and waits for hardirq completion
46802cea395SPeter Zijlstra  *	@irq: Interrupt to disable
46902cea395SPeter Zijlstra  *
47002cea395SPeter Zijlstra  *	Disable the selected interrupt line.  Enables and Disables are
47102cea395SPeter Zijlstra  *	nested.
47202cea395SPeter Zijlstra  *	This function waits for any pending hard IRQ handlers for this
47302cea395SPeter Zijlstra  *	interrupt to complete before returning. If you use this function while
47402cea395SPeter Zijlstra  *	holding a resource the hard IRQ handler may need you will deadlock.
47502cea395SPeter Zijlstra  *
47602cea395SPeter Zijlstra  *	When used to optimistically disable an interrupt from atomic context
47702cea395SPeter Zijlstra  *	the return value must be checked.
47802cea395SPeter Zijlstra  *
47902cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
48002cea395SPeter Zijlstra  *
48102cea395SPeter Zijlstra  *	This function may be called - with care - from IRQ context.
48202cea395SPeter Zijlstra  */
48302cea395SPeter Zijlstra bool disable_hardirq(unsigned int irq)
48402cea395SPeter Zijlstra {
48502cea395SPeter Zijlstra 	if (!__disable_irq_nosync(irq))
48602cea395SPeter Zijlstra 		return synchronize_hardirq(irq);
48702cea395SPeter Zijlstra 
48802cea395SPeter Zijlstra 	return false;
48902cea395SPeter Zijlstra }
49002cea395SPeter Zijlstra EXPORT_SYMBOL_GPL(disable_hardirq);
49102cea395SPeter Zijlstra 
49279ff1cdaSJiang Liu void __enable_irq(struct irq_desc *desc)
4931adb0850SThomas Gleixner {
4941adb0850SThomas Gleixner 	switch (desc->depth) {
4951adb0850SThomas Gleixner 	case 0:
4960a0c5168SRafael J. Wysocki  err_out:
49779ff1cdaSJiang Liu 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n",
49879ff1cdaSJiang Liu 		     irq_desc_get_irq(desc));
4991adb0850SThomas Gleixner 		break;
5001adb0850SThomas Gleixner 	case 1: {
501c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
5020a0c5168SRafael J. Wysocki 			goto err_out;
5031adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
5041ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
505201d7f47SThomas Gleixner 		/*
506201d7f47SThomas Gleixner 		 * Call irq_startup() not irq_enable() here because the
507201d7f47SThomas Gleixner 		 * interrupt might be marked NOAUTOEN. So irq_startup()
508201d7f47SThomas Gleixner 		 * needs to be invoked when it gets enabled the first
509201d7f47SThomas Gleixner 		 * time. If it was already started up, then irq_startup()
510201d7f47SThomas Gleixner 		 * will invoke irq_enable() under the hood.
511201d7f47SThomas Gleixner 		 */
5124cde9c6bSThomas Gleixner 		irq_startup(desc, IRQ_RESEND, IRQ_START_COND);
513201d7f47SThomas Gleixner 		break;
5141adb0850SThomas Gleixner 	}
5151adb0850SThomas Gleixner 	default:
5161adb0850SThomas Gleixner 		desc->depth--;
5171adb0850SThomas Gleixner 	}
5181adb0850SThomas Gleixner }
5191adb0850SThomas Gleixner 
5201da177e4SLinus Torvalds /**
5211da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
5221da177e4SLinus Torvalds  *	@irq: Interrupt to enable
5231da177e4SLinus Torvalds  *
5241da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
5251da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
5261da177e4SLinus Torvalds  *	IRQ line is re-enabled.
5271da177e4SLinus Torvalds  *
52870aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
5296b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
5301da177e4SLinus Torvalds  */
5311da177e4SLinus Torvalds void enable_irq(unsigned int irq)
5321da177e4SLinus Torvalds {
5331da177e4SLinus Torvalds 	unsigned long flags;
53431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5351da177e4SLinus Torvalds 
5367d94f7caSYinghai Lu 	if (!desc)
537c2b5a251SMatthew Wilcox 		return;
53850f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
5392656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
54002725e74SThomas Gleixner 		goto out;
5412656c366SThomas Gleixner 
54279ff1cdaSJiang Liu 	__enable_irq(desc);
54302725e74SThomas Gleixner out:
54402725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
5451da177e4SLinus Torvalds }
5461da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
5471da177e4SLinus Torvalds 
5480c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
5492db87321SUwe Kleine-König {
55008678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
5512db87321SUwe Kleine-König 	int ret = -ENXIO;
5522db87321SUwe Kleine-König 
55360f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
55460f96b41SSantosh Shilimkar 		return 0;
55560f96b41SSantosh Shilimkar 
5562f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
5572f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
5582db87321SUwe Kleine-König 
5592db87321SUwe Kleine-König 	return ret;
5602db87321SUwe Kleine-König }
5612db87321SUwe Kleine-König 
562ba9a2331SThomas Gleixner /**
563a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
564ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
565ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
566ba9a2331SThomas Gleixner  *
56715a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
56815a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
56915a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
57015a647ebSDavid Brownell  *
57115a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
57215a647ebSDavid Brownell  *	states like "suspend to RAM".
573ba9a2331SThomas Gleixner  */
574a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
575ba9a2331SThomas Gleixner {
576ba9a2331SThomas Gleixner 	unsigned long flags;
57731d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
5782db87321SUwe Kleine-König 	int ret = 0;
579ba9a2331SThomas Gleixner 
58013863a66SJesper Juhl 	if (!desc)
58113863a66SJesper Juhl 		return -EINVAL;
58213863a66SJesper Juhl 
58315a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
58415a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
58515a647ebSDavid Brownell 	 */
58615a647ebSDavid Brownell 	if (on) {
5872db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
5882db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5892db87321SUwe Kleine-König 			if (ret)
5902db87321SUwe Kleine-König 				desc->wake_depth = 0;
59115a647ebSDavid Brownell 			else
5927f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
5932db87321SUwe Kleine-König 		}
59415a647ebSDavid Brownell 	} else {
59515a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
5967a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
5972db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
5982db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
5992db87321SUwe Kleine-König 			if (ret)
6002db87321SUwe Kleine-König 				desc->wake_depth = 1;
60115a647ebSDavid Brownell 			else
6027f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
60315a647ebSDavid Brownell 		}
6042db87321SUwe Kleine-König 	}
60502725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
606ba9a2331SThomas Gleixner 	return ret;
607ba9a2331SThomas Gleixner }
608a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
609ba9a2331SThomas Gleixner 
6101da177e4SLinus Torvalds /*
6111da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
6121da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
6131da177e4SLinus Torvalds  * for driver use.
6141da177e4SLinus Torvalds  */
6151da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
6161da177e4SLinus Torvalds {
617cc8c3b78SThomas Gleixner 	unsigned long flags;
61831d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
61902725e74SThomas Gleixner 	int canrequest = 0;
6201da177e4SLinus Torvalds 
6217d94f7caSYinghai Lu 	if (!desc)
6227d94f7caSYinghai Lu 		return 0;
6237d94f7caSYinghai Lu 
62402725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
6252779db8dSBen Hutchings 		if (!desc->action ||
6262779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
62702725e74SThomas Gleixner 			canrequest = 1;
62802725e74SThomas Gleixner 	}
62902725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
63002725e74SThomas Gleixner 	return canrequest;
6311da177e4SLinus Torvalds }
6321da177e4SLinus Torvalds 
633a1ff541aSJiang Liu int __irq_set_trigger(struct irq_desc *desc, unsigned long flags)
63482736f4dSUwe Kleine-König {
6356b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
636d4d5e089SThomas Gleixner 	int ret, unmask = 0;
63782736f4dSUwe Kleine-König 
638b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
63982736f4dSUwe Kleine-König 		/*
64082736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
64182736f4dSUwe Kleine-König 		 * flow-types?
64282736f4dSUwe Kleine-König 		 */
643a1ff541aSJiang Liu 		pr_debug("No set_type function for IRQ %d (%s)\n",
644a1ff541aSJiang Liu 			 irq_desc_get_irq(desc),
64582736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
64682736f4dSUwe Kleine-König 		return 0;
64782736f4dSUwe Kleine-König 	}
64882736f4dSUwe Kleine-König 
649d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
65032f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
651d4d5e089SThomas Gleixner 			mask_irq(desc);
65232f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
653d4d5e089SThomas Gleixner 			unmask = 1;
654d4d5e089SThomas Gleixner 	}
655d4d5e089SThomas Gleixner 
65600b992deSAlexander Kuleshov 	/* Mask all flags except trigger mode */
65700b992deSAlexander Kuleshov 	flags &= IRQ_TYPE_SENSE_MASK;
658b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
65982736f4dSUwe Kleine-König 
660876dbd4cSThomas Gleixner 	switch (ret) {
661876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
6622cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
663876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
664876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
665876dbd4cSThomas Gleixner 
666876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
667876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
668876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
669876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
670876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
671876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
672876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
673876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
674876dbd4cSThomas Gleixner 		}
67546732475SThomas Gleixner 
676d4d5e089SThomas Gleixner 		ret = 0;
6778fff39e0SThomas Gleixner 		break;
678876dbd4cSThomas Gleixner 	default:
67997fd75b7SAndrew Morton 		pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n",
680a1ff541aSJiang Liu 		       flags, irq_desc_get_irq(desc), chip->irq_set_type);
6810c5d1eb7SDavid Brownell 	}
682d4d5e089SThomas Gleixner 	if (unmask)
683d4d5e089SThomas Gleixner 		unmask_irq(desc);
68482736f4dSUwe Kleine-König 	return ret;
68582736f4dSUwe Kleine-König }
68682736f4dSUwe Kleine-König 
687293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
688293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
689293a7a0aSThomas Gleixner {
690293a7a0aSThomas Gleixner 	unsigned long flags;
691293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
692293a7a0aSThomas Gleixner 
693293a7a0aSThomas Gleixner 	if (!desc)
694293a7a0aSThomas Gleixner 		return -EINVAL;
695293a7a0aSThomas Gleixner 
696293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
697293a7a0aSThomas Gleixner 
698293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
699293a7a0aSThomas Gleixner 	return 0;
700293a7a0aSThomas Gleixner }
7013118dac5SSudip Mukherjee EXPORT_SYMBOL_GPL(irq_set_parent);
702293a7a0aSThomas Gleixner #endif
703293a7a0aSThomas Gleixner 
704b25c340cSThomas Gleixner /*
705b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
706b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
707b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
708b25c340cSThomas Gleixner  */
709b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
710b25c340cSThomas Gleixner {
711b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
712b25c340cSThomas Gleixner }
713b25c340cSThomas Gleixner 
714399b5da2SThomas Gleixner /*
715399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
716399b5da2SThomas Gleixner  * called.
717399b5da2SThomas Gleixner  */
718399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
719399b5da2SThomas Gleixner {
720399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
721399b5da2SThomas Gleixner 	return IRQ_NONE;
722399b5da2SThomas Gleixner }
723399b5da2SThomas Gleixner 
7242a1d3ab8SThomas Gleixner static irqreturn_t irq_forced_secondary_handler(int irq, void *dev_id)
7252a1d3ab8SThomas Gleixner {
7262a1d3ab8SThomas Gleixner 	WARN(1, "Secondary action handler called for irq %d\n", irq);
7272a1d3ab8SThomas Gleixner 	return IRQ_NONE;
7282a1d3ab8SThomas Gleixner }
7292a1d3ab8SThomas Gleixner 
7303aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
7313aa551c9SThomas Gleixner {
7323aa551c9SThomas Gleixner 	set_current_state(TASK_INTERRUPTIBLE);
733f48fe81eSThomas Gleixner 
734550acb19SIdo Yariv 	while (!kthread_should_stop()) {
735550acb19SIdo Yariv 
736f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
737f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
7383aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
7393aa551c9SThomas Gleixner 			return 0;
740f48fe81eSThomas Gleixner 		}
7413aa551c9SThomas Gleixner 		schedule();
742550acb19SIdo Yariv 		set_current_state(TASK_INTERRUPTIBLE);
7433aa551c9SThomas Gleixner 	}
744550acb19SIdo Yariv 	__set_current_state(TASK_RUNNING);
7453aa551c9SThomas Gleixner 	return -1;
7463aa551c9SThomas Gleixner }
7473aa551c9SThomas Gleixner 
748b25c340cSThomas Gleixner /*
749b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
750b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
751b25c340cSThomas Gleixner  * is marked MASKED.
752b25c340cSThomas Gleixner  */
753b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
754f3f79e38SAlexander Gordeev 				 struct irqaction *action)
755b25c340cSThomas Gleixner {
7562a1d3ab8SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT) ||
7572a1d3ab8SThomas Gleixner 	    action->handler == irq_forced_secondary_handler)
758b5faba21SThomas Gleixner 		return;
7590b1adaa0SThomas Gleixner again:
7603876ec9eSThomas Gleixner 	chip_bus_lock(desc);
761239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
7620b1adaa0SThomas Gleixner 
7630b1adaa0SThomas Gleixner 	/*
7640b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
7650b1adaa0SThomas Gleixner 	 * the following scenario:
7660b1adaa0SThomas Gleixner 	 *
7670b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
7680b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
7690b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
770009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
771b5faba21SThomas Gleixner 	 *
772b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
773b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
774b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
775b5faba21SThomas Gleixner 	 * serialization.
7760b1adaa0SThomas Gleixner 	 */
77732f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
7780b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
7793876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
7800b1adaa0SThomas Gleixner 		cpu_relax();
7810b1adaa0SThomas Gleixner 		goto again;
7820b1adaa0SThomas Gleixner 	}
7830b1adaa0SThomas Gleixner 
784b5faba21SThomas Gleixner 	/*
785b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
786b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
787b5faba21SThomas Gleixner 	 * was just set.
788b5faba21SThomas Gleixner 	 */
789f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
790b5faba21SThomas Gleixner 		goto out_unlock;
791b5faba21SThomas Gleixner 
792b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
793b5faba21SThomas Gleixner 
79432f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
79532f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
796328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
79732f4125eSThomas Gleixner 
798b5faba21SThomas Gleixner out_unlock:
799239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
8003876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
801b25c340cSThomas Gleixner }
802b25c340cSThomas Gleixner 
80361f38261SBruno Premont #ifdef CONFIG_SMP
8043aa551c9SThomas Gleixner /*
805b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
806591d2fb0SThomas Gleixner  */
807591d2fb0SThomas Gleixner static void
808591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
809591d2fb0SThomas Gleixner {
810591d2fb0SThomas Gleixner 	cpumask_var_t mask;
81104aa530eSThomas Gleixner 	bool valid = true;
812591d2fb0SThomas Gleixner 
813591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
814591d2fb0SThomas Gleixner 		return;
815591d2fb0SThomas Gleixner 
816591d2fb0SThomas Gleixner 	/*
817591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
818591d2fb0SThomas Gleixner 	 * try again next time
819591d2fb0SThomas Gleixner 	 */
820591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
821591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
822591d2fb0SThomas Gleixner 		return;
823591d2fb0SThomas Gleixner 	}
824591d2fb0SThomas Gleixner 
825239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
82604aa530eSThomas Gleixner 	/*
82704aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
82804aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
82904aa530eSThomas Gleixner 	 */
830d170fe7dSMatthias Kaehlcke 	if (cpumask_available(desc->irq_common_data.affinity))
8319df872faSJiang Liu 		cpumask_copy(mask, desc->irq_common_data.affinity);
83204aa530eSThomas Gleixner 	else
83304aa530eSThomas Gleixner 		valid = false;
834239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
835591d2fb0SThomas Gleixner 
83604aa530eSThomas Gleixner 	if (valid)
837591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
838591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
839591d2fb0SThomas Gleixner }
84061f38261SBruno Premont #else
84161f38261SBruno Premont static inline void
84261f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
84361f38261SBruno Premont #endif
844591d2fb0SThomas Gleixner 
845591d2fb0SThomas Gleixner /*
8468d32a307SThomas Gleixner  * Interrupts which are not explicitely requested as threaded
8478d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
8488d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
8498d32a307SThomas Gleixner  * side effects.
8508d32a307SThomas Gleixner  */
8513a43e05fSSebastian Andrzej Siewior static irqreturn_t
8528d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
8538d32a307SThomas Gleixner {
8543a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8553a43e05fSSebastian Andrzej Siewior 
8568d32a307SThomas Gleixner 	local_bh_disable();
8573a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
858f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8598d32a307SThomas Gleixner 	local_bh_enable();
8603a43e05fSSebastian Andrzej Siewior 	return ret;
8618d32a307SThomas Gleixner }
8628d32a307SThomas Gleixner 
8638d32a307SThomas Gleixner /*
864f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
8658d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
8668d32a307SThomas Gleixner  * complete.
8678d32a307SThomas Gleixner  */
8683a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
8693a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
8708d32a307SThomas Gleixner {
8713a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
8723a43e05fSSebastian Andrzej Siewior 
8733a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
874f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
8753a43e05fSSebastian Andrzej Siewior 	return ret;
8768d32a307SThomas Gleixner }
8778d32a307SThomas Gleixner 
8787140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
8797140ea19SIdo Yariv {
880c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
8817140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
8827140ea19SIdo Yariv }
8837140ea19SIdo Yariv 
88467d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
8854d1d61a6SOleg Nesterov {
8864d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
8874d1d61a6SOleg Nesterov 	struct irq_desc *desc;
8884d1d61a6SOleg Nesterov 	struct irqaction *action;
8894d1d61a6SOleg Nesterov 
8904d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
8914d1d61a6SOleg Nesterov 		return;
8924d1d61a6SOleg Nesterov 
8934d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
8944d1d61a6SOleg Nesterov 
895fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
89619af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
8974d1d61a6SOleg Nesterov 
8984d1d61a6SOleg Nesterov 
8994d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
9004d1d61a6SOleg Nesterov 	/*
9014d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
9024d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
9034d1d61a6SOleg Nesterov 	 */
9044d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
9054d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
9064d1d61a6SOleg Nesterov 
9074d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
9084d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
9094d1d61a6SOleg Nesterov }
9104d1d61a6SOleg Nesterov 
9112a1d3ab8SThomas Gleixner static void irq_wake_secondary(struct irq_desc *desc, struct irqaction *action)
9122a1d3ab8SThomas Gleixner {
9132a1d3ab8SThomas Gleixner 	struct irqaction *secondary = action->secondary;
9142a1d3ab8SThomas Gleixner 
9152a1d3ab8SThomas Gleixner 	if (WARN_ON_ONCE(!secondary))
9162a1d3ab8SThomas Gleixner 		return;
9172a1d3ab8SThomas Gleixner 
9182a1d3ab8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
9192a1d3ab8SThomas Gleixner 	__irq_wake_thread(desc, secondary);
9202a1d3ab8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
9212a1d3ab8SThomas Gleixner }
9222a1d3ab8SThomas Gleixner 
9238d32a307SThomas Gleixner /*
9243aa551c9SThomas Gleixner  * Interrupt handler thread
9253aa551c9SThomas Gleixner  */
9263aa551c9SThomas Gleixner static int irq_thread(void *data)
9273aa551c9SThomas Gleixner {
92867d12145SAl Viro 	struct callback_head on_exit_work;
9293aa551c9SThomas Gleixner 	struct irqaction *action = data;
9303aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
9313a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
9323a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
9333aa551c9SThomas Gleixner 
934540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
9358d32a307SThomas Gleixner 					&action->thread_flags))
9368d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
9378d32a307SThomas Gleixner 	else
9388d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
9398d32a307SThomas Gleixner 
94041f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
9414d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
9423aa551c9SThomas Gleixner 
943f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
944f3de44edSSankara Muthukrishnan 
9453aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
9467140ea19SIdo Yariv 		irqreturn_t action_ret;
9473aa551c9SThomas Gleixner 
948591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
949591d2fb0SThomas Gleixner 
9503a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
9511e77d0a1SThomas Gleixner 		if (action_ret == IRQ_HANDLED)
9521e77d0a1SThomas Gleixner 			atomic_inc(&desc->threads_handled);
9532a1d3ab8SThomas Gleixner 		if (action_ret == IRQ_WAKE_THREAD)
9542a1d3ab8SThomas Gleixner 			irq_wake_secondary(desc, action);
9557140ea19SIdo Yariv 
9567140ea19SIdo Yariv 		wake_threads_waitq(desc);
9573aa551c9SThomas Gleixner 	}
9583aa551c9SThomas Gleixner 
9597140ea19SIdo Yariv 	/*
9607140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
9617140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
9627140ea19SIdo Yariv 	 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the
963e04268b0SThomas Gleixner 	 * oneshot mask bit can be set. We cannot verify that as we
964e04268b0SThomas Gleixner 	 * cannot touch the oneshot mask at this point anymore as
965e04268b0SThomas Gleixner 	 * __setup_irq() might have given out currents thread_mask
966e04268b0SThomas Gleixner 	 * again.
9673aa551c9SThomas Gleixner 	 */
9684d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
9693aa551c9SThomas Gleixner 	return 0;
9703aa551c9SThomas Gleixner }
9713aa551c9SThomas Gleixner 
972a92444c6SThomas Gleixner /**
973a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
974a92444c6SThomas Gleixner  *	@irq:		Interrupt line
975a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
976a92444c6SThomas Gleixner  *
977a92444c6SThomas Gleixner  */
978a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
979a92444c6SThomas Gleixner {
980a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
981a92444c6SThomas Gleixner 	struct irqaction *action;
982a92444c6SThomas Gleixner 	unsigned long flags;
983a92444c6SThomas Gleixner 
984a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
985a92444c6SThomas Gleixner 		return;
986a92444c6SThomas Gleixner 
987a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
988f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action) {
989a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
990a92444c6SThomas Gleixner 			if (action->thread)
991a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
992a92444c6SThomas Gleixner 			break;
993a92444c6SThomas Gleixner 		}
994a92444c6SThomas Gleixner 	}
995a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
996a92444c6SThomas Gleixner }
997a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
998a92444c6SThomas Gleixner 
9992a1d3ab8SThomas Gleixner static int irq_setup_forced_threading(struct irqaction *new)
10008d32a307SThomas Gleixner {
10018d32a307SThomas Gleixner 	if (!force_irqthreads)
10022a1d3ab8SThomas Gleixner 		return 0;
10038d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
10042a1d3ab8SThomas Gleixner 		return 0;
10058d32a307SThomas Gleixner 
10068d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
10078d32a307SThomas Gleixner 
10082a1d3ab8SThomas Gleixner 	/*
10092a1d3ab8SThomas Gleixner 	 * Handle the case where we have a real primary handler and a
10102a1d3ab8SThomas Gleixner 	 * thread handler. We force thread them as well by creating a
10112a1d3ab8SThomas Gleixner 	 * secondary action.
10122a1d3ab8SThomas Gleixner 	 */
10132a1d3ab8SThomas Gleixner 	if (new->handler != irq_default_primary_handler && new->thread_fn) {
10142a1d3ab8SThomas Gleixner 		/* Allocate the secondary action */
10152a1d3ab8SThomas Gleixner 		new->secondary = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
10162a1d3ab8SThomas Gleixner 		if (!new->secondary)
10172a1d3ab8SThomas Gleixner 			return -ENOMEM;
10182a1d3ab8SThomas Gleixner 		new->secondary->handler = irq_forced_secondary_handler;
10192a1d3ab8SThomas Gleixner 		new->secondary->thread_fn = new->thread_fn;
10202a1d3ab8SThomas Gleixner 		new->secondary->dev_id = new->dev_id;
10212a1d3ab8SThomas Gleixner 		new->secondary->irq = new->irq;
10222a1d3ab8SThomas Gleixner 		new->secondary->name = new->name;
10232a1d3ab8SThomas Gleixner 	}
10242a1d3ab8SThomas Gleixner 	/* Deal with the primary handler */
10258d32a307SThomas Gleixner 	set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
10268d32a307SThomas Gleixner 	new->thread_fn = new->handler;
10278d32a307SThomas Gleixner 	new->handler = irq_default_primary_handler;
10282a1d3ab8SThomas Gleixner 	return 0;
10298d32a307SThomas Gleixner }
10308d32a307SThomas Gleixner 
1031c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
1032c1bacbaeSThomas Gleixner {
1033c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1034c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1035c1bacbaeSThomas Gleixner 
1036c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
1037c1bacbaeSThomas Gleixner }
1038c1bacbaeSThomas Gleixner 
1039c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
1040c1bacbaeSThomas Gleixner {
1041c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1042c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1043c1bacbaeSThomas Gleixner 
1044c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
1045c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
1046c1bacbaeSThomas Gleixner }
1047c1bacbaeSThomas Gleixner 
10482a1d3ab8SThomas Gleixner static int
10492a1d3ab8SThomas Gleixner setup_irq_thread(struct irqaction *new, unsigned int irq, bool secondary)
10502a1d3ab8SThomas Gleixner {
10512a1d3ab8SThomas Gleixner 	struct task_struct *t;
10522a1d3ab8SThomas Gleixner 	struct sched_param param = {
10532a1d3ab8SThomas Gleixner 		.sched_priority = MAX_USER_RT_PRIO/2,
10542a1d3ab8SThomas Gleixner 	};
10552a1d3ab8SThomas Gleixner 
10562a1d3ab8SThomas Gleixner 	if (!secondary) {
10572a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
10582a1d3ab8SThomas Gleixner 				   new->name);
10592a1d3ab8SThomas Gleixner 	} else {
10602a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-s-%s", irq,
10612a1d3ab8SThomas Gleixner 				   new->name);
10622a1d3ab8SThomas Gleixner 		param.sched_priority -= 1;
10632a1d3ab8SThomas Gleixner 	}
10642a1d3ab8SThomas Gleixner 
10652a1d3ab8SThomas Gleixner 	if (IS_ERR(t))
10662a1d3ab8SThomas Gleixner 		return PTR_ERR(t);
10672a1d3ab8SThomas Gleixner 
10682a1d3ab8SThomas Gleixner 	sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
10692a1d3ab8SThomas Gleixner 
10702a1d3ab8SThomas Gleixner 	/*
10712a1d3ab8SThomas Gleixner 	 * We keep the reference to the task struct even if
10722a1d3ab8SThomas Gleixner 	 * the thread dies to avoid that the interrupt code
10732a1d3ab8SThomas Gleixner 	 * references an already freed task_struct.
10742a1d3ab8SThomas Gleixner 	 */
10752a1d3ab8SThomas Gleixner 	get_task_struct(t);
10762a1d3ab8SThomas Gleixner 	new->thread = t;
10772a1d3ab8SThomas Gleixner 	/*
10782a1d3ab8SThomas Gleixner 	 * Tell the thread to set its affinity. This is
10792a1d3ab8SThomas Gleixner 	 * important for shared interrupt handlers as we do
10802a1d3ab8SThomas Gleixner 	 * not invoke setup_affinity() for the secondary
10812a1d3ab8SThomas Gleixner 	 * handlers as everything is already set up. Even for
10822a1d3ab8SThomas Gleixner 	 * interrupts marked with IRQF_NO_BALANCE this is
10832a1d3ab8SThomas Gleixner 	 * correct as we want the thread to move to the cpu(s)
10842a1d3ab8SThomas Gleixner 	 * on which the requesting code placed the interrupt.
10852a1d3ab8SThomas Gleixner 	 */
10862a1d3ab8SThomas Gleixner 	set_bit(IRQTF_AFFINITY, &new->thread_flags);
10872a1d3ab8SThomas Gleixner 	return 0;
10882a1d3ab8SThomas Gleixner }
10892a1d3ab8SThomas Gleixner 
10901da177e4SLinus Torvalds /*
10911da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
10921da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
10931da177e4SLinus Torvalds  */
1094d3c60047SThomas Gleixner static int
1095d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
10961da177e4SLinus Torvalds {
1097f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
1098b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
10993b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
11001da177e4SLinus Torvalds 
11017d94f7caSYinghai Lu 	if (!desc)
1102c2b5a251SMatthew Wilcox 		return -EINVAL;
1103c2b5a251SMatthew Wilcox 
11046b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
11051da177e4SLinus Torvalds 		return -ENOSYS;
1106b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
1107b6873807SSebastian Andrzej Siewior 		return -ENODEV;
11081da177e4SLinus Torvalds 
11092a1d3ab8SThomas Gleixner 	new->irq = irq;
11102a1d3ab8SThomas Gleixner 
11111da177e4SLinus Torvalds 	/*
11124b357daeSJon Hunter 	 * If the trigger type is not specified by the caller,
11134b357daeSJon Hunter 	 * then use the default for this interrupt.
11144b357daeSJon Hunter 	 */
11154b357daeSJon Hunter 	if (!(new->flags & IRQF_TRIGGER_MASK))
11164b357daeSJon Hunter 		new->flags |= irqd_get_trigger_type(&desc->irq_data);
11174b357daeSJon Hunter 
11184b357daeSJon Hunter 	/*
1119399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
1120399b5da2SThomas Gleixner 	 * thread.
11213aa551c9SThomas Gleixner 	 */
11221ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
1123399b5da2SThomas Gleixner 	if (nested) {
1124b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
1125b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
1126b6873807SSebastian Andrzej Siewior 			goto out_mput;
1127b6873807SSebastian Andrzej Siewior 		}
1128399b5da2SThomas Gleixner 		/*
1129399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
1130399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
1131399b5da2SThomas Gleixner 		 * dummy function which warns when called.
1132399b5da2SThomas Gleixner 		 */
1133399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
11348d32a307SThomas Gleixner 	} else {
11352a1d3ab8SThomas Gleixner 		if (irq_settings_can_thread(desc)) {
11362a1d3ab8SThomas Gleixner 			ret = irq_setup_forced_threading(new);
11372a1d3ab8SThomas Gleixner 			if (ret)
11382a1d3ab8SThomas Gleixner 				goto out_mput;
11392a1d3ab8SThomas Gleixner 		}
1140399b5da2SThomas Gleixner 	}
1141399b5da2SThomas Gleixner 
1142399b5da2SThomas Gleixner 	/*
1143399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
1144399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
1145399b5da2SThomas Gleixner 	 * thread.
1146399b5da2SThomas Gleixner 	 */
1147399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
11482a1d3ab8SThomas Gleixner 		ret = setup_irq_thread(new, irq, false);
11492a1d3ab8SThomas Gleixner 		if (ret)
1150b6873807SSebastian Andrzej Siewior 			goto out_mput;
11512a1d3ab8SThomas Gleixner 		if (new->secondary) {
11522a1d3ab8SThomas Gleixner 			ret = setup_irq_thread(new->secondary, irq, true);
11532a1d3ab8SThomas Gleixner 			if (ret)
11542a1d3ab8SThomas Gleixner 				goto out_thread;
1155b6873807SSebastian Andrzej Siewior 		}
11563aa551c9SThomas Gleixner 	}
11573aa551c9SThomas Gleixner 
11583aa551c9SThomas Gleixner 	/*
1159dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1160dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1161dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1162dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1163dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1164dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1165dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1166dc9b229aSThomas Gleixner 	 */
1167dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1168dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1169dc9b229aSThomas Gleixner 
11709114014cSThomas Gleixner 	mutex_lock(&desc->request_mutex);
117146e48e25SThomas Gleixner 	if (!desc->action) {
117246e48e25SThomas Gleixner 		ret = irq_request_resources(desc);
117346e48e25SThomas Gleixner 		if (ret) {
117446e48e25SThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
117546e48e25SThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
117646e48e25SThomas Gleixner 			goto out_mutex;
117746e48e25SThomas Gleixner 		}
117846e48e25SThomas Gleixner 	}
11799114014cSThomas Gleixner 
11803a90795eSThomas Gleixner 	chip_bus_lock(desc);
11813a90795eSThomas Gleixner 
1182dc9b229aSThomas Gleixner 	/*
11831da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
11841da177e4SLinus Torvalds 	 */
1185239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1186f17c7545SIngo Molnar 	old_ptr = &desc->action;
1187f17c7545SIngo Molnar 	old = *old_ptr;
118806fcb0c6SIngo Molnar 	if (old) {
1189e76de9f8SThomas Gleixner 		/*
1190e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1191e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
11923cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
11939d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
11949d591eddSThomas Gleixner 		 * agree on ONESHOT.
1195e76de9f8SThomas Gleixner 		 */
1196382bd4deSHans de Goede 		unsigned int oldtype = irqd_get_trigger_type(&desc->irq_data);
1197382bd4deSHans de Goede 
11983cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
1199382bd4deSHans de Goede 		    (oldtype != (new->flags & IRQF_TRIGGER_MASK)) ||
1200f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1201f5163427SDimitri Sivanich 			goto mismatch;
1202f5163427SDimitri Sivanich 
1203f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
12043cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
12053cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1206f5163427SDimitri Sivanich 			goto mismatch;
12071da177e4SLinus Torvalds 
12081da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
12091da177e4SLinus Torvalds 		do {
121052abb700SThomas Gleixner 			/*
121152abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
121252abb700SThomas Gleixner 			 * so we can find the next zero bit for this
121352abb700SThomas Gleixner 			 * new action.
121452abb700SThomas Gleixner 			 */
1215b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1216f17c7545SIngo Molnar 			old_ptr = &old->next;
1217f17c7545SIngo Molnar 			old = *old_ptr;
12181da177e4SLinus Torvalds 		} while (old);
12191da177e4SLinus Torvalds 		shared = 1;
12201da177e4SLinus Torvalds 	}
12211da177e4SLinus Torvalds 
1222b5faba21SThomas Gleixner 	/*
122352abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
122452abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
122552abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1226b5faba21SThomas Gleixner 	 */
122752abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
122852abb700SThomas Gleixner 		/*
122952abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
123052abb700SThomas Gleixner 		 * but who knows.
123152abb700SThomas Gleixner 		 */
123252abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1233b5faba21SThomas Gleixner 			ret = -EBUSY;
1234cba4235eSThomas Gleixner 			goto out_unlock;
1235b5faba21SThomas Gleixner 		}
123652abb700SThomas Gleixner 		/*
123752abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
123852abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
123952abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
124052abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
124152abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
124252abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
124352abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
124452abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
124552abb700SThomas Gleixner 		 *
124652abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
124752abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
124852abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
124952abb700SThomas Gleixner 		 * affected hard irq flow handlers
125052abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
125152abb700SThomas Gleixner 		 *
125252abb700SThomas Gleixner 		 * The new action gets the first zero bit of
125352abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
125452abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
125552abb700SThomas Gleixner 		 */
1256b5faba21SThomas Gleixner 		new->thread_mask = 1 << ffz(thread_mask);
12571c6c6952SThomas Gleixner 
1258dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1259dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
12601c6c6952SThomas Gleixner 		/*
12611c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
12621c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
12631c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
12641c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
12651c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
12661c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
12671c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
12681c6c6952SThomas Gleixner 		 *
12691c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
12701c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
12711c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
12721c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
12731c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
12741c6c6952SThomas Gleixner 		 */
127597fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
12761c6c6952SThomas Gleixner 		       irq);
12771c6c6952SThomas Gleixner 		ret = -EINVAL;
1278cba4235eSThomas Gleixner 		goto out_unlock;
127952abb700SThomas Gleixner 	}
1280b5faba21SThomas Gleixner 
12811da177e4SLinus Torvalds 	if (!shared) {
12823aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
12833aa551c9SThomas Gleixner 
128482736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
128582736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1286a1ff541aSJiang Liu 			ret = __irq_set_trigger(desc,
1287f2b662daSDavid Brownell 						new->flags & IRQF_TRIGGER_MASK);
128882736f4dSUwe Kleine-König 
1289fa07ab72SHeiner Kallweit 			if (ret) {
1290fa07ab72SHeiner Kallweit 				irq_release_resources(desc);
1291cba4235eSThomas Gleixner 				goto out_unlock;
1292091738a2SThomas Gleixner 			}
1293fa07ab72SHeiner Kallweit 		}
1294f75d222bSAhmed S. Darwish 
1295009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
129632f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
129732f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
129894d39e1fSThomas Gleixner 
1299a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1300a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1301a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1302a005677bSThomas Gleixner 		}
13036a58fb3bSThomas Gleixner 
1304b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
13053d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1306b25c340cSThomas Gleixner 
13072e051552SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
13082e051552SThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
13092e051552SThomas Gleixner 			irq_settings_set_no_balancing(desc);
13102e051552SThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
13112e051552SThomas Gleixner 		}
13122e051552SThomas Gleixner 
131304c848d3SThomas Gleixner 		if (irq_settings_can_autoenable(desc)) {
13144cde9c6bSThomas Gleixner 			irq_startup(desc, IRQ_RESEND, IRQ_START_COND);
131504c848d3SThomas Gleixner 		} else {
131604c848d3SThomas Gleixner 			/*
131704c848d3SThomas Gleixner 			 * Shared interrupts do not go well with disabling
131804c848d3SThomas Gleixner 			 * auto enable. The sharing interrupt might request
131904c848d3SThomas Gleixner 			 * it while it's still disabled and then wait for
132004c848d3SThomas Gleixner 			 * interrupts forever.
132104c848d3SThomas Gleixner 			 */
132204c848d3SThomas Gleixner 			WARN_ON_ONCE(new->flags & IRQF_SHARED);
1323e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1324e76de9f8SThomas Gleixner 			desc->depth = 1;
132504c848d3SThomas Gleixner 		}
132618404756SMax Krasnyansky 
1327876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1328876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
13297ee7e87dSThomas Gleixner 		unsigned int omsk = irqd_get_trigger_type(&desc->irq_data);
1330876dbd4cSThomas Gleixner 
1331876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1332876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
1333a395d6a7SJoe Perches 			pr_warn("irq %d uses trigger mode %u; requested %u\n",
13347ee7e87dSThomas Gleixner 				irq, omsk, nmsk);
133594d39e1fSThomas Gleixner 	}
133682736f4dSUwe Kleine-König 
1337f17c7545SIngo Molnar 	*old_ptr = new;
133882736f4dSUwe Kleine-König 
1339cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1340cab303beSThomas Gleixner 
13418528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
13428528b0f1SLinus Torvalds 	desc->irq_count = 0;
13438528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
13441adb0850SThomas Gleixner 
13451adb0850SThomas Gleixner 	/*
13461adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
13471adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
13481adb0850SThomas Gleixner 	 */
13497acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
13507acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
135179ff1cdaSJiang Liu 		__enable_irq(desc);
13521adb0850SThomas Gleixner 	}
13531adb0850SThomas Gleixner 
1354239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
13553a90795eSThomas Gleixner 	chip_bus_sync_unlock(desc);
13569114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
13571da177e4SLinus Torvalds 
1358b2d3d61aSDaniel Lezcano 	irq_setup_timings(desc, new);
1359b2d3d61aSDaniel Lezcano 
136069ab8494SThomas Gleixner 	/*
136169ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
136269ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
136369ab8494SThomas Gleixner 	 */
136469ab8494SThomas Gleixner 	if (new->thread)
136569ab8494SThomas Gleixner 		wake_up_process(new->thread);
13662a1d3ab8SThomas Gleixner 	if (new->secondary)
13672a1d3ab8SThomas Gleixner 		wake_up_process(new->secondary->thread);
136869ab8494SThomas Gleixner 
13692c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
1370087cdfb6SThomas Gleixner 	irq_add_debugfs_entry(irq, desc);
13711da177e4SLinus Torvalds 	new->dir = NULL;
13721da177e4SLinus Torvalds 	register_handler_proc(irq, new);
13731da177e4SLinus Torvalds 	return 0;
1374f5163427SDimitri Sivanich 
1375f5163427SDimitri Sivanich mismatch:
13763cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
137797fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1378f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1379f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1380f5163427SDimitri Sivanich 		dump_stack();
13813f050447SAlan Cox #endif
1382f5d89470SThomas Gleixner 	}
13833aa551c9SThomas Gleixner 	ret = -EBUSY;
13843aa551c9SThomas Gleixner 
1385cba4235eSThomas Gleixner out_unlock:
13861c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
13873b8249e7SThomas Gleixner 
13883a90795eSThomas Gleixner 	chip_bus_sync_unlock(desc);
13893a90795eSThomas Gleixner 
139046e48e25SThomas Gleixner 	if (!desc->action)
139146e48e25SThomas Gleixner 		irq_release_resources(desc);
139246e48e25SThomas Gleixner 
139346e48e25SThomas Gleixner out_mutex:
13949114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
13959114014cSThomas Gleixner 
13963aa551c9SThomas Gleixner out_thread:
13973aa551c9SThomas Gleixner 	if (new->thread) {
13983aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
13993aa551c9SThomas Gleixner 
14003aa551c9SThomas Gleixner 		new->thread = NULL;
14013aa551c9SThomas Gleixner 		kthread_stop(t);
14023aa551c9SThomas Gleixner 		put_task_struct(t);
14033aa551c9SThomas Gleixner 	}
14042a1d3ab8SThomas Gleixner 	if (new->secondary && new->secondary->thread) {
14052a1d3ab8SThomas Gleixner 		struct task_struct *t = new->secondary->thread;
14062a1d3ab8SThomas Gleixner 
14072a1d3ab8SThomas Gleixner 		new->secondary->thread = NULL;
14082a1d3ab8SThomas Gleixner 		kthread_stop(t);
14092a1d3ab8SThomas Gleixner 		put_task_struct(t);
14102a1d3ab8SThomas Gleixner 	}
1411b6873807SSebastian Andrzej Siewior out_mput:
1412b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
14133aa551c9SThomas Gleixner 	return ret;
14141da177e4SLinus Torvalds }
14151da177e4SLinus Torvalds 
14161da177e4SLinus Torvalds /**
1417d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1418d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1419d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1420d3c60047SThomas Gleixner  *
1421d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1422d3c60047SThomas Gleixner  */
1423d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1424d3c60047SThomas Gleixner {
1425986c011dSDavid Daney 	int retval;
1426d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1427d3c60047SThomas Gleixner 
14289b5d585dSJon Hunter 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
142931d9d9b6SMarc Zyngier 		return -EINVAL;
1430be45beb2SJon Hunter 
1431be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
1432be45beb2SJon Hunter 	if (retval < 0)
1433be45beb2SJon Hunter 		return retval;
1434be45beb2SJon Hunter 
1435986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1436986c011dSDavid Daney 
1437be45beb2SJon Hunter 	if (retval)
1438be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
1439be45beb2SJon Hunter 
1440986c011dSDavid Daney 	return retval;
1441d3c60047SThomas Gleixner }
1442eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1443d3c60047SThomas Gleixner 
1444cbf94f06SMagnus Damm /*
1445cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1446cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
14471da177e4SLinus Torvalds  */
1448cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id)
14491da177e4SLinus Torvalds {
1450d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1451f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
14521da177e4SLinus Torvalds 	unsigned long flags;
14531da177e4SLinus Torvalds 
1454ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
14557d94f7caSYinghai Lu 
14567d94f7caSYinghai Lu 	if (!desc)
1457f21cfb25SMagnus Damm 		return NULL;
14581da177e4SLinus Torvalds 
14599114014cSThomas Gleixner 	mutex_lock(&desc->request_mutex);
1460abc7e40cSThomas Gleixner 	chip_bus_lock(desc);
1461239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1462ae88a23bSIngo Molnar 
1463ae88a23bSIngo Molnar 	/*
1464ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1465ae88a23bSIngo Molnar 	 * one based on the dev_id:
1466ae88a23bSIngo Molnar 	 */
1467f17c7545SIngo Molnar 	action_ptr = &desc->action;
14681da177e4SLinus Torvalds 	for (;;) {
1469f17c7545SIngo Molnar 		action = *action_ptr;
14701da177e4SLinus Torvalds 
1471ae88a23bSIngo Molnar 		if (!action) {
1472ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1473239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1474abc7e40cSThomas Gleixner 			chip_bus_sync_unlock(desc);
1475f21cfb25SMagnus Damm 			return NULL;
1476ae88a23bSIngo Molnar 		}
14771da177e4SLinus Torvalds 
14788316e381SIngo Molnar 		if (action->dev_id == dev_id)
1479ae88a23bSIngo Molnar 			break;
1480f17c7545SIngo Molnar 		action_ptr = &action->next;
1481ae88a23bSIngo Molnar 	}
1482ae88a23bSIngo Molnar 
1483ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1484f17c7545SIngo Molnar 	*action_ptr = action->next;
1485dbce706eSPaolo 'Blaisorblade' Giarrusso 
1486cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1487cab303beSThomas Gleixner 
1488ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1489c1bacbaeSThomas Gleixner 	if (!desc->action) {
1490e9849777SThomas Gleixner 		irq_settings_clr_disable_unlazy(desc);
149146999238SThomas Gleixner 		irq_shutdown(desc);
1492c1bacbaeSThomas Gleixner 	}
14933aa551c9SThomas Gleixner 
1494e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1495e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1496e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1497e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1498e7a297b0SPeter P Waskiewicz Jr #endif
1499e7a297b0SPeter P Waskiewicz Jr 
1500239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1501abc7e40cSThomas Gleixner 	chip_bus_sync_unlock(desc);
1502ae88a23bSIngo Molnar 
15031da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
15041da177e4SLinus Torvalds 
1505ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
15061da177e4SLinus Torvalds 	synchronize_irq(irq);
1507ae88a23bSIngo Molnar 
15081d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
15091d99493bSDavid Woodhouse 	/*
1510ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1511ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1512ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1513ae88a23bSIngo Molnar 	 *
1514ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
1515ae88a23bSIngo Molnar 	 *   'real' IRQ doesn't run in * parallel with our fake. )
15161d99493bSDavid Woodhouse 	 */
15171d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
15181d99493bSDavid Woodhouse 		local_irq_save(flags);
15191d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
15201d99493bSDavid Woodhouse 		local_irq_restore(flags);
15211d99493bSDavid Woodhouse 	}
15221d99493bSDavid Woodhouse #endif
15232d860ad7SLinus Torvalds 
15242d860ad7SLinus Torvalds 	if (action->thread) {
15252d860ad7SLinus Torvalds 		kthread_stop(action->thread);
15262d860ad7SLinus Torvalds 		put_task_struct(action->thread);
15272a1d3ab8SThomas Gleixner 		if (action->secondary && action->secondary->thread) {
15282a1d3ab8SThomas Gleixner 			kthread_stop(action->secondary->thread);
15292a1d3ab8SThomas Gleixner 			put_task_struct(action->secondary->thread);
15302a1d3ab8SThomas Gleixner 		}
15312d860ad7SLinus Torvalds 	}
15322d860ad7SLinus Torvalds 
1533*2343877fSThomas Gleixner 	if (!desc->action) {
153446e48e25SThomas Gleixner 		irq_release_resources(desc);
1535*2343877fSThomas Gleixner 		irq_remove_timings(desc);
1536*2343877fSThomas Gleixner 	}
153746e48e25SThomas Gleixner 
15389114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
15399114014cSThomas Gleixner 
1540be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
1541b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
15422a1d3ab8SThomas Gleixner 	kfree(action->secondary);
1543f21cfb25SMagnus Damm 	return action;
1544f21cfb25SMagnus Damm }
15451da177e4SLinus Torvalds 
15461da177e4SLinus Torvalds /**
1547cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1548cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1549cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1550cbf94f06SMagnus Damm  *
1551cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1552cbf94f06SMagnus Damm  */
1553cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1554cbf94f06SMagnus Damm {
155531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
155631d9d9b6SMarc Zyngier 
155731d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1558cbf94f06SMagnus Damm 		__free_irq(irq, act->dev_id);
1559cbf94f06SMagnus Damm }
1560eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1561cbf94f06SMagnus Damm 
1562cbf94f06SMagnus Damm /**
1563f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
15641da177e4SLinus Torvalds  *	@irq: Interrupt line to free
15651da177e4SLinus Torvalds  *	@dev_id: Device identity to free
15661da177e4SLinus Torvalds  *
15671da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
15681da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
15691da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
15701da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
15711da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
15721da177e4SLinus Torvalds  *	have completed.
15731da177e4SLinus Torvalds  *
15741da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
157525ce4be7SChristoph Hellwig  *
157625ce4be7SChristoph Hellwig  *	Returns the devname argument passed to request_irq.
15771da177e4SLinus Torvalds  */
157825ce4be7SChristoph Hellwig const void *free_irq(unsigned int irq, void *dev_id)
15791da177e4SLinus Torvalds {
158070aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
158125ce4be7SChristoph Hellwig 	struct irqaction *action;
158225ce4be7SChristoph Hellwig 	const char *devname;
158370aedd24SThomas Gleixner 
158431d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
158525ce4be7SChristoph Hellwig 		return NULL;
158670aedd24SThomas Gleixner 
1587cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1588cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1589cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1590cd7eab44SBen Hutchings #endif
1591cd7eab44SBen Hutchings 
159225ce4be7SChristoph Hellwig 	action = __free_irq(irq, dev_id);
159325ce4be7SChristoph Hellwig 	devname = action->name;
159425ce4be7SChristoph Hellwig 	kfree(action);
159525ce4be7SChristoph Hellwig 	return devname;
15961da177e4SLinus Torvalds }
15971da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
15981da177e4SLinus Torvalds 
15991da177e4SLinus Torvalds /**
16003aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
16011da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
16023aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
16033aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1604b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1605b25c340cSThomas Gleixner  *		  primary handler is installed
16063aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
16073aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
16081da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
16091da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
16101da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
16111da177e4SLinus Torvalds  *
16121da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
16131da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
16141da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
16151da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
16161da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
16171da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
16181da177e4SLinus Torvalds  *
16193aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
16206d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
16213aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
16223aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
16233aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
162439a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
16253aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
16263aa551c9SThomas Gleixner  *	shared interrupts.
16273aa551c9SThomas Gleixner  *
16281da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
16291da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
16301da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
16311da177e4SLinus Torvalds  *
16321da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
16331da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
16341da177e4SLinus Torvalds  *
16351da177e4SLinus Torvalds  *	Flags:
16361da177e4SLinus Torvalds  *
16373cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
16380c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
16391da177e4SLinus Torvalds  *
16401da177e4SLinus Torvalds  */
16413aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
16423aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
16433aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
16441da177e4SLinus Torvalds {
16451da177e4SLinus Torvalds 	struct irqaction *action;
164608678b08SYinghai Lu 	struct irq_desc *desc;
1647d3c60047SThomas Gleixner 	int retval;
16481da177e4SLinus Torvalds 
1649e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1650e237a551SChen Fan 		return -ENOTCONN;
1651e237a551SChen Fan 
1652470c6623SDavid Brownell 	/*
16531da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
16541da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
16551da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
16561da177e4SLinus Torvalds 	 * logic etc).
165717f48034SRafael J. Wysocki 	 *
165817f48034SRafael J. Wysocki 	 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and
165917f48034SRafael J. Wysocki 	 * it cannot be set along with IRQF_NO_SUSPEND.
16601da177e4SLinus Torvalds 	 */
166117f48034SRafael J. Wysocki 	if (((irqflags & IRQF_SHARED) && !dev_id) ||
166217f48034SRafael J. Wysocki 	    (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) ||
166317f48034SRafael J. Wysocki 	    ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND)))
16641da177e4SLinus Torvalds 		return -EINVAL;
16657d94f7caSYinghai Lu 
1666cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
16677d94f7caSYinghai Lu 	if (!desc)
16681da177e4SLinus Torvalds 		return -EINVAL;
16697d94f7caSYinghai Lu 
167031d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
167131d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
16726550c775SThomas Gleixner 		return -EINVAL;
1673b25c340cSThomas Gleixner 
1674b25c340cSThomas Gleixner 	if (!handler) {
1675b25c340cSThomas Gleixner 		if (!thread_fn)
16761da177e4SLinus Torvalds 			return -EINVAL;
1677b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1678b25c340cSThomas Gleixner 	}
16791da177e4SLinus Torvalds 
168045535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
16811da177e4SLinus Torvalds 	if (!action)
16821da177e4SLinus Torvalds 		return -ENOMEM;
16831da177e4SLinus Torvalds 
16841da177e4SLinus Torvalds 	action->handler = handler;
16853aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
16861da177e4SLinus Torvalds 	action->flags = irqflags;
16871da177e4SLinus Torvalds 	action->name = devname;
16881da177e4SLinus Torvalds 	action->dev_id = dev_id;
16891da177e4SLinus Torvalds 
1690be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
16914396f46cSShawn Lin 	if (retval < 0) {
16924396f46cSShawn Lin 		kfree(action);
1693be45beb2SJon Hunter 		return retval;
16944396f46cSShawn Lin 	}
1695be45beb2SJon Hunter 
1696d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
169770aedd24SThomas Gleixner 
16982a1d3ab8SThomas Gleixner 	if (retval) {
1699be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
17002a1d3ab8SThomas Gleixner 		kfree(action->secondary);
1701377bf1e4SAnton Vorontsov 		kfree(action);
17022a1d3ab8SThomas Gleixner 	}
1703377bf1e4SAnton Vorontsov 
17046d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
17056ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1706a304e1b8SDavid Woodhouse 		/*
1707a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
1708a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
1709377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
1710377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
1711a304e1b8SDavid Woodhouse 		 */
1712a304e1b8SDavid Woodhouse 		unsigned long flags;
1713a304e1b8SDavid Woodhouse 
1714377bf1e4SAnton Vorontsov 		disable_irq(irq);
1715a304e1b8SDavid Woodhouse 		local_irq_save(flags);
1716377bf1e4SAnton Vorontsov 
1717a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
1718377bf1e4SAnton Vorontsov 
1719a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
1720377bf1e4SAnton Vorontsov 		enable_irq(irq);
1721a304e1b8SDavid Woodhouse 	}
1722a304e1b8SDavid Woodhouse #endif
17231da177e4SLinus Torvalds 	return retval;
17241da177e4SLinus Torvalds }
17253aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
1726ae731f8dSMarc Zyngier 
1727ae731f8dSMarc Zyngier /**
1728ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
1729ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
1730ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
1731ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
1732ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
1733ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
1734ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
1735ae731f8dSMarc Zyngier  *
1736ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
1737ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
1738ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
1739ae731f8dSMarc Zyngier  *	context.
1740ae731f8dSMarc Zyngier  *
1741ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
1742ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
1743ae731f8dSMarc Zyngier  */
1744ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
1745ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
1746ae731f8dSMarc Zyngier {
1747e237a551SChen Fan 	struct irq_desc *desc;
1748ae731f8dSMarc Zyngier 	int ret;
1749ae731f8dSMarc Zyngier 
1750e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1751e237a551SChen Fan 		return -ENOTCONN;
1752e237a551SChen Fan 
1753e237a551SChen Fan 	desc = irq_to_desc(irq);
1754ae731f8dSMarc Zyngier 	if (!desc)
1755ae731f8dSMarc Zyngier 		return -EINVAL;
1756ae731f8dSMarc Zyngier 
17571ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
1758ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
1759ae731f8dSMarc Zyngier 					   flags, name, dev_id);
1760ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
1761ae731f8dSMarc Zyngier 	}
1762ae731f8dSMarc Zyngier 
1763ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
1764ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
1765ae731f8dSMarc Zyngier }
1766ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
176731d9d9b6SMarc Zyngier 
17681e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
176931d9d9b6SMarc Zyngier {
177031d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
177131d9d9b6SMarc Zyngier 	unsigned long flags;
177231d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
177331d9d9b6SMarc Zyngier 
177431d9d9b6SMarc Zyngier 	if (!desc)
177531d9d9b6SMarc Zyngier 		return;
177631d9d9b6SMarc Zyngier 
1777f35ad083SMarc Zyngier 	/*
1778f35ad083SMarc Zyngier 	 * If the trigger type is not specified by the caller, then
1779f35ad083SMarc Zyngier 	 * use the default for this interrupt.
1780f35ad083SMarc Zyngier 	 */
17811e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
1782f35ad083SMarc Zyngier 	if (type == IRQ_TYPE_NONE)
1783f35ad083SMarc Zyngier 		type = irqd_get_trigger_type(&desc->irq_data);
1784f35ad083SMarc Zyngier 
17851e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
17861e7c5fd2SMarc Zyngier 		int ret;
17871e7c5fd2SMarc Zyngier 
1788a1ff541aSJiang Liu 		ret = __irq_set_trigger(desc, type);
17891e7c5fd2SMarc Zyngier 
17901e7c5fd2SMarc Zyngier 		if (ret) {
179132cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
17921e7c5fd2SMarc Zyngier 			goto out;
17931e7c5fd2SMarc Zyngier 		}
17941e7c5fd2SMarc Zyngier 	}
17951e7c5fd2SMarc Zyngier 
179631d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
17971e7c5fd2SMarc Zyngier out:
179831d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
179931d9d9b6SMarc Zyngier }
180036a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
180131d9d9b6SMarc Zyngier 
1802f0cb3220SThomas Petazzoni /**
1803f0cb3220SThomas Petazzoni  * irq_percpu_is_enabled - Check whether the per cpu irq is enabled
1804f0cb3220SThomas Petazzoni  * @irq:	Linux irq number to check for
1805f0cb3220SThomas Petazzoni  *
1806f0cb3220SThomas Petazzoni  * Must be called from a non migratable context. Returns the enable
1807f0cb3220SThomas Petazzoni  * state of a per cpu interrupt on the current cpu.
1808f0cb3220SThomas Petazzoni  */
1809f0cb3220SThomas Petazzoni bool irq_percpu_is_enabled(unsigned int irq)
1810f0cb3220SThomas Petazzoni {
1811f0cb3220SThomas Petazzoni 	unsigned int cpu = smp_processor_id();
1812f0cb3220SThomas Petazzoni 	struct irq_desc *desc;
1813f0cb3220SThomas Petazzoni 	unsigned long flags;
1814f0cb3220SThomas Petazzoni 	bool is_enabled;
1815f0cb3220SThomas Petazzoni 
1816f0cb3220SThomas Petazzoni 	desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
1817f0cb3220SThomas Petazzoni 	if (!desc)
1818f0cb3220SThomas Petazzoni 		return false;
1819f0cb3220SThomas Petazzoni 
1820f0cb3220SThomas Petazzoni 	is_enabled = cpumask_test_cpu(cpu, desc->percpu_enabled);
1821f0cb3220SThomas Petazzoni 	irq_put_desc_unlock(desc, flags);
1822f0cb3220SThomas Petazzoni 
1823f0cb3220SThomas Petazzoni 	return is_enabled;
1824f0cb3220SThomas Petazzoni }
1825f0cb3220SThomas Petazzoni EXPORT_SYMBOL_GPL(irq_percpu_is_enabled);
1826f0cb3220SThomas Petazzoni 
182731d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
182831d9d9b6SMarc Zyngier {
182931d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
183031d9d9b6SMarc Zyngier 	unsigned long flags;
183131d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
183231d9d9b6SMarc Zyngier 
183331d9d9b6SMarc Zyngier 	if (!desc)
183431d9d9b6SMarc Zyngier 		return;
183531d9d9b6SMarc Zyngier 
183631d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
183731d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
183831d9d9b6SMarc Zyngier }
183936a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
184031d9d9b6SMarc Zyngier 
184131d9d9b6SMarc Zyngier /*
184231d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
184331d9d9b6SMarc Zyngier  */
184431d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
184531d9d9b6SMarc Zyngier {
184631d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
184731d9d9b6SMarc Zyngier 	struct irqaction *action;
184831d9d9b6SMarc Zyngier 	unsigned long flags;
184931d9d9b6SMarc Zyngier 
185031d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
185131d9d9b6SMarc Zyngier 
185231d9d9b6SMarc Zyngier 	if (!desc)
185331d9d9b6SMarc Zyngier 		return NULL;
185431d9d9b6SMarc Zyngier 
185531d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
185631d9d9b6SMarc Zyngier 
185731d9d9b6SMarc Zyngier 	action = desc->action;
185831d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
185931d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
186031d9d9b6SMarc Zyngier 		goto bad;
186131d9d9b6SMarc Zyngier 	}
186231d9d9b6SMarc Zyngier 
186331d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
186431d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
186531d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
186631d9d9b6SMarc Zyngier 		goto bad;
186731d9d9b6SMarc Zyngier 	}
186831d9d9b6SMarc Zyngier 
186931d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
187031d9d9b6SMarc Zyngier 	desc->action = NULL;
187131d9d9b6SMarc Zyngier 
187231d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
187331d9d9b6SMarc Zyngier 
187431d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
187531d9d9b6SMarc Zyngier 
1876be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
187731d9d9b6SMarc Zyngier 	module_put(desc->owner);
187831d9d9b6SMarc Zyngier 	return action;
187931d9d9b6SMarc Zyngier 
188031d9d9b6SMarc Zyngier bad:
188131d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
188231d9d9b6SMarc Zyngier 	return NULL;
188331d9d9b6SMarc Zyngier }
188431d9d9b6SMarc Zyngier 
188531d9d9b6SMarc Zyngier /**
188631d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
188731d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
188831d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
188931d9d9b6SMarc Zyngier  *
189031d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
189131d9d9b6SMarc Zyngier  */
189231d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
189331d9d9b6SMarc Zyngier {
189431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
189531d9d9b6SMarc Zyngier 
189631d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
189731d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
189831d9d9b6SMarc Zyngier }
189931d9d9b6SMarc Zyngier 
190031d9d9b6SMarc Zyngier /**
190131d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
190231d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
190331d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
190431d9d9b6SMarc Zyngier  *
190531d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
190631d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
190731d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
190831d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
190931d9d9b6SMarc Zyngier  *
191031d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
191131d9d9b6SMarc Zyngier  */
191231d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
191331d9d9b6SMarc Zyngier {
191431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
191531d9d9b6SMarc Zyngier 
191631d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
191731d9d9b6SMarc Zyngier 		return;
191831d9d9b6SMarc Zyngier 
191931d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
192031d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
192131d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
192231d9d9b6SMarc Zyngier }
1923aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(free_percpu_irq);
192431d9d9b6SMarc Zyngier 
192531d9d9b6SMarc Zyngier /**
192631d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
192731d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
192831d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
192931d9d9b6SMarc Zyngier  *
193031d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
193131d9d9b6SMarc Zyngier  */
193231d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
193331d9d9b6SMarc Zyngier {
193431d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
193531d9d9b6SMarc Zyngier 	int retval;
193631d9d9b6SMarc Zyngier 
193731d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
193831d9d9b6SMarc Zyngier 		return -EINVAL;
1939be45beb2SJon Hunter 
1940be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
1941be45beb2SJon Hunter 	if (retval < 0)
1942be45beb2SJon Hunter 		return retval;
1943be45beb2SJon Hunter 
194431d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
194531d9d9b6SMarc Zyngier 
1946be45beb2SJon Hunter 	if (retval)
1947be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
1948be45beb2SJon Hunter 
194931d9d9b6SMarc Zyngier 	return retval;
195031d9d9b6SMarc Zyngier }
195131d9d9b6SMarc Zyngier 
195231d9d9b6SMarc Zyngier /**
195331d9d9b6SMarc Zyngier  *	request_percpu_irq - allocate a percpu interrupt line
195431d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
195531d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
195631d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
195731d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
195831d9d9b6SMarc Zyngier  *
1959a1b7febdSMaxime Ripard  *	This call allocates interrupt resources and enables the
1960a1b7febdSMaxime Ripard  *	interrupt on the local CPU. If the interrupt is supposed to be
1961a1b7febdSMaxime Ripard  *	enabled on other CPUs, it has to be done on each CPU using
1962a1b7febdSMaxime Ripard  *	enable_percpu_irq().
196331d9d9b6SMarc Zyngier  *
196431d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
196531d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
196631d9d9b6SMarc Zyngier  *	that variable.
196731d9d9b6SMarc Zyngier  */
196831d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler,
196931d9d9b6SMarc Zyngier 		       const char *devname, void __percpu *dev_id)
197031d9d9b6SMarc Zyngier {
197131d9d9b6SMarc Zyngier 	struct irqaction *action;
197231d9d9b6SMarc Zyngier 	struct irq_desc *desc;
197331d9d9b6SMarc Zyngier 	int retval;
197431d9d9b6SMarc Zyngier 
197531d9d9b6SMarc Zyngier 	if (!dev_id)
197631d9d9b6SMarc Zyngier 		return -EINVAL;
197731d9d9b6SMarc Zyngier 
197831d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
197931d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
198031d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
198131d9d9b6SMarc Zyngier 		return -EINVAL;
198231d9d9b6SMarc Zyngier 
198331d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
198431d9d9b6SMarc Zyngier 	if (!action)
198531d9d9b6SMarc Zyngier 		return -ENOMEM;
198631d9d9b6SMarc Zyngier 
198731d9d9b6SMarc Zyngier 	action->handler = handler;
19882ed0e645SMarc Zyngier 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND;
198931d9d9b6SMarc Zyngier 	action->name = devname;
199031d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
199131d9d9b6SMarc Zyngier 
1992be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
19934396f46cSShawn Lin 	if (retval < 0) {
19944396f46cSShawn Lin 		kfree(action);
1995be45beb2SJon Hunter 		return retval;
19964396f46cSShawn Lin 	}
1997be45beb2SJon Hunter 
199831d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
199931d9d9b6SMarc Zyngier 
2000be45beb2SJon Hunter 	if (retval) {
2001be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
200231d9d9b6SMarc Zyngier 		kfree(action);
2003be45beb2SJon Hunter 	}
200431d9d9b6SMarc Zyngier 
200531d9d9b6SMarc Zyngier 	return retval;
200631d9d9b6SMarc Zyngier }
2007aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(request_percpu_irq);
20081b7047edSMarc Zyngier 
20091b7047edSMarc Zyngier /**
20101b7047edSMarc Zyngier  *	irq_get_irqchip_state - returns the irqchip state of a interrupt.
20111b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
20121b7047edSMarc Zyngier  *	@which: One of IRQCHIP_STATE_* the caller wants to know about
20131b7047edSMarc Zyngier  *	@state: a pointer to a boolean where the state is to be storeed
20141b7047edSMarc Zyngier  *
20151b7047edSMarc Zyngier  *	This call snapshots the internal irqchip state of an
20161b7047edSMarc Zyngier  *	interrupt, returning into @state the bit corresponding to
20171b7047edSMarc Zyngier  *	stage @which
20181b7047edSMarc Zyngier  *
20191b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
20201b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
20211b7047edSMarc Zyngier  */
20221b7047edSMarc Zyngier int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
20231b7047edSMarc Zyngier 			  bool *state)
20241b7047edSMarc Zyngier {
20251b7047edSMarc Zyngier 	struct irq_desc *desc;
20261b7047edSMarc Zyngier 	struct irq_data *data;
20271b7047edSMarc Zyngier 	struct irq_chip *chip;
20281b7047edSMarc Zyngier 	unsigned long flags;
20291b7047edSMarc Zyngier 	int err = -EINVAL;
20301b7047edSMarc Zyngier 
20311b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
20321b7047edSMarc Zyngier 	if (!desc)
20331b7047edSMarc Zyngier 		return err;
20341b7047edSMarc Zyngier 
20351b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
20361b7047edSMarc Zyngier 
20371b7047edSMarc Zyngier 	do {
20381b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
20391b7047edSMarc Zyngier 		if (chip->irq_get_irqchip_state)
20401b7047edSMarc Zyngier 			break;
20411b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
20421b7047edSMarc Zyngier 		data = data->parent_data;
20431b7047edSMarc Zyngier #else
20441b7047edSMarc Zyngier 		data = NULL;
20451b7047edSMarc Zyngier #endif
20461b7047edSMarc Zyngier 	} while (data);
20471b7047edSMarc Zyngier 
20481b7047edSMarc Zyngier 	if (data)
20491b7047edSMarc Zyngier 		err = chip->irq_get_irqchip_state(data, which, state);
20501b7047edSMarc Zyngier 
20511b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
20521b7047edSMarc Zyngier 	return err;
20531b7047edSMarc Zyngier }
20541ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_get_irqchip_state);
20551b7047edSMarc Zyngier 
20561b7047edSMarc Zyngier /**
20571b7047edSMarc Zyngier  *	irq_set_irqchip_state - set the state of a forwarded interrupt.
20581b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
20591b7047edSMarc Zyngier  *	@which: State to be restored (one of IRQCHIP_STATE_*)
20601b7047edSMarc Zyngier  *	@val: Value corresponding to @which
20611b7047edSMarc Zyngier  *
20621b7047edSMarc Zyngier  *	This call sets the internal irqchip state of an interrupt,
20631b7047edSMarc Zyngier  *	depending on the value of @which.
20641b7047edSMarc Zyngier  *
20651b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
20661b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
20671b7047edSMarc Zyngier  */
20681b7047edSMarc Zyngier int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
20691b7047edSMarc Zyngier 			  bool val)
20701b7047edSMarc Zyngier {
20711b7047edSMarc Zyngier 	struct irq_desc *desc;
20721b7047edSMarc Zyngier 	struct irq_data *data;
20731b7047edSMarc Zyngier 	struct irq_chip *chip;
20741b7047edSMarc Zyngier 	unsigned long flags;
20751b7047edSMarc Zyngier 	int err = -EINVAL;
20761b7047edSMarc Zyngier 
20771b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
20781b7047edSMarc Zyngier 	if (!desc)
20791b7047edSMarc Zyngier 		return err;
20801b7047edSMarc Zyngier 
20811b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
20821b7047edSMarc Zyngier 
20831b7047edSMarc Zyngier 	do {
20841b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
20851b7047edSMarc Zyngier 		if (chip->irq_set_irqchip_state)
20861b7047edSMarc Zyngier 			break;
20871b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
20881b7047edSMarc Zyngier 		data = data->parent_data;
20891b7047edSMarc Zyngier #else
20901b7047edSMarc Zyngier 		data = NULL;
20911b7047edSMarc Zyngier #endif
20921b7047edSMarc Zyngier 	} while (data);
20931b7047edSMarc Zyngier 
20941b7047edSMarc Zyngier 	if (data)
20951b7047edSMarc Zyngier 		err = chip->irq_set_irqchip_state(data, which, val);
20961b7047edSMarc Zyngier 
20971b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
20981b7047edSMarc Zyngier 	return err;
20991b7047edSMarc Zyngier }
21001ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_set_irqchip_state);
2101