xref: /openbmc/linux/kernel/irq/manage.c (revision d75f773c86a2b8b7278e2c33343b46a4024bc002)
152a65ff5SThomas Gleixner // SPDX-License-Identifier: GPL-2.0
21da177e4SLinus Torvalds /*
3a34db9b2SIngo Molnar  * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar
4a34db9b2SIngo Molnar  * Copyright (C) 2005-2006 Thomas Gleixner
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  * This file contains driver APIs to the irq subsystem.
71da177e4SLinus Torvalds  */
81da177e4SLinus Torvalds 
997fd75b7SAndrew Morton #define pr_fmt(fmt) "genirq: " fmt
1097fd75b7SAndrew Morton 
111da177e4SLinus Torvalds #include <linux/irq.h>
123aa551c9SThomas Gleixner #include <linux/kthread.h>
131da177e4SLinus Torvalds #include <linux/module.h>
141da177e4SLinus Torvalds #include <linux/random.h>
151da177e4SLinus Torvalds #include <linux/interrupt.h>
161aeb272cSRobert P. J. Day #include <linux/slab.h>
173aa551c9SThomas Gleixner #include <linux/sched.h>
188bd75c77SClark Williams #include <linux/sched/rt.h>
190881e7bdSIngo Molnar #include <linux/sched/task.h>
20ae7e81c0SIngo Molnar #include <uapi/linux/sched/types.h>
214d1d61a6SOleg Nesterov #include <linux/task_work.h>
221da177e4SLinus Torvalds 
231da177e4SLinus Torvalds #include "internals.h"
241da177e4SLinus Torvalds 
258d32a307SThomas Gleixner #ifdef CONFIG_IRQ_FORCED_THREADING
268d32a307SThomas Gleixner __read_mostly bool force_irqthreads;
2747b82e88SSebastian Andrzej Siewior EXPORT_SYMBOL_GPL(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 
17119e1d4e9SThomas Gleixner static void irq_validate_effective_affinity(struct irq_data *data)
17219e1d4e9SThomas Gleixner {
17319e1d4e9SThomas Gleixner #ifdef CONFIG_GENERIC_IRQ_EFFECTIVE_AFF_MASK
17419e1d4e9SThomas Gleixner 	const struct cpumask *m = irq_data_get_effective_affinity_mask(data);
17519e1d4e9SThomas Gleixner 	struct irq_chip *chip = irq_data_get_irq_chip(data);
17619e1d4e9SThomas Gleixner 
17719e1d4e9SThomas Gleixner 	if (!cpumask_empty(m))
17819e1d4e9SThomas Gleixner 		return;
17919e1d4e9SThomas Gleixner 	pr_warn_once("irq_chip %s did not update eff. affinity mask of irq %u\n",
18019e1d4e9SThomas Gleixner 		     chip->name, data->irq);
18119e1d4e9SThomas Gleixner #endif
18219e1d4e9SThomas Gleixner }
18319e1d4e9SThomas Gleixner 
184818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask,
185818b0f3bSJiang Liu 			bool force)
186818b0f3bSJiang Liu {
187818b0f3bSJiang Liu 	struct irq_desc *desc = irq_data_to_desc(data);
188818b0f3bSJiang Liu 	struct irq_chip *chip = irq_data_get_irq_chip(data);
189818b0f3bSJiang Liu 	int ret;
190818b0f3bSJiang Liu 
191e43b3b58SThomas Gleixner 	if (!chip || !chip->irq_set_affinity)
192e43b3b58SThomas Gleixner 		return -EINVAL;
193e43b3b58SThomas Gleixner 
19401f8fa4fSThomas Gleixner 	ret = chip->irq_set_affinity(data, mask, force);
195818b0f3bSJiang Liu 	switch (ret) {
196818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK:
1972cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
1989df872faSJiang Liu 		cpumask_copy(desc->irq_common_data.affinity, mask);
199818b0f3bSJiang Liu 	case IRQ_SET_MASK_OK_NOCOPY:
20019e1d4e9SThomas Gleixner 		irq_validate_effective_affinity(data);
201818b0f3bSJiang Liu 		irq_set_thread_affinity(desc);
202818b0f3bSJiang Liu 		ret = 0;
203818b0f3bSJiang Liu 	}
204818b0f3bSJiang Liu 
205818b0f3bSJiang Liu 	return ret;
206818b0f3bSJiang Liu }
207818b0f3bSJiang Liu 
20812f47073SThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ
20912f47073SThomas Gleixner static inline int irq_set_affinity_pending(struct irq_data *data,
21012f47073SThomas Gleixner 					   const struct cpumask *dest)
21112f47073SThomas Gleixner {
21212f47073SThomas Gleixner 	struct irq_desc *desc = irq_data_to_desc(data);
21312f47073SThomas Gleixner 
21412f47073SThomas Gleixner 	irqd_set_move_pending(data);
21512f47073SThomas Gleixner 	irq_copy_pending(desc, dest);
21612f47073SThomas Gleixner 	return 0;
21712f47073SThomas Gleixner }
21812f47073SThomas Gleixner #else
21912f47073SThomas Gleixner static inline int irq_set_affinity_pending(struct irq_data *data,
22012f47073SThomas Gleixner 					   const struct cpumask *dest)
22112f47073SThomas Gleixner {
22212f47073SThomas Gleixner 	return -EBUSY;
22312f47073SThomas Gleixner }
22412f47073SThomas Gleixner #endif
22512f47073SThomas Gleixner 
22612f47073SThomas Gleixner static int irq_try_set_affinity(struct irq_data *data,
22712f47073SThomas Gleixner 				const struct cpumask *dest, bool force)
22812f47073SThomas Gleixner {
22912f47073SThomas Gleixner 	int ret = irq_do_set_affinity(data, dest, force);
23012f47073SThomas Gleixner 
23112f47073SThomas Gleixner 	/*
23212f47073SThomas Gleixner 	 * In case that the underlying vector management is busy and the
23312f47073SThomas Gleixner 	 * architecture supports the generic pending mechanism then utilize
23412f47073SThomas Gleixner 	 * this to avoid returning an error to user space.
23512f47073SThomas Gleixner 	 */
23612f47073SThomas Gleixner 	if (ret == -EBUSY && !force)
23712f47073SThomas Gleixner 		ret = irq_set_affinity_pending(data, dest);
23812f47073SThomas Gleixner 	return ret;
23912f47073SThomas Gleixner }
24012f47073SThomas Gleixner 
24101f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask,
24201f8fa4fSThomas Gleixner 			    bool force)
243c2d0c555SDavid Daney {
244c2d0c555SDavid Daney 	struct irq_chip *chip = irq_data_get_irq_chip(data);
245c2d0c555SDavid Daney 	struct irq_desc *desc = irq_data_to_desc(data);
246c2d0c555SDavid Daney 	int ret = 0;
247c2d0c555SDavid Daney 
248c2d0c555SDavid Daney 	if (!chip || !chip->irq_set_affinity)
249c2d0c555SDavid Daney 		return -EINVAL;
250c2d0c555SDavid Daney 
25112f47073SThomas Gleixner 	if (irq_can_move_pcntxt(data) && !irqd_is_setaffinity_pending(data)) {
25212f47073SThomas Gleixner 		ret = irq_try_set_affinity(data, mask, force);
253c2d0c555SDavid Daney 	} else {
254c2d0c555SDavid Daney 		irqd_set_move_pending(data);
255c2d0c555SDavid Daney 		irq_copy_pending(desc, mask);
256c2d0c555SDavid Daney 	}
257c2d0c555SDavid Daney 
258c2d0c555SDavid Daney 	if (desc->affinity_notify) {
259c2d0c555SDavid Daney 		kref_get(&desc->affinity_notify->kref);
260c2d0c555SDavid Daney 		schedule_work(&desc->affinity_notify->work);
261c2d0c555SDavid Daney 	}
262c2d0c555SDavid Daney 	irqd_set(data, IRQD_AFFINITY_SET);
263c2d0c555SDavid Daney 
264c2d0c555SDavid Daney 	return ret;
265c2d0c555SDavid Daney }
266c2d0c555SDavid Daney 
26701f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force)
268771ee3b0SThomas Gleixner {
26908678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
270f6d87f4bSThomas Gleixner 	unsigned long flags;
271c2d0c555SDavid Daney 	int ret;
272771ee3b0SThomas Gleixner 
273c2d0c555SDavid Daney 	if (!desc)
274771ee3b0SThomas Gleixner 		return -EINVAL;
275771ee3b0SThomas Gleixner 
276239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
27701f8fa4fSThomas Gleixner 	ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force);
278239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2791fa46f1fSThomas Gleixner 	return ret;
280771ee3b0SThomas Gleixner }
281771ee3b0SThomas Gleixner 
282e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m)
283e7a297b0SPeter P Waskiewicz Jr {
284e7a297b0SPeter P Waskiewicz Jr 	unsigned long flags;
28531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
286e7a297b0SPeter P Waskiewicz Jr 
287e7a297b0SPeter P Waskiewicz Jr 	if (!desc)
288e7a297b0SPeter P Waskiewicz Jr 		return -EINVAL;
289e7a297b0SPeter P Waskiewicz Jr 	desc->affinity_hint = m;
29002725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
291e2e64a93SJesse Brandeburg 	/* set the initial affinity to prevent every interrupt being on CPU0 */
2924fe7ffb7SJesse Brandeburg 	if (m)
293e2e64a93SJesse Brandeburg 		__irq_set_affinity(irq, m, false);
294e7a297b0SPeter P Waskiewicz Jr 	return 0;
295e7a297b0SPeter P Waskiewicz Jr }
296e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint);
297e7a297b0SPeter P Waskiewicz Jr 
298cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work)
299cd7eab44SBen Hutchings {
300cd7eab44SBen Hutchings 	struct irq_affinity_notify *notify =
301cd7eab44SBen Hutchings 		container_of(work, struct irq_affinity_notify, work);
302cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(notify->irq);
303cd7eab44SBen Hutchings 	cpumask_var_t cpumask;
304cd7eab44SBen Hutchings 	unsigned long flags;
305cd7eab44SBen Hutchings 
3061fa46f1fSThomas Gleixner 	if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL))
307cd7eab44SBen Hutchings 		goto out;
308cd7eab44SBen Hutchings 
309cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
3100ef5ca1eSThomas Gleixner 	if (irq_move_pending(&desc->irq_data))
3111fa46f1fSThomas Gleixner 		irq_get_pending(cpumask, desc);
312cd7eab44SBen Hutchings 	else
3139df872faSJiang Liu 		cpumask_copy(cpumask, desc->irq_common_data.affinity);
314cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
315cd7eab44SBen Hutchings 
316cd7eab44SBen Hutchings 	notify->notify(notify, cpumask);
317cd7eab44SBen Hutchings 
318cd7eab44SBen Hutchings 	free_cpumask_var(cpumask);
319cd7eab44SBen Hutchings out:
320cd7eab44SBen Hutchings 	kref_put(&notify->kref, notify->release);
321cd7eab44SBen Hutchings }
322cd7eab44SBen Hutchings 
323cd7eab44SBen Hutchings /**
324cd7eab44SBen Hutchings  *	irq_set_affinity_notifier - control notification of IRQ affinity changes
325cd7eab44SBen Hutchings  *	@irq:		Interrupt for which to enable/disable notification
326cd7eab44SBen Hutchings  *	@notify:	Context for notification, or %NULL to disable
327cd7eab44SBen Hutchings  *			notification.  Function pointers must be initialised;
328cd7eab44SBen Hutchings  *			the other fields will be initialised by this function.
329cd7eab44SBen Hutchings  *
330cd7eab44SBen Hutchings  *	Must be called in process context.  Notification may only be enabled
331cd7eab44SBen Hutchings  *	after the IRQ is allocated and must be disabled before the IRQ is
332cd7eab44SBen Hutchings  *	freed using free_irq().
333cd7eab44SBen Hutchings  */
334cd7eab44SBen Hutchings int
335cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify)
336cd7eab44SBen Hutchings {
337cd7eab44SBen Hutchings 	struct irq_desc *desc = irq_to_desc(irq);
338cd7eab44SBen Hutchings 	struct irq_affinity_notify *old_notify;
339cd7eab44SBen Hutchings 	unsigned long flags;
340cd7eab44SBen Hutchings 
341cd7eab44SBen Hutchings 	/* The release function is promised process context */
342cd7eab44SBen Hutchings 	might_sleep();
343cd7eab44SBen Hutchings 
344b525903cSJulien Thierry 	if (!desc || desc->istate & IRQS_NMI)
345cd7eab44SBen Hutchings 		return -EINVAL;
346cd7eab44SBen Hutchings 
347cd7eab44SBen Hutchings 	/* Complete initialisation of *notify */
348cd7eab44SBen Hutchings 	if (notify) {
349cd7eab44SBen Hutchings 		notify->irq = irq;
350cd7eab44SBen Hutchings 		kref_init(&notify->kref);
351cd7eab44SBen Hutchings 		INIT_WORK(&notify->work, irq_affinity_notify);
352cd7eab44SBen Hutchings 	}
353cd7eab44SBen Hutchings 
354cd7eab44SBen Hutchings 	raw_spin_lock_irqsave(&desc->lock, flags);
355cd7eab44SBen Hutchings 	old_notify = desc->affinity_notify;
356cd7eab44SBen Hutchings 	desc->affinity_notify = notify;
357cd7eab44SBen Hutchings 	raw_spin_unlock_irqrestore(&desc->lock, flags);
358cd7eab44SBen Hutchings 
359cd7eab44SBen Hutchings 	if (old_notify)
360cd7eab44SBen Hutchings 		kref_put(&old_notify->kref, old_notify->release);
361cd7eab44SBen Hutchings 
362cd7eab44SBen Hutchings 	return 0;
363cd7eab44SBen Hutchings }
364cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier);
365cd7eab44SBen Hutchings 
36618404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY
36718404756SMax Krasnyansky /*
36818404756SMax Krasnyansky  * Generic version of the affinity autoselector.
36918404756SMax Krasnyansky  */
37043564bd9SThomas Gleixner int irq_setup_affinity(struct irq_desc *desc)
37118404756SMax Krasnyansky {
372569bda8dSThomas Gleixner 	struct cpumask *set = irq_default_affinity;
373cba4235eSThomas Gleixner 	int ret, node = irq_desc_get_node(desc);
374cba4235eSThomas Gleixner 	static DEFINE_RAW_SPINLOCK(mask_lock);
375cba4235eSThomas Gleixner 	static struct cpumask mask;
376569bda8dSThomas Gleixner 
377b008207cSThomas Gleixner 	/* Excludes PER_CPU and NO_BALANCE interrupts */
378e019c249SJiang Liu 	if (!__irq_can_set_affinity(desc))
37918404756SMax Krasnyansky 		return 0;
38018404756SMax Krasnyansky 
381cba4235eSThomas Gleixner 	raw_spin_lock(&mask_lock);
382f6d87f4bSThomas Gleixner 	/*
3839332ef9dSMasahiro Yamada 	 * Preserve the managed affinity setting and a userspace affinity
38406ee6d57SThomas Gleixner 	 * setup, but make sure that one of the targets is online.
385f6d87f4bSThomas Gleixner 	 */
38606ee6d57SThomas Gleixner 	if (irqd_affinity_is_managed(&desc->irq_data) ||
38706ee6d57SThomas Gleixner 	    irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) {
3889df872faSJiang Liu 		if (cpumask_intersects(desc->irq_common_data.affinity,
389569bda8dSThomas Gleixner 				       cpu_online_mask))
3909df872faSJiang Liu 			set = desc->irq_common_data.affinity;
3910c6f8a8bSThomas Gleixner 		else
3922bdd1055SThomas Gleixner 			irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET);
3932bdd1055SThomas Gleixner 	}
39418404756SMax Krasnyansky 
395cba4235eSThomas Gleixner 	cpumask_and(&mask, cpu_online_mask, set);
396bddda606SSrinivas Ramana 	if (cpumask_empty(&mask))
397bddda606SSrinivas Ramana 		cpumask_copy(&mask, cpu_online_mask);
398bddda606SSrinivas Ramana 
399241fc640SPrarit Bhargava 	if (node != NUMA_NO_NODE) {
400241fc640SPrarit Bhargava 		const struct cpumask *nodemask = cpumask_of_node(node);
401241fc640SPrarit Bhargava 
402241fc640SPrarit Bhargava 		/* make sure at least one of the cpus in nodemask is online */
403cba4235eSThomas Gleixner 		if (cpumask_intersects(&mask, nodemask))
404cba4235eSThomas Gleixner 			cpumask_and(&mask, &mask, nodemask);
405241fc640SPrarit Bhargava 	}
406cba4235eSThomas Gleixner 	ret = irq_do_set_affinity(&desc->irq_data, &mask, false);
407cba4235eSThomas Gleixner 	raw_spin_unlock(&mask_lock);
408cba4235eSThomas Gleixner 	return ret;
40918404756SMax Krasnyansky }
410f6d87f4bSThomas Gleixner #else
411a8a98eacSJiang Liu /* Wrapper for ALPHA specific affinity selector magic */
412cba4235eSThomas Gleixner int irq_setup_affinity(struct irq_desc *desc)
413f6d87f4bSThomas Gleixner {
414cba4235eSThomas Gleixner 	return irq_select_affinity(irq_desc_get_irq(desc));
415f6d87f4bSThomas Gleixner }
41618404756SMax Krasnyansky #endif
41718404756SMax Krasnyansky 
418f6d87f4bSThomas Gleixner /*
419cba4235eSThomas Gleixner  * Called when a bogus affinity is set via /proc/irq
420f6d87f4bSThomas Gleixner  */
421cba4235eSThomas Gleixner int irq_select_affinity_usr(unsigned int irq)
422f6d87f4bSThomas Gleixner {
423f6d87f4bSThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
424f6d87f4bSThomas Gleixner 	unsigned long flags;
425f6d87f4bSThomas Gleixner 	int ret;
426f6d87f4bSThomas Gleixner 
427239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
428cba4235eSThomas Gleixner 	ret = irq_setup_affinity(desc);
429239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
430f6d87f4bSThomas Gleixner 	return ret;
431f6d87f4bSThomas Gleixner }
4321da177e4SLinus Torvalds #endif
4331da177e4SLinus Torvalds 
434fcf1ae2fSFeng Wu /**
435fcf1ae2fSFeng Wu  *	irq_set_vcpu_affinity - Set vcpu affinity for the interrupt
436fcf1ae2fSFeng Wu  *	@irq: interrupt number to set affinity
437250a53d6SChristoffer Dall  *	@vcpu_info: vCPU specific data or pointer to a percpu array of vCPU
438250a53d6SChristoffer Dall  *	            specific data for percpu_devid interrupts
439fcf1ae2fSFeng Wu  *
440fcf1ae2fSFeng Wu  *	This function uses the vCPU specific data to set the vCPU
441fcf1ae2fSFeng Wu  *	affinity for an irq. The vCPU specific data is passed from
442fcf1ae2fSFeng Wu  *	outside, such as KVM. One example code path is as below:
443fcf1ae2fSFeng Wu  *	KVM -> IOMMU -> irq_set_vcpu_affinity().
444fcf1ae2fSFeng Wu  */
445fcf1ae2fSFeng Wu int irq_set_vcpu_affinity(unsigned int irq, void *vcpu_info)
446fcf1ae2fSFeng Wu {
447fcf1ae2fSFeng Wu 	unsigned long flags;
448fcf1ae2fSFeng Wu 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
449fcf1ae2fSFeng Wu 	struct irq_data *data;
450fcf1ae2fSFeng Wu 	struct irq_chip *chip;
451fcf1ae2fSFeng Wu 	int ret = -ENOSYS;
452fcf1ae2fSFeng Wu 
453fcf1ae2fSFeng Wu 	if (!desc)
454fcf1ae2fSFeng Wu 		return -EINVAL;
455fcf1ae2fSFeng Wu 
456fcf1ae2fSFeng Wu 	data = irq_desc_get_irq_data(desc);
4570abce64aSMarc Zyngier 	do {
458fcf1ae2fSFeng Wu 		chip = irq_data_get_irq_chip(data);
459fcf1ae2fSFeng Wu 		if (chip && chip->irq_set_vcpu_affinity)
4600abce64aSMarc Zyngier 			break;
4610abce64aSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
4620abce64aSMarc Zyngier 		data = data->parent_data;
4630abce64aSMarc Zyngier #else
4640abce64aSMarc Zyngier 		data = NULL;
4650abce64aSMarc Zyngier #endif
4660abce64aSMarc Zyngier 	} while (data);
4670abce64aSMarc Zyngier 
4680abce64aSMarc Zyngier 	if (data)
469fcf1ae2fSFeng Wu 		ret = chip->irq_set_vcpu_affinity(data, vcpu_info);
470fcf1ae2fSFeng Wu 	irq_put_desc_unlock(desc, flags);
471fcf1ae2fSFeng Wu 
472fcf1ae2fSFeng Wu 	return ret;
473fcf1ae2fSFeng Wu }
474fcf1ae2fSFeng Wu EXPORT_SYMBOL_GPL(irq_set_vcpu_affinity);
475fcf1ae2fSFeng Wu 
47679ff1cdaSJiang Liu void __disable_irq(struct irq_desc *desc)
4770a0c5168SRafael J. Wysocki {
4783aae994fSThomas Gleixner 	if (!desc->depth++)
47987923470SThomas Gleixner 		irq_disable(desc);
4800a0c5168SRafael J. Wysocki }
4810a0c5168SRafael J. Wysocki 
48202725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq)
48302725e74SThomas Gleixner {
48402725e74SThomas Gleixner 	unsigned long flags;
48531d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
48602725e74SThomas Gleixner 
48702725e74SThomas Gleixner 	if (!desc)
48802725e74SThomas Gleixner 		return -EINVAL;
48979ff1cdaSJiang Liu 	__disable_irq(desc);
49002725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
49102725e74SThomas Gleixner 	return 0;
49202725e74SThomas Gleixner }
49302725e74SThomas Gleixner 
4941da177e4SLinus Torvalds /**
4951da177e4SLinus Torvalds  *	disable_irq_nosync - disable an irq without waiting
4961da177e4SLinus Torvalds  *	@irq: Interrupt to disable
4971da177e4SLinus Torvalds  *
4981da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Disables and Enables are
4991da177e4SLinus Torvalds  *	nested.
5001da177e4SLinus Torvalds  *	Unlike disable_irq(), this function does not ensure existing
5011da177e4SLinus Torvalds  *	instances of the IRQ handler have completed before returning.
5021da177e4SLinus Torvalds  *
5031da177e4SLinus Torvalds  *	This function may be called from IRQ context.
5041da177e4SLinus Torvalds  */
5051da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq)
5061da177e4SLinus Torvalds {
50702725e74SThomas Gleixner 	__disable_irq_nosync(irq);
5081da177e4SLinus Torvalds }
5091da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync);
5101da177e4SLinus Torvalds 
5111da177e4SLinus Torvalds /**
5121da177e4SLinus Torvalds  *	disable_irq - disable an irq and wait for completion
5131da177e4SLinus Torvalds  *	@irq: Interrupt to disable
5141da177e4SLinus Torvalds  *
5151da177e4SLinus Torvalds  *	Disable the selected interrupt line.  Enables and Disables are
5161da177e4SLinus Torvalds  *	nested.
5171da177e4SLinus Torvalds  *	This function waits for any pending IRQ handlers for this interrupt
5181da177e4SLinus Torvalds  *	to complete before returning. If you use this function while
5191da177e4SLinus Torvalds  *	holding a resource the IRQ handler may need you will deadlock.
5201da177e4SLinus Torvalds  *
5211da177e4SLinus Torvalds  *	This function may be called - with care - from IRQ context.
5221da177e4SLinus Torvalds  */
5231da177e4SLinus Torvalds void disable_irq(unsigned int irq)
5241da177e4SLinus Torvalds {
52502725e74SThomas Gleixner 	if (!__disable_irq_nosync(irq))
5261da177e4SLinus Torvalds 		synchronize_irq(irq);
5271da177e4SLinus Torvalds }
5281da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq);
5291da177e4SLinus Torvalds 
53002cea395SPeter Zijlstra /**
53102cea395SPeter Zijlstra  *	disable_hardirq - disables an irq and waits for hardirq completion
53202cea395SPeter Zijlstra  *	@irq: Interrupt to disable
53302cea395SPeter Zijlstra  *
53402cea395SPeter Zijlstra  *	Disable the selected interrupt line.  Enables and Disables are
53502cea395SPeter Zijlstra  *	nested.
53602cea395SPeter Zijlstra  *	This function waits for any pending hard IRQ handlers for this
53702cea395SPeter Zijlstra  *	interrupt to complete before returning. If you use this function while
53802cea395SPeter Zijlstra  *	holding a resource the hard IRQ handler may need you will deadlock.
53902cea395SPeter Zijlstra  *
54002cea395SPeter Zijlstra  *	When used to optimistically disable an interrupt from atomic context
54102cea395SPeter Zijlstra  *	the return value must be checked.
54202cea395SPeter Zijlstra  *
54302cea395SPeter Zijlstra  *	Returns: false if a threaded handler is active.
54402cea395SPeter Zijlstra  *
54502cea395SPeter Zijlstra  *	This function may be called - with care - from IRQ context.
54602cea395SPeter Zijlstra  */
54702cea395SPeter Zijlstra bool disable_hardirq(unsigned int irq)
54802cea395SPeter Zijlstra {
54902cea395SPeter Zijlstra 	if (!__disable_irq_nosync(irq))
55002cea395SPeter Zijlstra 		return synchronize_hardirq(irq);
55102cea395SPeter Zijlstra 
55202cea395SPeter Zijlstra 	return false;
55302cea395SPeter Zijlstra }
55402cea395SPeter Zijlstra EXPORT_SYMBOL_GPL(disable_hardirq);
55502cea395SPeter Zijlstra 
556b525903cSJulien Thierry /**
557b525903cSJulien Thierry  *	disable_nmi_nosync - disable an nmi without waiting
558b525903cSJulien Thierry  *	@irq: Interrupt to disable
559b525903cSJulien Thierry  *
560b525903cSJulien Thierry  *	Disable the selected interrupt line. Disables and enables are
561b525903cSJulien Thierry  *	nested.
562b525903cSJulien Thierry  *	The interrupt to disable must have been requested through request_nmi.
563b525903cSJulien Thierry  *	Unlike disable_nmi(), this function does not ensure existing
564b525903cSJulien Thierry  *	instances of the IRQ handler have completed before returning.
565b525903cSJulien Thierry  */
566b525903cSJulien Thierry void disable_nmi_nosync(unsigned int irq)
567b525903cSJulien Thierry {
568b525903cSJulien Thierry 	disable_irq_nosync(irq);
569b525903cSJulien Thierry }
570b525903cSJulien Thierry 
57179ff1cdaSJiang Liu void __enable_irq(struct irq_desc *desc)
5721adb0850SThomas Gleixner {
5731adb0850SThomas Gleixner 	switch (desc->depth) {
5741adb0850SThomas Gleixner 	case 0:
5750a0c5168SRafael J. Wysocki  err_out:
57679ff1cdaSJiang Liu 		WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n",
57779ff1cdaSJiang Liu 		     irq_desc_get_irq(desc));
5781adb0850SThomas Gleixner 		break;
5791adb0850SThomas Gleixner 	case 1: {
580c531e836SThomas Gleixner 		if (desc->istate & IRQS_SUSPENDED)
5810a0c5168SRafael J. Wysocki 			goto err_out;
5821adb0850SThomas Gleixner 		/* Prevent probing on this irq: */
5831ccb4e61SThomas Gleixner 		irq_settings_set_noprobe(desc);
584201d7f47SThomas Gleixner 		/*
585201d7f47SThomas Gleixner 		 * Call irq_startup() not irq_enable() here because the
586201d7f47SThomas Gleixner 		 * interrupt might be marked NOAUTOEN. So irq_startup()
587201d7f47SThomas Gleixner 		 * needs to be invoked when it gets enabled the first
588201d7f47SThomas Gleixner 		 * time. If it was already started up, then irq_startup()
589201d7f47SThomas Gleixner 		 * will invoke irq_enable() under the hood.
590201d7f47SThomas Gleixner 		 */
591c942cee4SThomas Gleixner 		irq_startup(desc, IRQ_RESEND, IRQ_START_FORCE);
592201d7f47SThomas Gleixner 		break;
5931adb0850SThomas Gleixner 	}
5941adb0850SThomas Gleixner 	default:
5951adb0850SThomas Gleixner 		desc->depth--;
5961adb0850SThomas Gleixner 	}
5971adb0850SThomas Gleixner }
5981adb0850SThomas Gleixner 
5991da177e4SLinus Torvalds /**
6001da177e4SLinus Torvalds  *	enable_irq - enable handling of an irq
6011da177e4SLinus Torvalds  *	@irq: Interrupt to enable
6021da177e4SLinus Torvalds  *
6031da177e4SLinus Torvalds  *	Undoes the effect of one call to disable_irq().  If this
6041da177e4SLinus Torvalds  *	matches the last disable, processing of interrupts on this
6051da177e4SLinus Torvalds  *	IRQ line is re-enabled.
6061da177e4SLinus Torvalds  *
60770aedd24SThomas Gleixner  *	This function may be called from IRQ context only when
6086b8ff312SThomas Gleixner  *	desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL !
6091da177e4SLinus Torvalds  */
6101da177e4SLinus Torvalds void enable_irq(unsigned int irq)
6111da177e4SLinus Torvalds {
6121da177e4SLinus Torvalds 	unsigned long flags;
61331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
6141da177e4SLinus Torvalds 
6157d94f7caSYinghai Lu 	if (!desc)
616c2b5a251SMatthew Wilcox 		return;
61750f7c032SThomas Gleixner 	if (WARN(!desc->irq_data.chip,
6182656c366SThomas Gleixner 		 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq))
61902725e74SThomas Gleixner 		goto out;
6202656c366SThomas Gleixner 
62179ff1cdaSJiang Liu 	__enable_irq(desc);
62202725e74SThomas Gleixner out:
62302725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
6241da177e4SLinus Torvalds }
6251da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq);
6261da177e4SLinus Torvalds 
627b525903cSJulien Thierry /**
628b525903cSJulien Thierry  *	enable_nmi - enable handling of an nmi
629b525903cSJulien Thierry  *	@irq: Interrupt to enable
630b525903cSJulien Thierry  *
631b525903cSJulien Thierry  *	The interrupt to enable must have been requested through request_nmi.
632b525903cSJulien Thierry  *	Undoes the effect of one call to disable_nmi(). If this
633b525903cSJulien Thierry  *	matches the last disable, processing of interrupts on this
634b525903cSJulien Thierry  *	IRQ line is re-enabled.
635b525903cSJulien Thierry  */
636b525903cSJulien Thierry void enable_nmi(unsigned int irq)
637b525903cSJulien Thierry {
638b525903cSJulien Thierry 	enable_irq(irq);
639b525903cSJulien Thierry }
640b525903cSJulien Thierry 
6410c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on)
6422db87321SUwe Kleine-König {
64308678b08SYinghai Lu 	struct irq_desc *desc = irq_to_desc(irq);
6442db87321SUwe Kleine-König 	int ret = -ENXIO;
6452db87321SUwe Kleine-König 
64660f96b41SSantosh Shilimkar 	if (irq_desc_get_chip(desc)->flags &  IRQCHIP_SKIP_SET_WAKE)
64760f96b41SSantosh Shilimkar 		return 0;
64860f96b41SSantosh Shilimkar 
6492f7e99bbSThomas Gleixner 	if (desc->irq_data.chip->irq_set_wake)
6502f7e99bbSThomas Gleixner 		ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on);
6512db87321SUwe Kleine-König 
6522db87321SUwe Kleine-König 	return ret;
6532db87321SUwe Kleine-König }
6542db87321SUwe Kleine-König 
655ba9a2331SThomas Gleixner /**
656a0cd9ca2SThomas Gleixner  *	irq_set_irq_wake - control irq power management wakeup
657ba9a2331SThomas Gleixner  *	@irq:	interrupt to control
658ba9a2331SThomas Gleixner  *	@on:	enable/disable power management wakeup
659ba9a2331SThomas Gleixner  *
66015a647ebSDavid Brownell  *	Enable/disable power management wakeup mode, which is
66115a647ebSDavid Brownell  *	disabled by default.  Enables and disables must match,
66215a647ebSDavid Brownell  *	just as they match for non-wakeup mode support.
66315a647ebSDavid Brownell  *
66415a647ebSDavid Brownell  *	Wakeup mode lets this IRQ wake the system from sleep
66515a647ebSDavid Brownell  *	states like "suspend to RAM".
666ba9a2331SThomas Gleixner  */
667a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on)
668ba9a2331SThomas Gleixner {
669ba9a2331SThomas Gleixner 	unsigned long flags;
67031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL);
6712db87321SUwe Kleine-König 	int ret = 0;
672ba9a2331SThomas Gleixner 
67313863a66SJesper Juhl 	if (!desc)
67413863a66SJesper Juhl 		return -EINVAL;
67513863a66SJesper Juhl 
676b525903cSJulien Thierry 	/* Don't use NMIs as wake up interrupts please */
677b525903cSJulien Thierry 	if (desc->istate & IRQS_NMI) {
678b525903cSJulien Thierry 		ret = -EINVAL;
679b525903cSJulien Thierry 		goto out_unlock;
680b525903cSJulien Thierry 	}
681b525903cSJulien Thierry 
68215a647ebSDavid Brownell 	/* wakeup-capable irqs can be shared between drivers that
68315a647ebSDavid Brownell 	 * don't need to have the same sleep mode behaviors.
68415a647ebSDavid Brownell 	 */
68515a647ebSDavid Brownell 	if (on) {
6862db87321SUwe Kleine-König 		if (desc->wake_depth++ == 0) {
6872db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6882db87321SUwe Kleine-König 			if (ret)
6892db87321SUwe Kleine-König 				desc->wake_depth = 0;
69015a647ebSDavid Brownell 			else
6917f94226fSThomas Gleixner 				irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE);
6922db87321SUwe Kleine-König 		}
69315a647ebSDavid Brownell 	} else {
69415a647ebSDavid Brownell 		if (desc->wake_depth == 0) {
6957a2c4770SArjan van de Ven 			WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
6962db87321SUwe Kleine-König 		} else if (--desc->wake_depth == 0) {
6972db87321SUwe Kleine-König 			ret = set_irq_wake_real(irq, on);
6982db87321SUwe Kleine-König 			if (ret)
6992db87321SUwe Kleine-König 				desc->wake_depth = 1;
70015a647ebSDavid Brownell 			else
7017f94226fSThomas Gleixner 				irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE);
70215a647ebSDavid Brownell 		}
7032db87321SUwe Kleine-König 	}
704b525903cSJulien Thierry 
705b525903cSJulien Thierry out_unlock:
70602725e74SThomas Gleixner 	irq_put_desc_busunlock(desc, flags);
707ba9a2331SThomas Gleixner 	return ret;
708ba9a2331SThomas Gleixner }
709a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake);
710ba9a2331SThomas Gleixner 
7111da177e4SLinus Torvalds /*
7121da177e4SLinus Torvalds  * Internal function that tells the architecture code whether a
7131da177e4SLinus Torvalds  * particular irq has been exclusively allocated or is available
7141da177e4SLinus Torvalds  * for driver use.
7151da177e4SLinus Torvalds  */
7161da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags)
7171da177e4SLinus Torvalds {
718cc8c3b78SThomas Gleixner 	unsigned long flags;
71931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
72002725e74SThomas Gleixner 	int canrequest = 0;
7211da177e4SLinus Torvalds 
7227d94f7caSYinghai Lu 	if (!desc)
7237d94f7caSYinghai Lu 		return 0;
7247d94f7caSYinghai Lu 
72502725e74SThomas Gleixner 	if (irq_settings_can_request(desc)) {
7262779db8dSBen Hutchings 		if (!desc->action ||
7272779db8dSBen Hutchings 		    irqflags & desc->action->flags & IRQF_SHARED)
72802725e74SThomas Gleixner 			canrequest = 1;
72902725e74SThomas Gleixner 	}
73002725e74SThomas Gleixner 	irq_put_desc_unlock(desc, flags);
73102725e74SThomas Gleixner 	return canrequest;
7321da177e4SLinus Torvalds }
7331da177e4SLinus Torvalds 
734a1ff541aSJiang Liu int __irq_set_trigger(struct irq_desc *desc, unsigned long flags)
73582736f4dSUwe Kleine-König {
7366b8ff312SThomas Gleixner 	struct irq_chip *chip = desc->irq_data.chip;
737d4d5e089SThomas Gleixner 	int ret, unmask = 0;
73882736f4dSUwe Kleine-König 
739b2ba2c30SThomas Gleixner 	if (!chip || !chip->irq_set_type) {
74082736f4dSUwe Kleine-König 		/*
74182736f4dSUwe Kleine-König 		 * IRQF_TRIGGER_* but the PIC does not support multiple
74282736f4dSUwe Kleine-König 		 * flow-types?
74382736f4dSUwe Kleine-König 		 */
744a1ff541aSJiang Liu 		pr_debug("No set_type function for IRQ %d (%s)\n",
745a1ff541aSJiang Liu 			 irq_desc_get_irq(desc),
74682736f4dSUwe Kleine-König 			 chip ? (chip->name ? : "unknown") : "unknown");
74782736f4dSUwe Kleine-König 		return 0;
74882736f4dSUwe Kleine-König 	}
74982736f4dSUwe Kleine-König 
750d4d5e089SThomas Gleixner 	if (chip->flags & IRQCHIP_SET_TYPE_MASKED) {
75132f4125eSThomas Gleixner 		if (!irqd_irq_masked(&desc->irq_data))
752d4d5e089SThomas Gleixner 			mask_irq(desc);
75332f4125eSThomas Gleixner 		if (!irqd_irq_disabled(&desc->irq_data))
754d4d5e089SThomas Gleixner 			unmask = 1;
755d4d5e089SThomas Gleixner 	}
756d4d5e089SThomas Gleixner 
75700b992deSAlexander Kuleshov 	/* Mask all flags except trigger mode */
75800b992deSAlexander Kuleshov 	flags &= IRQ_TYPE_SENSE_MASK;
759b2ba2c30SThomas Gleixner 	ret = chip->irq_set_type(&desc->irq_data, flags);
76082736f4dSUwe Kleine-König 
761876dbd4cSThomas Gleixner 	switch (ret) {
762876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK:
7632cb62547SJiang Liu 	case IRQ_SET_MASK_OK_DONE:
764876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK);
765876dbd4cSThomas Gleixner 		irqd_set(&desc->irq_data, flags);
76644133f7eSMathieu Malaterre 		/* fall through */
767876dbd4cSThomas Gleixner 
768876dbd4cSThomas Gleixner 	case IRQ_SET_MASK_OK_NOCOPY:
769876dbd4cSThomas Gleixner 		flags = irqd_get_trigger_type(&desc->irq_data);
770876dbd4cSThomas Gleixner 		irq_settings_set_trigger_mask(desc, flags);
771876dbd4cSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_LEVEL);
772876dbd4cSThomas Gleixner 		irq_settings_clr_level(desc);
773876dbd4cSThomas Gleixner 		if (flags & IRQ_TYPE_LEVEL_MASK) {
774876dbd4cSThomas Gleixner 			irq_settings_set_level(desc);
775876dbd4cSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_LEVEL);
776876dbd4cSThomas Gleixner 		}
77746732475SThomas Gleixner 
778d4d5e089SThomas Gleixner 		ret = 0;
7798fff39e0SThomas Gleixner 		break;
780876dbd4cSThomas Gleixner 	default:
781*d75f773cSSakari Ailus 		pr_err("Setting trigger mode %lu for irq %u failed (%pS)\n",
782a1ff541aSJiang Liu 		       flags, irq_desc_get_irq(desc), chip->irq_set_type);
7830c5d1eb7SDavid Brownell 	}
784d4d5e089SThomas Gleixner 	if (unmask)
785d4d5e089SThomas Gleixner 		unmask_irq(desc);
78682736f4dSUwe Kleine-König 	return ret;
78782736f4dSUwe Kleine-König }
78882736f4dSUwe Kleine-König 
789293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND
790293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq)
791293a7a0aSThomas Gleixner {
792293a7a0aSThomas Gleixner 	unsigned long flags;
793293a7a0aSThomas Gleixner 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0);
794293a7a0aSThomas Gleixner 
795293a7a0aSThomas Gleixner 	if (!desc)
796293a7a0aSThomas Gleixner 		return -EINVAL;
797293a7a0aSThomas Gleixner 
798293a7a0aSThomas Gleixner 	desc->parent_irq = parent_irq;
799293a7a0aSThomas Gleixner 
800293a7a0aSThomas Gleixner 	irq_put_desc_unlock(desc, flags);
801293a7a0aSThomas Gleixner 	return 0;
802293a7a0aSThomas Gleixner }
8033118dac5SSudip Mukherjee EXPORT_SYMBOL_GPL(irq_set_parent);
804293a7a0aSThomas Gleixner #endif
805293a7a0aSThomas Gleixner 
806b25c340cSThomas Gleixner /*
807b25c340cSThomas Gleixner  * Default primary interrupt handler for threaded interrupts. Is
808b25c340cSThomas Gleixner  * assigned as primary handler when request_threaded_irq is called
809b25c340cSThomas Gleixner  * with handler == NULL. Useful for oneshot interrupts.
810b25c340cSThomas Gleixner  */
811b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id)
812b25c340cSThomas Gleixner {
813b25c340cSThomas Gleixner 	return IRQ_WAKE_THREAD;
814b25c340cSThomas Gleixner }
815b25c340cSThomas Gleixner 
816399b5da2SThomas Gleixner /*
817399b5da2SThomas Gleixner  * Primary handler for nested threaded interrupts. Should never be
818399b5da2SThomas Gleixner  * called.
819399b5da2SThomas Gleixner  */
820399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id)
821399b5da2SThomas Gleixner {
822399b5da2SThomas Gleixner 	WARN(1, "Primary handler called for nested irq %d\n", irq);
823399b5da2SThomas Gleixner 	return IRQ_NONE;
824399b5da2SThomas Gleixner }
825399b5da2SThomas Gleixner 
8262a1d3ab8SThomas Gleixner static irqreturn_t irq_forced_secondary_handler(int irq, void *dev_id)
8272a1d3ab8SThomas Gleixner {
8282a1d3ab8SThomas Gleixner 	WARN(1, "Secondary action handler called for irq %d\n", irq);
8292a1d3ab8SThomas Gleixner 	return IRQ_NONE;
8302a1d3ab8SThomas Gleixner }
8312a1d3ab8SThomas Gleixner 
8323aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action)
8333aa551c9SThomas Gleixner {
834519cc865SLukas Wunner 	for (;;) {
8353aa551c9SThomas Gleixner 		set_current_state(TASK_INTERRUPTIBLE);
836f48fe81eSThomas Gleixner 
837519cc865SLukas Wunner 		if (kthread_should_stop()) {
838519cc865SLukas Wunner 			/* may need to run one last time */
839519cc865SLukas Wunner 			if (test_and_clear_bit(IRQTF_RUNTHREAD,
840519cc865SLukas Wunner 					       &action->thread_flags)) {
841519cc865SLukas Wunner 				__set_current_state(TASK_RUNNING);
842519cc865SLukas Wunner 				return 0;
843519cc865SLukas Wunner 			}
844519cc865SLukas Wunner 			__set_current_state(TASK_RUNNING);
845519cc865SLukas Wunner 			return -1;
846519cc865SLukas Wunner 		}
847550acb19SIdo Yariv 
848f48fe81eSThomas Gleixner 		if (test_and_clear_bit(IRQTF_RUNTHREAD,
849f48fe81eSThomas Gleixner 				       &action->thread_flags)) {
8503aa551c9SThomas Gleixner 			__set_current_state(TASK_RUNNING);
8513aa551c9SThomas Gleixner 			return 0;
852f48fe81eSThomas Gleixner 		}
8533aa551c9SThomas Gleixner 		schedule();
8543aa551c9SThomas Gleixner 	}
8553aa551c9SThomas Gleixner }
8563aa551c9SThomas Gleixner 
857b25c340cSThomas Gleixner /*
858b25c340cSThomas Gleixner  * Oneshot interrupts keep the irq line masked until the threaded
859b25c340cSThomas Gleixner  * handler finished. unmask if the interrupt has not been disabled and
860b25c340cSThomas Gleixner  * is marked MASKED.
861b25c340cSThomas Gleixner  */
862b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc,
863f3f79e38SAlexander Gordeev 				 struct irqaction *action)
864b25c340cSThomas Gleixner {
8652a1d3ab8SThomas Gleixner 	if (!(desc->istate & IRQS_ONESHOT) ||
8662a1d3ab8SThomas Gleixner 	    action->handler == irq_forced_secondary_handler)
867b5faba21SThomas Gleixner 		return;
8680b1adaa0SThomas Gleixner again:
8693876ec9eSThomas Gleixner 	chip_bus_lock(desc);
870239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
8710b1adaa0SThomas Gleixner 
8720b1adaa0SThomas Gleixner 	/*
8730b1adaa0SThomas Gleixner 	 * Implausible though it may be we need to protect us against
8740b1adaa0SThomas Gleixner 	 * the following scenario:
8750b1adaa0SThomas Gleixner 	 *
8760b1adaa0SThomas Gleixner 	 * The thread is faster done than the hard interrupt handler
8770b1adaa0SThomas Gleixner 	 * on the other CPU. If we unmask the irq line then the
8780b1adaa0SThomas Gleixner 	 * interrupt can come in again and masks the line, leaves due
879009b4c3bSThomas Gleixner 	 * to IRQS_INPROGRESS and the irq line is masked forever.
880b5faba21SThomas Gleixner 	 *
881b5faba21SThomas Gleixner 	 * This also serializes the state of shared oneshot handlers
882b5faba21SThomas Gleixner 	 * versus "desc->threads_onehsot |= action->thread_mask;" in
883b5faba21SThomas Gleixner 	 * irq_wake_thread(). See the comment there which explains the
884b5faba21SThomas Gleixner 	 * serialization.
8850b1adaa0SThomas Gleixner 	 */
88632f4125eSThomas Gleixner 	if (unlikely(irqd_irq_inprogress(&desc->irq_data))) {
8870b1adaa0SThomas Gleixner 		raw_spin_unlock_irq(&desc->lock);
8883876ec9eSThomas Gleixner 		chip_bus_sync_unlock(desc);
8890b1adaa0SThomas Gleixner 		cpu_relax();
8900b1adaa0SThomas Gleixner 		goto again;
8910b1adaa0SThomas Gleixner 	}
8920b1adaa0SThomas Gleixner 
893b5faba21SThomas Gleixner 	/*
894b5faba21SThomas Gleixner 	 * Now check again, whether the thread should run. Otherwise
895b5faba21SThomas Gleixner 	 * we would clear the threads_oneshot bit of this thread which
896b5faba21SThomas Gleixner 	 * was just set.
897b5faba21SThomas Gleixner 	 */
898f3f79e38SAlexander Gordeev 	if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags))
899b5faba21SThomas Gleixner 		goto out_unlock;
900b5faba21SThomas Gleixner 
901b5faba21SThomas Gleixner 	desc->threads_oneshot &= ~action->thread_mask;
902b5faba21SThomas Gleixner 
90332f4125eSThomas Gleixner 	if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) &&
90432f4125eSThomas Gleixner 	    irqd_irq_masked(&desc->irq_data))
905328a4978SThomas Gleixner 		unmask_threaded_irq(desc);
90632f4125eSThomas Gleixner 
907b5faba21SThomas Gleixner out_unlock:
908239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
9093876ec9eSThomas Gleixner 	chip_bus_sync_unlock(desc);
910b25c340cSThomas Gleixner }
911b25c340cSThomas Gleixner 
91261f38261SBruno Premont #ifdef CONFIG_SMP
9133aa551c9SThomas Gleixner /*
914b04c644eSChuansheng Liu  * Check whether we need to change the affinity of the interrupt thread.
915591d2fb0SThomas Gleixner  */
916591d2fb0SThomas Gleixner static void
917591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
918591d2fb0SThomas Gleixner {
919591d2fb0SThomas Gleixner 	cpumask_var_t mask;
92004aa530eSThomas Gleixner 	bool valid = true;
921591d2fb0SThomas Gleixner 
922591d2fb0SThomas Gleixner 	if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags))
923591d2fb0SThomas Gleixner 		return;
924591d2fb0SThomas Gleixner 
925591d2fb0SThomas Gleixner 	/*
926591d2fb0SThomas Gleixner 	 * In case we are out of memory we set IRQTF_AFFINITY again and
927591d2fb0SThomas Gleixner 	 * try again next time
928591d2fb0SThomas Gleixner 	 */
929591d2fb0SThomas Gleixner 	if (!alloc_cpumask_var(&mask, GFP_KERNEL)) {
930591d2fb0SThomas Gleixner 		set_bit(IRQTF_AFFINITY, &action->thread_flags);
931591d2fb0SThomas Gleixner 		return;
932591d2fb0SThomas Gleixner 	}
933591d2fb0SThomas Gleixner 
934239007b8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
93504aa530eSThomas Gleixner 	/*
93604aa530eSThomas Gleixner 	 * This code is triggered unconditionally. Check the affinity
93704aa530eSThomas Gleixner 	 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
93804aa530eSThomas Gleixner 	 */
939cbf86999SThomas Gleixner 	if (cpumask_available(desc->irq_common_data.affinity)) {
940cbf86999SThomas Gleixner 		const struct cpumask *m;
941cbf86999SThomas Gleixner 
942cbf86999SThomas Gleixner 		m = irq_data_get_effective_affinity_mask(&desc->irq_data);
943cbf86999SThomas Gleixner 		cpumask_copy(mask, m);
944cbf86999SThomas Gleixner 	} else {
94504aa530eSThomas Gleixner 		valid = false;
946cbf86999SThomas Gleixner 	}
947239007b8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
948591d2fb0SThomas Gleixner 
94904aa530eSThomas Gleixner 	if (valid)
950591d2fb0SThomas Gleixner 		set_cpus_allowed_ptr(current, mask);
951591d2fb0SThomas Gleixner 	free_cpumask_var(mask);
952591d2fb0SThomas Gleixner }
95361f38261SBruno Premont #else
95461f38261SBruno Premont static inline void
95561f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { }
95661f38261SBruno Premont #endif
957591d2fb0SThomas Gleixner 
958591d2fb0SThomas Gleixner /*
959c5f48c0aSIngo Molnar  * Interrupts which are not explicitly requested as threaded
9608d32a307SThomas Gleixner  * interrupts rely on the implicit bh/preempt disable of the hard irq
9618d32a307SThomas Gleixner  * context. So we need to disable bh here to avoid deadlocks and other
9628d32a307SThomas Gleixner  * side effects.
9638d32a307SThomas Gleixner  */
9643a43e05fSSebastian Andrzej Siewior static irqreturn_t
9658d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action)
9668d32a307SThomas Gleixner {
9673a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
9683a43e05fSSebastian Andrzej Siewior 
9698d32a307SThomas Gleixner 	local_bh_disable();
9703a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
971746a923bSLukas Wunner 	if (ret == IRQ_HANDLED)
972746a923bSLukas Wunner 		atomic_inc(&desc->threads_handled);
973746a923bSLukas Wunner 
974f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
9758d32a307SThomas Gleixner 	local_bh_enable();
9763a43e05fSSebastian Andrzej Siewior 	return ret;
9778d32a307SThomas Gleixner }
9788d32a307SThomas Gleixner 
9798d32a307SThomas Gleixner /*
980f788e7bfSXie XiuQi  * Interrupts explicitly requested as threaded interrupts want to be
9818d32a307SThomas Gleixner  * preemtible - many of them need to sleep and wait for slow busses to
9828d32a307SThomas Gleixner  * complete.
9838d32a307SThomas Gleixner  */
9843a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc,
9853a43e05fSSebastian Andrzej Siewior 		struct irqaction *action)
9868d32a307SThomas Gleixner {
9873a43e05fSSebastian Andrzej Siewior 	irqreturn_t ret;
9883a43e05fSSebastian Andrzej Siewior 
9893a43e05fSSebastian Andrzej Siewior 	ret = action->thread_fn(action->irq, action->dev_id);
990746a923bSLukas Wunner 	if (ret == IRQ_HANDLED)
991746a923bSLukas Wunner 		atomic_inc(&desc->threads_handled);
992746a923bSLukas Wunner 
993f3f79e38SAlexander Gordeev 	irq_finalize_oneshot(desc, action);
9943a43e05fSSebastian Andrzej Siewior 	return ret;
9958d32a307SThomas Gleixner }
9968d32a307SThomas Gleixner 
9977140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc)
9987140ea19SIdo Yariv {
999c685689fSChuansheng Liu 	if (atomic_dec_and_test(&desc->threads_active))
10007140ea19SIdo Yariv 		wake_up(&desc->wait_for_threads);
10017140ea19SIdo Yariv }
10027140ea19SIdo Yariv 
100367d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused)
10044d1d61a6SOleg Nesterov {
10054d1d61a6SOleg Nesterov 	struct task_struct *tsk = current;
10064d1d61a6SOleg Nesterov 	struct irq_desc *desc;
10074d1d61a6SOleg Nesterov 	struct irqaction *action;
10084d1d61a6SOleg Nesterov 
10094d1d61a6SOleg Nesterov 	if (WARN_ON_ONCE(!(current->flags & PF_EXITING)))
10104d1d61a6SOleg Nesterov 		return;
10114d1d61a6SOleg Nesterov 
10124d1d61a6SOleg Nesterov 	action = kthread_data(tsk);
10134d1d61a6SOleg Nesterov 
1014fb21affaSLinus Torvalds 	pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n",
101519af395dSAlan Cox 	       tsk->comm, tsk->pid, action->irq);
10164d1d61a6SOleg Nesterov 
10174d1d61a6SOleg Nesterov 
10184d1d61a6SOleg Nesterov 	desc = irq_to_desc(action->irq);
10194d1d61a6SOleg Nesterov 	/*
10204d1d61a6SOleg Nesterov 	 * If IRQTF_RUNTHREAD is set, we need to decrement
10214d1d61a6SOleg Nesterov 	 * desc->threads_active and wake possible waiters.
10224d1d61a6SOleg Nesterov 	 */
10234d1d61a6SOleg Nesterov 	if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags))
10244d1d61a6SOleg Nesterov 		wake_threads_waitq(desc);
10254d1d61a6SOleg Nesterov 
10264d1d61a6SOleg Nesterov 	/* Prevent a stale desc->threads_oneshot */
10274d1d61a6SOleg Nesterov 	irq_finalize_oneshot(desc, action);
10284d1d61a6SOleg Nesterov }
10294d1d61a6SOleg Nesterov 
10302a1d3ab8SThomas Gleixner static void irq_wake_secondary(struct irq_desc *desc, struct irqaction *action)
10312a1d3ab8SThomas Gleixner {
10322a1d3ab8SThomas Gleixner 	struct irqaction *secondary = action->secondary;
10332a1d3ab8SThomas Gleixner 
10342a1d3ab8SThomas Gleixner 	if (WARN_ON_ONCE(!secondary))
10352a1d3ab8SThomas Gleixner 		return;
10362a1d3ab8SThomas Gleixner 
10372a1d3ab8SThomas Gleixner 	raw_spin_lock_irq(&desc->lock);
10382a1d3ab8SThomas Gleixner 	__irq_wake_thread(desc, secondary);
10392a1d3ab8SThomas Gleixner 	raw_spin_unlock_irq(&desc->lock);
10402a1d3ab8SThomas Gleixner }
10412a1d3ab8SThomas Gleixner 
10428d32a307SThomas Gleixner /*
10433aa551c9SThomas Gleixner  * Interrupt handler thread
10443aa551c9SThomas Gleixner  */
10453aa551c9SThomas Gleixner static int irq_thread(void *data)
10463aa551c9SThomas Gleixner {
104767d12145SAl Viro 	struct callback_head on_exit_work;
10483aa551c9SThomas Gleixner 	struct irqaction *action = data;
10493aa551c9SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(action->irq);
10503a43e05fSSebastian Andrzej Siewior 	irqreturn_t (*handler_fn)(struct irq_desc *desc,
10513a43e05fSSebastian Andrzej Siewior 			struct irqaction *action);
10523aa551c9SThomas Gleixner 
1053540b60e2SAlexander Gordeev 	if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD,
10548d32a307SThomas Gleixner 					&action->thread_flags))
10558d32a307SThomas Gleixner 		handler_fn = irq_forced_thread_fn;
10568d32a307SThomas Gleixner 	else
10578d32a307SThomas Gleixner 		handler_fn = irq_thread_fn;
10588d32a307SThomas Gleixner 
105941f9d29fSAl Viro 	init_task_work(&on_exit_work, irq_thread_dtor);
10604d1d61a6SOleg Nesterov 	task_work_add(current, &on_exit_work, false);
10613aa551c9SThomas Gleixner 
1062f3de44edSSankara Muthukrishnan 	irq_thread_check_affinity(desc, action);
1063f3de44edSSankara Muthukrishnan 
10643aa551c9SThomas Gleixner 	while (!irq_wait_for_interrupt(action)) {
10657140ea19SIdo Yariv 		irqreturn_t action_ret;
10663aa551c9SThomas Gleixner 
1067591d2fb0SThomas Gleixner 		irq_thread_check_affinity(desc, action);
1068591d2fb0SThomas Gleixner 
10693a43e05fSSebastian Andrzej Siewior 		action_ret = handler_fn(desc, action);
10702a1d3ab8SThomas Gleixner 		if (action_ret == IRQ_WAKE_THREAD)
10712a1d3ab8SThomas Gleixner 			irq_wake_secondary(desc, action);
10727140ea19SIdo Yariv 
10737140ea19SIdo Yariv 		wake_threads_waitq(desc);
10743aa551c9SThomas Gleixner 	}
10753aa551c9SThomas Gleixner 
10767140ea19SIdo Yariv 	/*
10777140ea19SIdo Yariv 	 * This is the regular exit path. __free_irq() is stopping the
10787140ea19SIdo Yariv 	 * thread via kthread_stop() after calling
1079519cc865SLukas Wunner 	 * synchronize_hardirq(). So neither IRQTF_RUNTHREAD nor the
1080836557bdSLukas Wunner 	 * oneshot mask bit can be set.
10813aa551c9SThomas Gleixner 	 */
10824d1d61a6SOleg Nesterov 	task_work_cancel(current, irq_thread_dtor);
10833aa551c9SThomas Gleixner 	return 0;
10843aa551c9SThomas Gleixner }
10853aa551c9SThomas Gleixner 
1086a92444c6SThomas Gleixner /**
1087a92444c6SThomas Gleixner  *	irq_wake_thread - wake the irq thread for the action identified by dev_id
1088a92444c6SThomas Gleixner  *	@irq:		Interrupt line
1089a92444c6SThomas Gleixner  *	@dev_id:	Device identity for which the thread should be woken
1090a92444c6SThomas Gleixner  *
1091a92444c6SThomas Gleixner  */
1092a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id)
1093a92444c6SThomas Gleixner {
1094a92444c6SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1095a92444c6SThomas Gleixner 	struct irqaction *action;
1096a92444c6SThomas Gleixner 	unsigned long flags;
1097a92444c6SThomas Gleixner 
1098a92444c6SThomas Gleixner 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1099a92444c6SThomas Gleixner 		return;
1100a92444c6SThomas Gleixner 
1101a92444c6SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1102f944b5a7SDaniel Lezcano 	for_each_action_of_desc(desc, action) {
1103a92444c6SThomas Gleixner 		if (action->dev_id == dev_id) {
1104a92444c6SThomas Gleixner 			if (action->thread)
1105a92444c6SThomas Gleixner 				__irq_wake_thread(desc, action);
1106a92444c6SThomas Gleixner 			break;
1107a92444c6SThomas Gleixner 		}
1108a92444c6SThomas Gleixner 	}
1109a92444c6SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1110a92444c6SThomas Gleixner }
1111a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread);
1112a92444c6SThomas Gleixner 
11132a1d3ab8SThomas Gleixner static int irq_setup_forced_threading(struct irqaction *new)
11148d32a307SThomas Gleixner {
11158d32a307SThomas Gleixner 	if (!force_irqthreads)
11162a1d3ab8SThomas Gleixner 		return 0;
11178d32a307SThomas Gleixner 	if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT))
11182a1d3ab8SThomas Gleixner 		return 0;
11198d32a307SThomas Gleixner 
1120d1f0301bSThomas Gleixner 	/*
1121d1f0301bSThomas Gleixner 	 * No further action required for interrupts which are requested as
1122d1f0301bSThomas Gleixner 	 * threaded interrupts already
1123d1f0301bSThomas Gleixner 	 */
1124d1f0301bSThomas Gleixner 	if (new->handler == irq_default_primary_handler)
1125d1f0301bSThomas Gleixner 		return 0;
1126d1f0301bSThomas Gleixner 
11278d32a307SThomas Gleixner 	new->flags |= IRQF_ONESHOT;
11288d32a307SThomas Gleixner 
11292a1d3ab8SThomas Gleixner 	/*
11302a1d3ab8SThomas Gleixner 	 * Handle the case where we have a real primary handler and a
11312a1d3ab8SThomas Gleixner 	 * thread handler. We force thread them as well by creating a
11322a1d3ab8SThomas Gleixner 	 * secondary action.
11332a1d3ab8SThomas Gleixner 	 */
1134d1f0301bSThomas Gleixner 	if (new->handler && new->thread_fn) {
11352a1d3ab8SThomas Gleixner 		/* Allocate the secondary action */
11362a1d3ab8SThomas Gleixner 		new->secondary = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
11372a1d3ab8SThomas Gleixner 		if (!new->secondary)
11382a1d3ab8SThomas Gleixner 			return -ENOMEM;
11392a1d3ab8SThomas Gleixner 		new->secondary->handler = irq_forced_secondary_handler;
11402a1d3ab8SThomas Gleixner 		new->secondary->thread_fn = new->thread_fn;
11412a1d3ab8SThomas Gleixner 		new->secondary->dev_id = new->dev_id;
11422a1d3ab8SThomas Gleixner 		new->secondary->irq = new->irq;
11432a1d3ab8SThomas Gleixner 		new->secondary->name = new->name;
11442a1d3ab8SThomas Gleixner 	}
11452a1d3ab8SThomas Gleixner 	/* Deal with the primary handler */
11468d32a307SThomas Gleixner 	set_bit(IRQTF_FORCED_THREAD, &new->thread_flags);
11478d32a307SThomas Gleixner 	new->thread_fn = new->handler;
11488d32a307SThomas Gleixner 	new->handler = irq_default_primary_handler;
11492a1d3ab8SThomas Gleixner 	return 0;
11508d32a307SThomas Gleixner }
11518d32a307SThomas Gleixner 
1152c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc)
1153c1bacbaeSThomas Gleixner {
1154c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1155c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1156c1bacbaeSThomas Gleixner 
1157c1bacbaeSThomas Gleixner 	return c->irq_request_resources ? c->irq_request_resources(d) : 0;
1158c1bacbaeSThomas Gleixner }
1159c1bacbaeSThomas Gleixner 
1160c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc)
1161c1bacbaeSThomas Gleixner {
1162c1bacbaeSThomas Gleixner 	struct irq_data *d = &desc->irq_data;
1163c1bacbaeSThomas Gleixner 	struct irq_chip *c = d->chip;
1164c1bacbaeSThomas Gleixner 
1165c1bacbaeSThomas Gleixner 	if (c->irq_release_resources)
1166c1bacbaeSThomas Gleixner 		c->irq_release_resources(d);
1167c1bacbaeSThomas Gleixner }
1168c1bacbaeSThomas Gleixner 
1169b525903cSJulien Thierry static bool irq_supports_nmi(struct irq_desc *desc)
1170b525903cSJulien Thierry {
1171b525903cSJulien Thierry 	struct irq_data *d = irq_desc_get_irq_data(desc);
1172b525903cSJulien Thierry 
1173b525903cSJulien Thierry #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1174b525903cSJulien Thierry 	/* Only IRQs directly managed by the root irqchip can be set as NMI */
1175b525903cSJulien Thierry 	if (d->parent_data)
1176b525903cSJulien Thierry 		return false;
1177b525903cSJulien Thierry #endif
1178b525903cSJulien Thierry 	/* Don't support NMIs for chips behind a slow bus */
1179b525903cSJulien Thierry 	if (d->chip->irq_bus_lock || d->chip->irq_bus_sync_unlock)
1180b525903cSJulien Thierry 		return false;
1181b525903cSJulien Thierry 
1182b525903cSJulien Thierry 	return d->chip->flags & IRQCHIP_SUPPORTS_NMI;
1183b525903cSJulien Thierry }
1184b525903cSJulien Thierry 
1185b525903cSJulien Thierry static int irq_nmi_setup(struct irq_desc *desc)
1186b525903cSJulien Thierry {
1187b525903cSJulien Thierry 	struct irq_data *d = irq_desc_get_irq_data(desc);
1188b525903cSJulien Thierry 	struct irq_chip *c = d->chip;
1189b525903cSJulien Thierry 
1190b525903cSJulien Thierry 	return c->irq_nmi_setup ? c->irq_nmi_setup(d) : -EINVAL;
1191b525903cSJulien Thierry }
1192b525903cSJulien Thierry 
1193b525903cSJulien Thierry static void irq_nmi_teardown(struct irq_desc *desc)
1194b525903cSJulien Thierry {
1195b525903cSJulien Thierry 	struct irq_data *d = irq_desc_get_irq_data(desc);
1196b525903cSJulien Thierry 	struct irq_chip *c = d->chip;
1197b525903cSJulien Thierry 
1198b525903cSJulien Thierry 	if (c->irq_nmi_teardown)
1199b525903cSJulien Thierry 		c->irq_nmi_teardown(d);
1200b525903cSJulien Thierry }
1201b525903cSJulien Thierry 
12022a1d3ab8SThomas Gleixner static int
12032a1d3ab8SThomas Gleixner setup_irq_thread(struct irqaction *new, unsigned int irq, bool secondary)
12042a1d3ab8SThomas Gleixner {
12052a1d3ab8SThomas Gleixner 	struct task_struct *t;
12062a1d3ab8SThomas Gleixner 	struct sched_param param = {
12072a1d3ab8SThomas Gleixner 		.sched_priority = MAX_USER_RT_PRIO/2,
12082a1d3ab8SThomas Gleixner 	};
12092a1d3ab8SThomas Gleixner 
12102a1d3ab8SThomas Gleixner 	if (!secondary) {
12112a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-%s", irq,
12122a1d3ab8SThomas Gleixner 				   new->name);
12132a1d3ab8SThomas Gleixner 	} else {
12142a1d3ab8SThomas Gleixner 		t = kthread_create(irq_thread, new, "irq/%d-s-%s", irq,
12152a1d3ab8SThomas Gleixner 				   new->name);
12162a1d3ab8SThomas Gleixner 		param.sched_priority -= 1;
12172a1d3ab8SThomas Gleixner 	}
12182a1d3ab8SThomas Gleixner 
12192a1d3ab8SThomas Gleixner 	if (IS_ERR(t))
12202a1d3ab8SThomas Gleixner 		return PTR_ERR(t);
12212a1d3ab8SThomas Gleixner 
12222a1d3ab8SThomas Gleixner 	sched_setscheduler_nocheck(t, SCHED_FIFO, &param);
12232a1d3ab8SThomas Gleixner 
12242a1d3ab8SThomas Gleixner 	/*
12252a1d3ab8SThomas Gleixner 	 * We keep the reference to the task struct even if
12262a1d3ab8SThomas Gleixner 	 * the thread dies to avoid that the interrupt code
12272a1d3ab8SThomas Gleixner 	 * references an already freed task_struct.
12282a1d3ab8SThomas Gleixner 	 */
12292a1d3ab8SThomas Gleixner 	get_task_struct(t);
12302a1d3ab8SThomas Gleixner 	new->thread = t;
12312a1d3ab8SThomas Gleixner 	/*
12322a1d3ab8SThomas Gleixner 	 * Tell the thread to set its affinity. This is
12332a1d3ab8SThomas Gleixner 	 * important for shared interrupt handlers as we do
12342a1d3ab8SThomas Gleixner 	 * not invoke setup_affinity() for the secondary
12352a1d3ab8SThomas Gleixner 	 * handlers as everything is already set up. Even for
12362a1d3ab8SThomas Gleixner 	 * interrupts marked with IRQF_NO_BALANCE this is
12372a1d3ab8SThomas Gleixner 	 * correct as we want the thread to move to the cpu(s)
12382a1d3ab8SThomas Gleixner 	 * on which the requesting code placed the interrupt.
12392a1d3ab8SThomas Gleixner 	 */
12402a1d3ab8SThomas Gleixner 	set_bit(IRQTF_AFFINITY, &new->thread_flags);
12412a1d3ab8SThomas Gleixner 	return 0;
12422a1d3ab8SThomas Gleixner }
12432a1d3ab8SThomas Gleixner 
12441da177e4SLinus Torvalds /*
12451da177e4SLinus Torvalds  * Internal function to register an irqaction - typically used to
12461da177e4SLinus Torvalds  * allocate special interrupts that are part of the architecture.
124719d39a38SThomas Gleixner  *
124819d39a38SThomas Gleixner  * Locking rules:
124919d39a38SThomas Gleixner  *
125019d39a38SThomas Gleixner  * desc->request_mutex	Provides serialization against a concurrent free_irq()
125119d39a38SThomas Gleixner  *   chip_bus_lock	Provides serialization for slow bus operations
125219d39a38SThomas Gleixner  *     desc->lock	Provides serialization against hard interrupts
125319d39a38SThomas Gleixner  *
125419d39a38SThomas Gleixner  * chip_bus_lock and desc->lock are sufficient for all other management and
125519d39a38SThomas Gleixner  * interrupt related functions. desc->request_mutex solely serializes
125619d39a38SThomas Gleixner  * request/free_irq().
12571da177e4SLinus Torvalds  */
1258d3c60047SThomas Gleixner static int
1259d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
12601da177e4SLinus Torvalds {
1261f17c7545SIngo Molnar 	struct irqaction *old, **old_ptr;
1262b5faba21SThomas Gleixner 	unsigned long flags, thread_mask = 0;
12633b8249e7SThomas Gleixner 	int ret, nested, shared = 0;
12641da177e4SLinus Torvalds 
12657d94f7caSYinghai Lu 	if (!desc)
1266c2b5a251SMatthew Wilcox 		return -EINVAL;
1267c2b5a251SMatthew Wilcox 
12686b8ff312SThomas Gleixner 	if (desc->irq_data.chip == &no_irq_chip)
12691da177e4SLinus Torvalds 		return -ENOSYS;
1270b6873807SSebastian Andrzej Siewior 	if (!try_module_get(desc->owner))
1271b6873807SSebastian Andrzej Siewior 		return -ENODEV;
12721da177e4SLinus Torvalds 
12732a1d3ab8SThomas Gleixner 	new->irq = irq;
12742a1d3ab8SThomas Gleixner 
12751da177e4SLinus Torvalds 	/*
12764b357daeSJon Hunter 	 * If the trigger type is not specified by the caller,
12774b357daeSJon Hunter 	 * then use the default for this interrupt.
12784b357daeSJon Hunter 	 */
12794b357daeSJon Hunter 	if (!(new->flags & IRQF_TRIGGER_MASK))
12804b357daeSJon Hunter 		new->flags |= irqd_get_trigger_type(&desc->irq_data);
12814b357daeSJon Hunter 
12824b357daeSJon Hunter 	/*
1283399b5da2SThomas Gleixner 	 * Check whether the interrupt nests into another interrupt
1284399b5da2SThomas Gleixner 	 * thread.
12853aa551c9SThomas Gleixner 	 */
12861ccb4e61SThomas Gleixner 	nested = irq_settings_is_nested_thread(desc);
1287399b5da2SThomas Gleixner 	if (nested) {
1288b6873807SSebastian Andrzej Siewior 		if (!new->thread_fn) {
1289b6873807SSebastian Andrzej Siewior 			ret = -EINVAL;
1290b6873807SSebastian Andrzej Siewior 			goto out_mput;
1291b6873807SSebastian Andrzej Siewior 		}
1292399b5da2SThomas Gleixner 		/*
1293399b5da2SThomas Gleixner 		 * Replace the primary handler which was provided from
1294399b5da2SThomas Gleixner 		 * the driver for non nested interrupt handling by the
1295399b5da2SThomas Gleixner 		 * dummy function which warns when called.
1296399b5da2SThomas Gleixner 		 */
1297399b5da2SThomas Gleixner 		new->handler = irq_nested_primary_handler;
12988d32a307SThomas Gleixner 	} else {
12992a1d3ab8SThomas Gleixner 		if (irq_settings_can_thread(desc)) {
13002a1d3ab8SThomas Gleixner 			ret = irq_setup_forced_threading(new);
13012a1d3ab8SThomas Gleixner 			if (ret)
13022a1d3ab8SThomas Gleixner 				goto out_mput;
13032a1d3ab8SThomas Gleixner 		}
1304399b5da2SThomas Gleixner 	}
1305399b5da2SThomas Gleixner 
1306399b5da2SThomas Gleixner 	/*
1307399b5da2SThomas Gleixner 	 * Create a handler thread when a thread function is supplied
1308399b5da2SThomas Gleixner 	 * and the interrupt does not nest into another interrupt
1309399b5da2SThomas Gleixner 	 * thread.
1310399b5da2SThomas Gleixner 	 */
1311399b5da2SThomas Gleixner 	if (new->thread_fn && !nested) {
13122a1d3ab8SThomas Gleixner 		ret = setup_irq_thread(new, irq, false);
13132a1d3ab8SThomas Gleixner 		if (ret)
1314b6873807SSebastian Andrzej Siewior 			goto out_mput;
13152a1d3ab8SThomas Gleixner 		if (new->secondary) {
13162a1d3ab8SThomas Gleixner 			ret = setup_irq_thread(new->secondary, irq, true);
13172a1d3ab8SThomas Gleixner 			if (ret)
13182a1d3ab8SThomas Gleixner 				goto out_thread;
1319b6873807SSebastian Andrzej Siewior 		}
13203aa551c9SThomas Gleixner 	}
13213aa551c9SThomas Gleixner 
13223aa551c9SThomas Gleixner 	/*
1323dc9b229aSThomas Gleixner 	 * Drivers are often written to work w/o knowledge about the
1324dc9b229aSThomas Gleixner 	 * underlying irq chip implementation, so a request for a
1325dc9b229aSThomas Gleixner 	 * threaded irq without a primary hard irq context handler
1326dc9b229aSThomas Gleixner 	 * requires the ONESHOT flag to be set. Some irq chips like
1327dc9b229aSThomas Gleixner 	 * MSI based interrupts are per se one shot safe. Check the
1328dc9b229aSThomas Gleixner 	 * chip flags, so we can avoid the unmask dance at the end of
1329dc9b229aSThomas Gleixner 	 * the threaded handler for those.
1330dc9b229aSThomas Gleixner 	 */
1331dc9b229aSThomas Gleixner 	if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)
1332dc9b229aSThomas Gleixner 		new->flags &= ~IRQF_ONESHOT;
1333dc9b229aSThomas Gleixner 
133419d39a38SThomas Gleixner 	/*
133519d39a38SThomas Gleixner 	 * Protects against a concurrent __free_irq() call which might wait
1336519cc865SLukas Wunner 	 * for synchronize_hardirq() to complete without holding the optional
1337836557bdSLukas Wunner 	 * chip bus lock and desc->lock. Also protects against handing out
1338836557bdSLukas Wunner 	 * a recycled oneshot thread_mask bit while it's still in use by
1339836557bdSLukas Wunner 	 * its previous owner.
134019d39a38SThomas Gleixner 	 */
13419114014cSThomas Gleixner 	mutex_lock(&desc->request_mutex);
134219d39a38SThomas Gleixner 
134319d39a38SThomas Gleixner 	/*
134419d39a38SThomas Gleixner 	 * Acquire bus lock as the irq_request_resources() callback below
134519d39a38SThomas Gleixner 	 * might rely on the serialization or the magic power management
134619d39a38SThomas Gleixner 	 * functions which are abusing the irq_bus_lock() callback,
134719d39a38SThomas Gleixner 	 */
134819d39a38SThomas Gleixner 	chip_bus_lock(desc);
134919d39a38SThomas Gleixner 
135019d39a38SThomas Gleixner 	/* First installed action requests resources. */
135146e48e25SThomas Gleixner 	if (!desc->action) {
135246e48e25SThomas Gleixner 		ret = irq_request_resources(desc);
135346e48e25SThomas Gleixner 		if (ret) {
135446e48e25SThomas Gleixner 			pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n",
135546e48e25SThomas Gleixner 			       new->name, irq, desc->irq_data.chip->name);
135619d39a38SThomas Gleixner 			goto out_bus_unlock;
135746e48e25SThomas Gleixner 		}
135846e48e25SThomas Gleixner 	}
13599114014cSThomas Gleixner 
1360dc9b229aSThomas Gleixner 	/*
13611da177e4SLinus Torvalds 	 * The following block of code has to be executed atomically
136219d39a38SThomas Gleixner 	 * protected against a concurrent interrupt and any of the other
136319d39a38SThomas Gleixner 	 * management calls which are not serialized via
136419d39a38SThomas Gleixner 	 * desc->request_mutex or the optional bus lock.
13651da177e4SLinus Torvalds 	 */
1366239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1367f17c7545SIngo Molnar 	old_ptr = &desc->action;
1368f17c7545SIngo Molnar 	old = *old_ptr;
136906fcb0c6SIngo Molnar 	if (old) {
1370e76de9f8SThomas Gleixner 		/*
1371e76de9f8SThomas Gleixner 		 * Can't share interrupts unless both agree to and are
1372e76de9f8SThomas Gleixner 		 * the same type (level, edge, polarity). So both flag
13733cca53b0SThomas Gleixner 		 * fields must have IRQF_SHARED set and the bits which
13749d591eddSThomas Gleixner 		 * set the trigger type must match. Also all must
13759d591eddSThomas Gleixner 		 * agree on ONESHOT.
1376b525903cSJulien Thierry 		 * Interrupt lines used for NMIs cannot be shared.
1377e76de9f8SThomas Gleixner 		 */
13784f8413a3SMarc Zyngier 		unsigned int oldtype;
13794f8413a3SMarc Zyngier 
1380b525903cSJulien Thierry 		if (desc->istate & IRQS_NMI) {
1381b525903cSJulien Thierry 			pr_err("Invalid attempt to share NMI for %s (irq %d) on irqchip %s.\n",
1382b525903cSJulien Thierry 				new->name, irq, desc->irq_data.chip->name);
1383b525903cSJulien Thierry 			ret = -EINVAL;
1384b525903cSJulien Thierry 			goto out_unlock;
1385b525903cSJulien Thierry 		}
1386b525903cSJulien Thierry 
13874f8413a3SMarc Zyngier 		/*
13884f8413a3SMarc Zyngier 		 * If nobody did set the configuration before, inherit
13894f8413a3SMarc Zyngier 		 * the one provided by the requester.
13904f8413a3SMarc Zyngier 		 */
13914f8413a3SMarc Zyngier 		if (irqd_trigger_type_was_set(&desc->irq_data)) {
13924f8413a3SMarc Zyngier 			oldtype = irqd_get_trigger_type(&desc->irq_data);
13934f8413a3SMarc Zyngier 		} else {
13944f8413a3SMarc Zyngier 			oldtype = new->flags & IRQF_TRIGGER_MASK;
13954f8413a3SMarc Zyngier 			irqd_set_trigger_type(&desc->irq_data, oldtype);
13964f8413a3SMarc Zyngier 		}
1397382bd4deSHans de Goede 
13983cca53b0SThomas Gleixner 		if (!((old->flags & new->flags) & IRQF_SHARED) ||
1399382bd4deSHans de Goede 		    (oldtype != (new->flags & IRQF_TRIGGER_MASK)) ||
1400f5d89470SThomas Gleixner 		    ((old->flags ^ new->flags) & IRQF_ONESHOT))
1401f5163427SDimitri Sivanich 			goto mismatch;
1402f5163427SDimitri Sivanich 
1403f5163427SDimitri Sivanich 		/* All handlers must agree on per-cpuness */
14043cca53b0SThomas Gleixner 		if ((old->flags & IRQF_PERCPU) !=
14053cca53b0SThomas Gleixner 		    (new->flags & IRQF_PERCPU))
1406f5163427SDimitri Sivanich 			goto mismatch;
14071da177e4SLinus Torvalds 
14081da177e4SLinus Torvalds 		/* add new interrupt at end of irq queue */
14091da177e4SLinus Torvalds 		do {
141052abb700SThomas Gleixner 			/*
141152abb700SThomas Gleixner 			 * Or all existing action->thread_mask bits,
141252abb700SThomas Gleixner 			 * so we can find the next zero bit for this
141352abb700SThomas Gleixner 			 * new action.
141452abb700SThomas Gleixner 			 */
1415b5faba21SThomas Gleixner 			thread_mask |= old->thread_mask;
1416f17c7545SIngo Molnar 			old_ptr = &old->next;
1417f17c7545SIngo Molnar 			old = *old_ptr;
14181da177e4SLinus Torvalds 		} while (old);
14191da177e4SLinus Torvalds 		shared = 1;
14201da177e4SLinus Torvalds 	}
14211da177e4SLinus Torvalds 
1422b5faba21SThomas Gleixner 	/*
142352abb700SThomas Gleixner 	 * Setup the thread mask for this irqaction for ONESHOT. For
142452abb700SThomas Gleixner 	 * !ONESHOT irqs the thread mask is 0 so we can avoid a
142552abb700SThomas Gleixner 	 * conditional in irq_wake_thread().
1426b5faba21SThomas Gleixner 	 */
142752abb700SThomas Gleixner 	if (new->flags & IRQF_ONESHOT) {
142852abb700SThomas Gleixner 		/*
142952abb700SThomas Gleixner 		 * Unlikely to have 32 resp 64 irqs sharing one line,
143052abb700SThomas Gleixner 		 * but who knows.
143152abb700SThomas Gleixner 		 */
143252abb700SThomas Gleixner 		if (thread_mask == ~0UL) {
1433b5faba21SThomas Gleixner 			ret = -EBUSY;
1434cba4235eSThomas Gleixner 			goto out_unlock;
1435b5faba21SThomas Gleixner 		}
143652abb700SThomas Gleixner 		/*
143752abb700SThomas Gleixner 		 * The thread_mask for the action is or'ed to
143852abb700SThomas Gleixner 		 * desc->thread_active to indicate that the
143952abb700SThomas Gleixner 		 * IRQF_ONESHOT thread handler has been woken, but not
144052abb700SThomas Gleixner 		 * yet finished. The bit is cleared when a thread
144152abb700SThomas Gleixner 		 * completes. When all threads of a shared interrupt
144252abb700SThomas Gleixner 		 * line have completed desc->threads_active becomes
144352abb700SThomas Gleixner 		 * zero and the interrupt line is unmasked. See
144452abb700SThomas Gleixner 		 * handle.c:irq_wake_thread() for further information.
144552abb700SThomas Gleixner 		 *
144652abb700SThomas Gleixner 		 * If no thread is woken by primary (hard irq context)
144752abb700SThomas Gleixner 		 * interrupt handlers, then desc->threads_active is
144852abb700SThomas Gleixner 		 * also checked for zero to unmask the irq line in the
144952abb700SThomas Gleixner 		 * affected hard irq flow handlers
145052abb700SThomas Gleixner 		 * (handle_[fasteoi|level]_irq).
145152abb700SThomas Gleixner 		 *
145252abb700SThomas Gleixner 		 * The new action gets the first zero bit of
145352abb700SThomas Gleixner 		 * thread_mask assigned. See the loop above which or's
145452abb700SThomas Gleixner 		 * all existing action->thread_mask bits.
145552abb700SThomas Gleixner 		 */
1456ffc661c9SRasmus Villemoes 		new->thread_mask = 1UL << ffz(thread_mask);
14571c6c6952SThomas Gleixner 
1458dc9b229aSThomas Gleixner 	} else if (new->handler == irq_default_primary_handler &&
1459dc9b229aSThomas Gleixner 		   !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) {
14601c6c6952SThomas Gleixner 		/*
14611c6c6952SThomas Gleixner 		 * The interrupt was requested with handler = NULL, so
14621c6c6952SThomas Gleixner 		 * we use the default primary handler for it. But it
14631c6c6952SThomas Gleixner 		 * does not have the oneshot flag set. In combination
14641c6c6952SThomas Gleixner 		 * with level interrupts this is deadly, because the
14651c6c6952SThomas Gleixner 		 * default primary handler just wakes the thread, then
14661c6c6952SThomas Gleixner 		 * the irq lines is reenabled, but the device still
14671c6c6952SThomas Gleixner 		 * has the level irq asserted. Rinse and repeat....
14681c6c6952SThomas Gleixner 		 *
14691c6c6952SThomas Gleixner 		 * While this works for edge type interrupts, we play
14701c6c6952SThomas Gleixner 		 * it safe and reject unconditionally because we can't
14711c6c6952SThomas Gleixner 		 * say for sure which type this interrupt really
14721c6c6952SThomas Gleixner 		 * has. The type flags are unreliable as the
14731c6c6952SThomas Gleixner 		 * underlying chip implementation can override them.
14741c6c6952SThomas Gleixner 		 */
147597fd75b7SAndrew Morton 		pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n",
14761c6c6952SThomas Gleixner 		       irq);
14771c6c6952SThomas Gleixner 		ret = -EINVAL;
1478cba4235eSThomas Gleixner 		goto out_unlock;
147952abb700SThomas Gleixner 	}
1480b5faba21SThomas Gleixner 
14811da177e4SLinus Torvalds 	if (!shared) {
14823aa551c9SThomas Gleixner 		init_waitqueue_head(&desc->wait_for_threads);
14833aa551c9SThomas Gleixner 
148482736f4dSUwe Kleine-König 		/* Setup the type (level, edge polarity) if configured: */
148582736f4dSUwe Kleine-König 		if (new->flags & IRQF_TRIGGER_MASK) {
1486a1ff541aSJiang Liu 			ret = __irq_set_trigger(desc,
1487f2b662daSDavid Brownell 						new->flags & IRQF_TRIGGER_MASK);
148882736f4dSUwe Kleine-König 
148919d39a38SThomas Gleixner 			if (ret)
1490cba4235eSThomas Gleixner 				goto out_unlock;
1491091738a2SThomas Gleixner 		}
1492f75d222bSAhmed S. Darwish 
1493c942cee4SThomas Gleixner 		/*
1494c942cee4SThomas Gleixner 		 * Activate the interrupt. That activation must happen
1495c942cee4SThomas Gleixner 		 * independently of IRQ_NOAUTOEN. request_irq() can fail
1496c942cee4SThomas Gleixner 		 * and the callers are supposed to handle
1497c942cee4SThomas Gleixner 		 * that. enable_irq() of an interrupt requested with
1498c942cee4SThomas Gleixner 		 * IRQ_NOAUTOEN is not supposed to fail. The activation
1499c942cee4SThomas Gleixner 		 * keeps it in shutdown mode, it merily associates
1500c942cee4SThomas Gleixner 		 * resources if necessary and if that's not possible it
1501c942cee4SThomas Gleixner 		 * fails. Interrupts which are in managed shutdown mode
1502c942cee4SThomas Gleixner 		 * will simply ignore that activation request.
1503c942cee4SThomas Gleixner 		 */
1504c942cee4SThomas Gleixner 		ret = irq_activate(desc);
1505c942cee4SThomas Gleixner 		if (ret)
1506c942cee4SThomas Gleixner 			goto out_unlock;
1507c942cee4SThomas Gleixner 
1508009b4c3bSThomas Gleixner 		desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \
150932f4125eSThomas Gleixner 				  IRQS_ONESHOT | IRQS_WAITING);
151032f4125eSThomas Gleixner 		irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS);
151194d39e1fSThomas Gleixner 
1512a005677bSThomas Gleixner 		if (new->flags & IRQF_PERCPU) {
1513a005677bSThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_PER_CPU);
1514a005677bSThomas Gleixner 			irq_settings_set_per_cpu(desc);
1515a005677bSThomas Gleixner 		}
15166a58fb3bSThomas Gleixner 
1517b25c340cSThomas Gleixner 		if (new->flags & IRQF_ONESHOT)
15183d67baecSThomas Gleixner 			desc->istate |= IRQS_ONESHOT;
1519b25c340cSThomas Gleixner 
15202e051552SThomas Gleixner 		/* Exclude IRQ from balancing if requested */
15212e051552SThomas Gleixner 		if (new->flags & IRQF_NOBALANCING) {
15222e051552SThomas Gleixner 			irq_settings_set_no_balancing(desc);
15232e051552SThomas Gleixner 			irqd_set(&desc->irq_data, IRQD_NO_BALANCING);
15242e051552SThomas Gleixner 		}
15252e051552SThomas Gleixner 
152604c848d3SThomas Gleixner 		if (irq_settings_can_autoenable(desc)) {
15274cde9c6bSThomas Gleixner 			irq_startup(desc, IRQ_RESEND, IRQ_START_COND);
152804c848d3SThomas Gleixner 		} else {
152904c848d3SThomas Gleixner 			/*
153004c848d3SThomas Gleixner 			 * Shared interrupts do not go well with disabling
153104c848d3SThomas Gleixner 			 * auto enable. The sharing interrupt might request
153204c848d3SThomas Gleixner 			 * it while it's still disabled and then wait for
153304c848d3SThomas Gleixner 			 * interrupts forever.
153404c848d3SThomas Gleixner 			 */
153504c848d3SThomas Gleixner 			WARN_ON_ONCE(new->flags & IRQF_SHARED);
1536e76de9f8SThomas Gleixner 			/* Undo nested disables: */
1537e76de9f8SThomas Gleixner 			desc->depth = 1;
153804c848d3SThomas Gleixner 		}
153918404756SMax Krasnyansky 
1540876dbd4cSThomas Gleixner 	} else if (new->flags & IRQF_TRIGGER_MASK) {
1541876dbd4cSThomas Gleixner 		unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK;
15427ee7e87dSThomas Gleixner 		unsigned int omsk = irqd_get_trigger_type(&desc->irq_data);
1543876dbd4cSThomas Gleixner 
1544876dbd4cSThomas Gleixner 		if (nmsk != omsk)
1545876dbd4cSThomas Gleixner 			/* hope the handler works with current  trigger mode */
1546a395d6a7SJoe Perches 			pr_warn("irq %d uses trigger mode %u; requested %u\n",
15477ee7e87dSThomas Gleixner 				irq, omsk, nmsk);
154894d39e1fSThomas Gleixner 	}
154982736f4dSUwe Kleine-König 
1550f17c7545SIngo Molnar 	*old_ptr = new;
155182736f4dSUwe Kleine-König 
1552cab303beSThomas Gleixner 	irq_pm_install_action(desc, new);
1553cab303beSThomas Gleixner 
15548528b0f1SLinus Torvalds 	/* Reset broken irq detection when installing new handler */
15558528b0f1SLinus Torvalds 	desc->irq_count = 0;
15568528b0f1SLinus Torvalds 	desc->irqs_unhandled = 0;
15571adb0850SThomas Gleixner 
15581adb0850SThomas Gleixner 	/*
15591adb0850SThomas Gleixner 	 * Check whether we disabled the irq via the spurious handler
15601adb0850SThomas Gleixner 	 * before. Reenable it and give it another chance.
15611adb0850SThomas Gleixner 	 */
15627acdd53eSThomas Gleixner 	if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) {
15637acdd53eSThomas Gleixner 		desc->istate &= ~IRQS_SPURIOUS_DISABLED;
156479ff1cdaSJiang Liu 		__enable_irq(desc);
15651adb0850SThomas Gleixner 	}
15661adb0850SThomas Gleixner 
1567239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
15683a90795eSThomas Gleixner 	chip_bus_sync_unlock(desc);
15699114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
15701da177e4SLinus Torvalds 
1571b2d3d61aSDaniel Lezcano 	irq_setup_timings(desc, new);
1572b2d3d61aSDaniel Lezcano 
157369ab8494SThomas Gleixner 	/*
157469ab8494SThomas Gleixner 	 * Strictly no need to wake it up, but hung_task complains
157569ab8494SThomas Gleixner 	 * when no hard interrupt wakes the thread up.
157669ab8494SThomas Gleixner 	 */
157769ab8494SThomas Gleixner 	if (new->thread)
157869ab8494SThomas Gleixner 		wake_up_process(new->thread);
15792a1d3ab8SThomas Gleixner 	if (new->secondary)
15802a1d3ab8SThomas Gleixner 		wake_up_process(new->secondary->thread);
158169ab8494SThomas Gleixner 
15822c6927a3SYinghai Lu 	register_irq_proc(irq, desc);
15831da177e4SLinus Torvalds 	new->dir = NULL;
15841da177e4SLinus Torvalds 	register_handler_proc(irq, new);
15851da177e4SLinus Torvalds 	return 0;
1586f5163427SDimitri Sivanich 
1587f5163427SDimitri Sivanich mismatch:
15883cca53b0SThomas Gleixner 	if (!(new->flags & IRQF_PROBE_SHARED)) {
158997fd75b7SAndrew Morton 		pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n",
1590f5d89470SThomas Gleixner 		       irq, new->flags, new->name, old->flags, old->name);
1591f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ
1592f5163427SDimitri Sivanich 		dump_stack();
15933f050447SAlan Cox #endif
1594f5d89470SThomas Gleixner 	}
15953aa551c9SThomas Gleixner 	ret = -EBUSY;
15963aa551c9SThomas Gleixner 
1597cba4235eSThomas Gleixner out_unlock:
15981c389795SDan Carpenter 	raw_spin_unlock_irqrestore(&desc->lock, flags);
15993b8249e7SThomas Gleixner 
160046e48e25SThomas Gleixner 	if (!desc->action)
160146e48e25SThomas Gleixner 		irq_release_resources(desc);
160219d39a38SThomas Gleixner out_bus_unlock:
160319d39a38SThomas Gleixner 	chip_bus_sync_unlock(desc);
16049114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
16059114014cSThomas Gleixner 
16063aa551c9SThomas Gleixner out_thread:
16073aa551c9SThomas Gleixner 	if (new->thread) {
16083aa551c9SThomas Gleixner 		struct task_struct *t = new->thread;
16093aa551c9SThomas Gleixner 
16103aa551c9SThomas Gleixner 		new->thread = NULL;
16113aa551c9SThomas Gleixner 		kthread_stop(t);
16123aa551c9SThomas Gleixner 		put_task_struct(t);
16133aa551c9SThomas Gleixner 	}
16142a1d3ab8SThomas Gleixner 	if (new->secondary && new->secondary->thread) {
16152a1d3ab8SThomas Gleixner 		struct task_struct *t = new->secondary->thread;
16162a1d3ab8SThomas Gleixner 
16172a1d3ab8SThomas Gleixner 		new->secondary->thread = NULL;
16182a1d3ab8SThomas Gleixner 		kthread_stop(t);
16192a1d3ab8SThomas Gleixner 		put_task_struct(t);
16202a1d3ab8SThomas Gleixner 	}
1621b6873807SSebastian Andrzej Siewior out_mput:
1622b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
16233aa551c9SThomas Gleixner 	return ret;
16241da177e4SLinus Torvalds }
16251da177e4SLinus Torvalds 
16261da177e4SLinus Torvalds /**
1627d3c60047SThomas Gleixner  *	setup_irq - setup an interrupt
1628d3c60047SThomas Gleixner  *	@irq: Interrupt line to setup
1629d3c60047SThomas Gleixner  *	@act: irqaction for the interrupt
1630d3c60047SThomas Gleixner  *
1631d3c60047SThomas Gleixner  * Used to statically setup interrupts in the early boot process.
1632d3c60047SThomas Gleixner  */
1633d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act)
1634d3c60047SThomas Gleixner {
1635986c011dSDavid Daney 	int retval;
1636d3c60047SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
1637d3c60047SThomas Gleixner 
16389b5d585dSJon Hunter 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
163931d9d9b6SMarc Zyngier 		return -EINVAL;
1640be45beb2SJon Hunter 
1641be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
1642be45beb2SJon Hunter 	if (retval < 0)
1643be45beb2SJon Hunter 		return retval;
1644be45beb2SJon Hunter 
1645986c011dSDavid Daney 	retval = __setup_irq(irq, desc, act);
1646986c011dSDavid Daney 
1647be45beb2SJon Hunter 	if (retval)
1648be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
1649be45beb2SJon Hunter 
1650986c011dSDavid Daney 	return retval;
1651d3c60047SThomas Gleixner }
1652eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq);
1653d3c60047SThomas Gleixner 
1654cbf94f06SMagnus Damm /*
1655cbf94f06SMagnus Damm  * Internal function to unregister an irqaction - used to free
1656cbf94f06SMagnus Damm  * regular and special interrupts that are part of the architecture.
16571da177e4SLinus Torvalds  */
165883ac4ca9SUwe Kleine König static struct irqaction *__free_irq(struct irq_desc *desc, void *dev_id)
16591da177e4SLinus Torvalds {
166083ac4ca9SUwe Kleine König 	unsigned irq = desc->irq_data.irq;
1661f17c7545SIngo Molnar 	struct irqaction *action, **action_ptr;
16621da177e4SLinus Torvalds 	unsigned long flags;
16631da177e4SLinus Torvalds 
1664ae88a23bSIngo Molnar 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
16657d94f7caSYinghai Lu 
16669114014cSThomas Gleixner 	mutex_lock(&desc->request_mutex);
1667abc7e40cSThomas Gleixner 	chip_bus_lock(desc);
1668239007b8SThomas Gleixner 	raw_spin_lock_irqsave(&desc->lock, flags);
1669ae88a23bSIngo Molnar 
1670ae88a23bSIngo Molnar 	/*
1671ae88a23bSIngo Molnar 	 * There can be multiple actions per IRQ descriptor, find the right
1672ae88a23bSIngo Molnar 	 * one based on the dev_id:
1673ae88a23bSIngo Molnar 	 */
1674f17c7545SIngo Molnar 	action_ptr = &desc->action;
16751da177e4SLinus Torvalds 	for (;;) {
1676f17c7545SIngo Molnar 		action = *action_ptr;
16771da177e4SLinus Torvalds 
1678ae88a23bSIngo Molnar 		if (!action) {
1679ae88a23bSIngo Molnar 			WARN(1, "Trying to free already-free IRQ %d\n", irq);
1680239007b8SThomas Gleixner 			raw_spin_unlock_irqrestore(&desc->lock, flags);
1681abc7e40cSThomas Gleixner 			chip_bus_sync_unlock(desc);
168219d39a38SThomas Gleixner 			mutex_unlock(&desc->request_mutex);
1683f21cfb25SMagnus Damm 			return NULL;
1684ae88a23bSIngo Molnar 		}
16851da177e4SLinus Torvalds 
16868316e381SIngo Molnar 		if (action->dev_id == dev_id)
1687ae88a23bSIngo Molnar 			break;
1688f17c7545SIngo Molnar 		action_ptr = &action->next;
1689ae88a23bSIngo Molnar 	}
1690ae88a23bSIngo Molnar 
1691ae88a23bSIngo Molnar 	/* Found it - now remove it from the list of entries: */
1692f17c7545SIngo Molnar 	*action_ptr = action->next;
1693dbce706eSPaolo 'Blaisorblade' Giarrusso 
1694cab303beSThomas Gleixner 	irq_pm_remove_action(desc, action);
1695cab303beSThomas Gleixner 
1696ae88a23bSIngo Molnar 	/* If this was the last handler, shut down the IRQ line: */
1697c1bacbaeSThomas Gleixner 	if (!desc->action) {
1698e9849777SThomas Gleixner 		irq_settings_clr_disable_unlazy(desc);
169946999238SThomas Gleixner 		irq_shutdown(desc);
1700c1bacbaeSThomas Gleixner 	}
17013aa551c9SThomas Gleixner 
1702e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP
1703e7a297b0SPeter P Waskiewicz Jr 	/* make sure affinity_hint is cleaned up */
1704e7a297b0SPeter P Waskiewicz Jr 	if (WARN_ON_ONCE(desc->affinity_hint))
1705e7a297b0SPeter P Waskiewicz Jr 		desc->affinity_hint = NULL;
1706e7a297b0SPeter P Waskiewicz Jr #endif
1707e7a297b0SPeter P Waskiewicz Jr 
1708239007b8SThomas Gleixner 	raw_spin_unlock_irqrestore(&desc->lock, flags);
170919d39a38SThomas Gleixner 	/*
171019d39a38SThomas Gleixner 	 * Drop bus_lock here so the changes which were done in the chip
171119d39a38SThomas Gleixner 	 * callbacks above are synced out to the irq chips which hang
1712519cc865SLukas Wunner 	 * behind a slow bus (I2C, SPI) before calling synchronize_hardirq().
171319d39a38SThomas Gleixner 	 *
171419d39a38SThomas Gleixner 	 * Aside of that the bus_lock can also be taken from the threaded
171519d39a38SThomas Gleixner 	 * handler in irq_finalize_oneshot() which results in a deadlock
1716519cc865SLukas Wunner 	 * because kthread_stop() would wait forever for the thread to
171719d39a38SThomas Gleixner 	 * complete, which is blocked on the bus lock.
171819d39a38SThomas Gleixner 	 *
171919d39a38SThomas Gleixner 	 * The still held desc->request_mutex() protects against a
172019d39a38SThomas Gleixner 	 * concurrent request_irq() of this irq so the release of resources
172119d39a38SThomas Gleixner 	 * and timing data is properly serialized.
172219d39a38SThomas Gleixner 	 */
1723abc7e40cSThomas Gleixner 	chip_bus_sync_unlock(desc);
1724ae88a23bSIngo Molnar 
17251da177e4SLinus Torvalds 	unregister_handler_proc(irq, action);
17261da177e4SLinus Torvalds 
1727ae88a23bSIngo Molnar 	/* Make sure it's not being used on another CPU: */
1728519cc865SLukas Wunner 	synchronize_hardirq(irq);
1729ae88a23bSIngo Molnar 
17301d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ
17311d99493bSDavid Woodhouse 	/*
1732ae88a23bSIngo Molnar 	 * It's a shared IRQ -- the driver ought to be prepared for an IRQ
1733ae88a23bSIngo Molnar 	 * event to happen even now it's being freed, so let's make sure that
1734ae88a23bSIngo Molnar 	 * is so by doing an extra call to the handler ....
1735ae88a23bSIngo Molnar 	 *
1736ae88a23bSIngo Molnar 	 * ( We do this after actually deregistering it, to make sure that a
17370a13ec0bSJonathan Neuschäfer 	 *   'real' IRQ doesn't run in parallel with our fake. )
17381d99493bSDavid Woodhouse 	 */
17391d99493bSDavid Woodhouse 	if (action->flags & IRQF_SHARED) {
17401d99493bSDavid Woodhouse 		local_irq_save(flags);
17411d99493bSDavid Woodhouse 		action->handler(irq, dev_id);
17421d99493bSDavid Woodhouse 		local_irq_restore(flags);
17431d99493bSDavid Woodhouse 	}
17441d99493bSDavid Woodhouse #endif
17452d860ad7SLinus Torvalds 
1746519cc865SLukas Wunner 	/*
1747519cc865SLukas Wunner 	 * The action has already been removed above, but the thread writes
1748519cc865SLukas Wunner 	 * its oneshot mask bit when it completes. Though request_mutex is
1749519cc865SLukas Wunner 	 * held across this which prevents __setup_irq() from handing out
1750519cc865SLukas Wunner 	 * the same bit to a newly requested action.
1751519cc865SLukas Wunner 	 */
17522d860ad7SLinus Torvalds 	if (action->thread) {
17532d860ad7SLinus Torvalds 		kthread_stop(action->thread);
17542d860ad7SLinus Torvalds 		put_task_struct(action->thread);
17552a1d3ab8SThomas Gleixner 		if (action->secondary && action->secondary->thread) {
17562a1d3ab8SThomas Gleixner 			kthread_stop(action->secondary->thread);
17572a1d3ab8SThomas Gleixner 			put_task_struct(action->secondary->thread);
17582a1d3ab8SThomas Gleixner 		}
17592d860ad7SLinus Torvalds 	}
17602d860ad7SLinus Torvalds 
176119d39a38SThomas Gleixner 	/* Last action releases resources */
17622343877fSThomas Gleixner 	if (!desc->action) {
176319d39a38SThomas Gleixner 		/*
176419d39a38SThomas Gleixner 		 * Reaquire bus lock as irq_release_resources() might
176519d39a38SThomas Gleixner 		 * require it to deallocate resources over the slow bus.
176619d39a38SThomas Gleixner 		 */
176719d39a38SThomas Gleixner 		chip_bus_lock(desc);
176846e48e25SThomas Gleixner 		irq_release_resources(desc);
176919d39a38SThomas Gleixner 		chip_bus_sync_unlock(desc);
17702343877fSThomas Gleixner 		irq_remove_timings(desc);
17712343877fSThomas Gleixner 	}
177246e48e25SThomas Gleixner 
17739114014cSThomas Gleixner 	mutex_unlock(&desc->request_mutex);
17749114014cSThomas Gleixner 
1775be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
1776b6873807SSebastian Andrzej Siewior 	module_put(desc->owner);
17772a1d3ab8SThomas Gleixner 	kfree(action->secondary);
1778f21cfb25SMagnus Damm 	return action;
1779f21cfb25SMagnus Damm }
17801da177e4SLinus Torvalds 
17811da177e4SLinus Torvalds /**
1782cbf94f06SMagnus Damm  *	remove_irq - free an interrupt
1783cbf94f06SMagnus Damm  *	@irq: Interrupt line to free
1784cbf94f06SMagnus Damm  *	@act: irqaction for the interrupt
1785cbf94f06SMagnus Damm  *
1786cbf94f06SMagnus Damm  * Used to remove interrupts statically setup by the early boot process.
1787cbf94f06SMagnus Damm  */
1788cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act)
1789cbf94f06SMagnus Damm {
179031d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
179131d9d9b6SMarc Zyngier 
179231d9d9b6SMarc Zyngier 	if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc)))
179383ac4ca9SUwe Kleine König 		__free_irq(desc, act->dev_id);
1794cbf94f06SMagnus Damm }
1795eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq);
1796cbf94f06SMagnus Damm 
1797cbf94f06SMagnus Damm /**
1798f21cfb25SMagnus Damm  *	free_irq - free an interrupt allocated with request_irq
17991da177e4SLinus Torvalds  *	@irq: Interrupt line to free
18001da177e4SLinus Torvalds  *	@dev_id: Device identity to free
18011da177e4SLinus Torvalds  *
18021da177e4SLinus Torvalds  *	Remove an interrupt handler. The handler is removed and if the
18031da177e4SLinus Torvalds  *	interrupt line is no longer in use by any driver it is disabled.
18041da177e4SLinus Torvalds  *	On a shared IRQ the caller must ensure the interrupt is disabled
18051da177e4SLinus Torvalds  *	on the card it drives before calling this function. The function
18061da177e4SLinus Torvalds  *	does not return until any executing interrupts for this IRQ
18071da177e4SLinus Torvalds  *	have completed.
18081da177e4SLinus Torvalds  *
18091da177e4SLinus Torvalds  *	This function must not be called from interrupt context.
181025ce4be7SChristoph Hellwig  *
181125ce4be7SChristoph Hellwig  *	Returns the devname argument passed to request_irq.
18121da177e4SLinus Torvalds  */
181325ce4be7SChristoph Hellwig const void *free_irq(unsigned int irq, void *dev_id)
18141da177e4SLinus Torvalds {
181570aedd24SThomas Gleixner 	struct irq_desc *desc = irq_to_desc(irq);
181625ce4be7SChristoph Hellwig 	struct irqaction *action;
181725ce4be7SChristoph Hellwig 	const char *devname;
181870aedd24SThomas Gleixner 
181931d9d9b6SMarc Zyngier 	if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc)))
182025ce4be7SChristoph Hellwig 		return NULL;
182170aedd24SThomas Gleixner 
1822cd7eab44SBen Hutchings #ifdef CONFIG_SMP
1823cd7eab44SBen Hutchings 	if (WARN_ON(desc->affinity_notify))
1824cd7eab44SBen Hutchings 		desc->affinity_notify = NULL;
1825cd7eab44SBen Hutchings #endif
1826cd7eab44SBen Hutchings 
182783ac4ca9SUwe Kleine König 	action = __free_irq(desc, dev_id);
18282827a418SAlexandru Moise 
18292827a418SAlexandru Moise 	if (!action)
18302827a418SAlexandru Moise 		return NULL;
18312827a418SAlexandru Moise 
183225ce4be7SChristoph Hellwig 	devname = action->name;
183325ce4be7SChristoph Hellwig 	kfree(action);
183425ce4be7SChristoph Hellwig 	return devname;
18351da177e4SLinus Torvalds }
18361da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq);
18371da177e4SLinus Torvalds 
1838b525903cSJulien Thierry /* This function must be called with desc->lock held */
1839b525903cSJulien Thierry static const void *__cleanup_nmi(unsigned int irq, struct irq_desc *desc)
1840b525903cSJulien Thierry {
1841b525903cSJulien Thierry 	const char *devname = NULL;
1842b525903cSJulien Thierry 
1843b525903cSJulien Thierry 	desc->istate &= ~IRQS_NMI;
1844b525903cSJulien Thierry 
1845b525903cSJulien Thierry 	if (!WARN_ON(desc->action == NULL)) {
1846b525903cSJulien Thierry 		irq_pm_remove_action(desc, desc->action);
1847b525903cSJulien Thierry 		devname = desc->action->name;
1848b525903cSJulien Thierry 		unregister_handler_proc(irq, desc->action);
1849b525903cSJulien Thierry 
1850b525903cSJulien Thierry 		kfree(desc->action);
1851b525903cSJulien Thierry 		desc->action = NULL;
1852b525903cSJulien Thierry 	}
1853b525903cSJulien Thierry 
1854b525903cSJulien Thierry 	irq_settings_clr_disable_unlazy(desc);
1855b525903cSJulien Thierry 	irq_shutdown(desc);
1856b525903cSJulien Thierry 
1857b525903cSJulien Thierry 	irq_release_resources(desc);
1858b525903cSJulien Thierry 
1859b525903cSJulien Thierry 	irq_chip_pm_put(&desc->irq_data);
1860b525903cSJulien Thierry 	module_put(desc->owner);
1861b525903cSJulien Thierry 
1862b525903cSJulien Thierry 	return devname;
1863b525903cSJulien Thierry }
1864b525903cSJulien Thierry 
1865b525903cSJulien Thierry const void *free_nmi(unsigned int irq, void *dev_id)
1866b525903cSJulien Thierry {
1867b525903cSJulien Thierry 	struct irq_desc *desc = irq_to_desc(irq);
1868b525903cSJulien Thierry 	unsigned long flags;
1869b525903cSJulien Thierry 	const void *devname;
1870b525903cSJulien Thierry 
1871b525903cSJulien Thierry 	if (!desc || WARN_ON(!(desc->istate & IRQS_NMI)))
1872b525903cSJulien Thierry 		return NULL;
1873b525903cSJulien Thierry 
1874b525903cSJulien Thierry 	if (WARN_ON(irq_settings_is_per_cpu_devid(desc)))
1875b525903cSJulien Thierry 		return NULL;
1876b525903cSJulien Thierry 
1877b525903cSJulien Thierry 	/* NMI still enabled */
1878b525903cSJulien Thierry 	if (WARN_ON(desc->depth == 0))
1879b525903cSJulien Thierry 		disable_nmi_nosync(irq);
1880b525903cSJulien Thierry 
1881b525903cSJulien Thierry 	raw_spin_lock_irqsave(&desc->lock, flags);
1882b525903cSJulien Thierry 
1883b525903cSJulien Thierry 	irq_nmi_teardown(desc);
1884b525903cSJulien Thierry 	devname = __cleanup_nmi(irq, desc);
1885b525903cSJulien Thierry 
1886b525903cSJulien Thierry 	raw_spin_unlock_irqrestore(&desc->lock, flags);
1887b525903cSJulien Thierry 
1888b525903cSJulien Thierry 	return devname;
1889b525903cSJulien Thierry }
1890b525903cSJulien Thierry 
18911da177e4SLinus Torvalds /**
18923aa551c9SThomas Gleixner  *	request_threaded_irq - allocate an interrupt line
18931da177e4SLinus Torvalds  *	@irq: Interrupt line to allocate
18943aa551c9SThomas Gleixner  *	@handler: Function to be called when the IRQ occurs.
18953aa551c9SThomas Gleixner  *		  Primary handler for threaded interrupts
1896b25c340cSThomas Gleixner  *		  If NULL and thread_fn != NULL the default
1897b25c340cSThomas Gleixner  *		  primary handler is installed
18983aa551c9SThomas Gleixner  *	@thread_fn: Function called from the irq handler thread
18993aa551c9SThomas Gleixner  *		    If NULL, no irq thread is created
19001da177e4SLinus Torvalds  *	@irqflags: Interrupt type flags
19011da177e4SLinus Torvalds  *	@devname: An ascii name for the claiming device
19021da177e4SLinus Torvalds  *	@dev_id: A cookie passed back to the handler function
19031da177e4SLinus Torvalds  *
19041da177e4SLinus Torvalds  *	This call allocates interrupt resources and enables the
19051da177e4SLinus Torvalds  *	interrupt line and IRQ handling. From the point this
19061da177e4SLinus Torvalds  *	call is made your handler function may be invoked. Since
19071da177e4SLinus Torvalds  *	your handler function must clear any interrupt the board
19081da177e4SLinus Torvalds  *	raises, you must take care both to initialise your hardware
19091da177e4SLinus Torvalds  *	and to set up the interrupt handler in the right order.
19101da177e4SLinus Torvalds  *
19113aa551c9SThomas Gleixner  *	If you want to set up a threaded irq handler for your device
19126d21af4fSJavi Merino  *	then you need to supply @handler and @thread_fn. @handler is
19133aa551c9SThomas Gleixner  *	still called in hard interrupt context and has to check
19143aa551c9SThomas Gleixner  *	whether the interrupt originates from the device. If yes it
19153aa551c9SThomas Gleixner  *	needs to disable the interrupt on the device and return
191639a2eddbSSteven Rostedt  *	IRQ_WAKE_THREAD which will wake up the handler thread and run
19173aa551c9SThomas Gleixner  *	@thread_fn. This split handler design is necessary to support
19183aa551c9SThomas Gleixner  *	shared interrupts.
19193aa551c9SThomas Gleixner  *
19201da177e4SLinus Torvalds  *	Dev_id must be globally unique. Normally the address of the
19211da177e4SLinus Torvalds  *	device data structure is used as the cookie. Since the handler
19221da177e4SLinus Torvalds  *	receives this value it makes sense to use it.
19231da177e4SLinus Torvalds  *
19241da177e4SLinus Torvalds  *	If your interrupt is shared you must pass a non NULL dev_id
19251da177e4SLinus Torvalds  *	as this is required when freeing the interrupt.
19261da177e4SLinus Torvalds  *
19271da177e4SLinus Torvalds  *	Flags:
19281da177e4SLinus Torvalds  *
19293cca53b0SThomas Gleixner  *	IRQF_SHARED		Interrupt is shared
19300c5d1eb7SDavid Brownell  *	IRQF_TRIGGER_*		Specify active edge(s) or level
19311da177e4SLinus Torvalds  *
19321da177e4SLinus Torvalds  */
19333aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler,
19343aa551c9SThomas Gleixner 			 irq_handler_t thread_fn, unsigned long irqflags,
19353aa551c9SThomas Gleixner 			 const char *devname, void *dev_id)
19361da177e4SLinus Torvalds {
19371da177e4SLinus Torvalds 	struct irqaction *action;
193808678b08SYinghai Lu 	struct irq_desc *desc;
1939d3c60047SThomas Gleixner 	int retval;
19401da177e4SLinus Torvalds 
1941e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
1942e237a551SChen Fan 		return -ENOTCONN;
1943e237a551SChen Fan 
1944470c6623SDavid Brownell 	/*
19451da177e4SLinus Torvalds 	 * Sanity-check: shared interrupts must pass in a real dev-ID,
19461da177e4SLinus Torvalds 	 * otherwise we'll have trouble later trying to figure out
19471da177e4SLinus Torvalds 	 * which interrupt is which (messes up the interrupt freeing
19481da177e4SLinus Torvalds 	 * logic etc).
194917f48034SRafael J. Wysocki 	 *
195017f48034SRafael J. Wysocki 	 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and
195117f48034SRafael J. Wysocki 	 * it cannot be set along with IRQF_NO_SUSPEND.
19521da177e4SLinus Torvalds 	 */
195317f48034SRafael J. Wysocki 	if (((irqflags & IRQF_SHARED) && !dev_id) ||
195417f48034SRafael J. Wysocki 	    (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) ||
195517f48034SRafael J. Wysocki 	    ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND)))
19561da177e4SLinus Torvalds 		return -EINVAL;
19577d94f7caSYinghai Lu 
1958cb5bc832SYinghai Lu 	desc = irq_to_desc(irq);
19597d94f7caSYinghai Lu 	if (!desc)
19601da177e4SLinus Torvalds 		return -EINVAL;
19617d94f7caSYinghai Lu 
196231d9d9b6SMarc Zyngier 	if (!irq_settings_can_request(desc) ||
196331d9d9b6SMarc Zyngier 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)))
19646550c775SThomas Gleixner 		return -EINVAL;
1965b25c340cSThomas Gleixner 
1966b25c340cSThomas Gleixner 	if (!handler) {
1967b25c340cSThomas Gleixner 		if (!thread_fn)
19681da177e4SLinus Torvalds 			return -EINVAL;
1969b25c340cSThomas Gleixner 		handler = irq_default_primary_handler;
1970b25c340cSThomas Gleixner 	}
19711da177e4SLinus Torvalds 
197245535732SThomas Gleixner 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
19731da177e4SLinus Torvalds 	if (!action)
19741da177e4SLinus Torvalds 		return -ENOMEM;
19751da177e4SLinus Torvalds 
19761da177e4SLinus Torvalds 	action->handler = handler;
19773aa551c9SThomas Gleixner 	action->thread_fn = thread_fn;
19781da177e4SLinus Torvalds 	action->flags = irqflags;
19791da177e4SLinus Torvalds 	action->name = devname;
19801da177e4SLinus Torvalds 	action->dev_id = dev_id;
19811da177e4SLinus Torvalds 
1982be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
19834396f46cSShawn Lin 	if (retval < 0) {
19844396f46cSShawn Lin 		kfree(action);
1985be45beb2SJon Hunter 		return retval;
19864396f46cSShawn Lin 	}
1987be45beb2SJon Hunter 
1988d3c60047SThomas Gleixner 	retval = __setup_irq(irq, desc, action);
198970aedd24SThomas Gleixner 
19902a1d3ab8SThomas Gleixner 	if (retval) {
1991be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
19922a1d3ab8SThomas Gleixner 		kfree(action->secondary);
1993377bf1e4SAnton Vorontsov 		kfree(action);
19942a1d3ab8SThomas Gleixner 	}
1995377bf1e4SAnton Vorontsov 
19966d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME
19976ce51c43SLuis Henriques 	if (!retval && (irqflags & IRQF_SHARED)) {
1998a304e1b8SDavid Woodhouse 		/*
1999a304e1b8SDavid Woodhouse 		 * It's a shared IRQ -- the driver ought to be prepared for it
2000a304e1b8SDavid Woodhouse 		 * to happen immediately, so let's make sure....
2001377bf1e4SAnton Vorontsov 		 * We disable the irq to make sure that a 'real' IRQ doesn't
2002377bf1e4SAnton Vorontsov 		 * run in parallel with our fake.
2003a304e1b8SDavid Woodhouse 		 */
2004a304e1b8SDavid Woodhouse 		unsigned long flags;
2005a304e1b8SDavid Woodhouse 
2006377bf1e4SAnton Vorontsov 		disable_irq(irq);
2007a304e1b8SDavid Woodhouse 		local_irq_save(flags);
2008377bf1e4SAnton Vorontsov 
2009a304e1b8SDavid Woodhouse 		handler(irq, dev_id);
2010377bf1e4SAnton Vorontsov 
2011a304e1b8SDavid Woodhouse 		local_irq_restore(flags);
2012377bf1e4SAnton Vorontsov 		enable_irq(irq);
2013a304e1b8SDavid Woodhouse 	}
2014a304e1b8SDavid Woodhouse #endif
20151da177e4SLinus Torvalds 	return retval;
20161da177e4SLinus Torvalds }
20173aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq);
2018ae731f8dSMarc Zyngier 
2019ae731f8dSMarc Zyngier /**
2020ae731f8dSMarc Zyngier  *	request_any_context_irq - allocate an interrupt line
2021ae731f8dSMarc Zyngier  *	@irq: Interrupt line to allocate
2022ae731f8dSMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
2023ae731f8dSMarc Zyngier  *		  Threaded handler for threaded interrupts.
2024ae731f8dSMarc Zyngier  *	@flags: Interrupt type flags
2025ae731f8dSMarc Zyngier  *	@name: An ascii name for the claiming device
2026ae731f8dSMarc Zyngier  *	@dev_id: A cookie passed back to the handler function
2027ae731f8dSMarc Zyngier  *
2028ae731f8dSMarc Zyngier  *	This call allocates interrupt resources and enables the
2029ae731f8dSMarc Zyngier  *	interrupt line and IRQ handling. It selects either a
2030ae731f8dSMarc Zyngier  *	hardirq or threaded handling method depending on the
2031ae731f8dSMarc Zyngier  *	context.
2032ae731f8dSMarc Zyngier  *
2033ae731f8dSMarc Zyngier  *	On failure, it returns a negative value. On success,
2034ae731f8dSMarc Zyngier  *	it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED.
2035ae731f8dSMarc Zyngier  */
2036ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler,
2037ae731f8dSMarc Zyngier 			    unsigned long flags, const char *name, void *dev_id)
2038ae731f8dSMarc Zyngier {
2039e237a551SChen Fan 	struct irq_desc *desc;
2040ae731f8dSMarc Zyngier 	int ret;
2041ae731f8dSMarc Zyngier 
2042e237a551SChen Fan 	if (irq == IRQ_NOTCONNECTED)
2043e237a551SChen Fan 		return -ENOTCONN;
2044e237a551SChen Fan 
2045e237a551SChen Fan 	desc = irq_to_desc(irq);
2046ae731f8dSMarc Zyngier 	if (!desc)
2047ae731f8dSMarc Zyngier 		return -EINVAL;
2048ae731f8dSMarc Zyngier 
20491ccb4e61SThomas Gleixner 	if (irq_settings_is_nested_thread(desc)) {
2050ae731f8dSMarc Zyngier 		ret = request_threaded_irq(irq, NULL, handler,
2051ae731f8dSMarc Zyngier 					   flags, name, dev_id);
2052ae731f8dSMarc Zyngier 		return !ret ? IRQC_IS_NESTED : ret;
2053ae731f8dSMarc Zyngier 	}
2054ae731f8dSMarc Zyngier 
2055ae731f8dSMarc Zyngier 	ret = request_irq(irq, handler, flags, name, dev_id);
2056ae731f8dSMarc Zyngier 	return !ret ? IRQC_IS_HARDIRQ : ret;
2057ae731f8dSMarc Zyngier }
2058ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq);
205931d9d9b6SMarc Zyngier 
2060b525903cSJulien Thierry /**
2061b525903cSJulien Thierry  *	request_nmi - allocate an interrupt line for NMI delivery
2062b525903cSJulien Thierry  *	@irq: Interrupt line to allocate
2063b525903cSJulien Thierry  *	@handler: Function to be called when the IRQ occurs.
2064b525903cSJulien Thierry  *		  Threaded handler for threaded interrupts.
2065b525903cSJulien Thierry  *	@irqflags: Interrupt type flags
2066b525903cSJulien Thierry  *	@name: An ascii name for the claiming device
2067b525903cSJulien Thierry  *	@dev_id: A cookie passed back to the handler function
2068b525903cSJulien Thierry  *
2069b525903cSJulien Thierry  *	This call allocates interrupt resources and enables the
2070b525903cSJulien Thierry  *	interrupt line and IRQ handling. It sets up the IRQ line
2071b525903cSJulien Thierry  *	to be handled as an NMI.
2072b525903cSJulien Thierry  *
2073b525903cSJulien Thierry  *	An interrupt line delivering NMIs cannot be shared and IRQ handling
2074b525903cSJulien Thierry  *	cannot be threaded.
2075b525903cSJulien Thierry  *
2076b525903cSJulien Thierry  *	Interrupt lines requested for NMI delivering must produce per cpu
2077b525903cSJulien Thierry  *	interrupts and have auto enabling setting disabled.
2078b525903cSJulien Thierry  *
2079b525903cSJulien Thierry  *	Dev_id must be globally unique. Normally the address of the
2080b525903cSJulien Thierry  *	device data structure is used as the cookie. Since the handler
2081b525903cSJulien Thierry  *	receives this value it makes sense to use it.
2082b525903cSJulien Thierry  *
2083b525903cSJulien Thierry  *	If the interrupt line cannot be used to deliver NMIs, function
2084b525903cSJulien Thierry  *	will fail and return a negative value.
2085b525903cSJulien Thierry  */
2086b525903cSJulien Thierry int request_nmi(unsigned int irq, irq_handler_t handler,
2087b525903cSJulien Thierry 		unsigned long irqflags, const char *name, void *dev_id)
2088b525903cSJulien Thierry {
2089b525903cSJulien Thierry 	struct irqaction *action;
2090b525903cSJulien Thierry 	struct irq_desc *desc;
2091b525903cSJulien Thierry 	unsigned long flags;
2092b525903cSJulien Thierry 	int retval;
2093b525903cSJulien Thierry 
2094b525903cSJulien Thierry 	if (irq == IRQ_NOTCONNECTED)
2095b525903cSJulien Thierry 		return -ENOTCONN;
2096b525903cSJulien Thierry 
2097b525903cSJulien Thierry 	/* NMI cannot be shared, used for Polling */
2098b525903cSJulien Thierry 	if (irqflags & (IRQF_SHARED | IRQF_COND_SUSPEND | IRQF_IRQPOLL))
2099b525903cSJulien Thierry 		return -EINVAL;
2100b525903cSJulien Thierry 
2101b525903cSJulien Thierry 	if (!(irqflags & IRQF_PERCPU))
2102b525903cSJulien Thierry 		return -EINVAL;
2103b525903cSJulien Thierry 
2104b525903cSJulien Thierry 	if (!handler)
2105b525903cSJulien Thierry 		return -EINVAL;
2106b525903cSJulien Thierry 
2107b525903cSJulien Thierry 	desc = irq_to_desc(irq);
2108b525903cSJulien Thierry 
2109b525903cSJulien Thierry 	if (!desc || irq_settings_can_autoenable(desc) ||
2110b525903cSJulien Thierry 	    !irq_settings_can_request(desc) ||
2111b525903cSJulien Thierry 	    WARN_ON(irq_settings_is_per_cpu_devid(desc)) ||
2112b525903cSJulien Thierry 	    !irq_supports_nmi(desc))
2113b525903cSJulien Thierry 		return -EINVAL;
2114b525903cSJulien Thierry 
2115b525903cSJulien Thierry 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
2116b525903cSJulien Thierry 	if (!action)
2117b525903cSJulien Thierry 		return -ENOMEM;
2118b525903cSJulien Thierry 
2119b525903cSJulien Thierry 	action->handler = handler;
2120b525903cSJulien Thierry 	action->flags = irqflags | IRQF_NO_THREAD | IRQF_NOBALANCING;
2121b525903cSJulien Thierry 	action->name = name;
2122b525903cSJulien Thierry 	action->dev_id = dev_id;
2123b525903cSJulien Thierry 
2124b525903cSJulien Thierry 	retval = irq_chip_pm_get(&desc->irq_data);
2125b525903cSJulien Thierry 	if (retval < 0)
2126b525903cSJulien Thierry 		goto err_out;
2127b525903cSJulien Thierry 
2128b525903cSJulien Thierry 	retval = __setup_irq(irq, desc, action);
2129b525903cSJulien Thierry 	if (retval)
2130b525903cSJulien Thierry 		goto err_irq_setup;
2131b525903cSJulien Thierry 
2132b525903cSJulien Thierry 	raw_spin_lock_irqsave(&desc->lock, flags);
2133b525903cSJulien Thierry 
2134b525903cSJulien Thierry 	/* Setup NMI state */
2135b525903cSJulien Thierry 	desc->istate |= IRQS_NMI;
2136b525903cSJulien Thierry 	retval = irq_nmi_setup(desc);
2137b525903cSJulien Thierry 	if (retval) {
2138b525903cSJulien Thierry 		__cleanup_nmi(irq, desc);
2139b525903cSJulien Thierry 		raw_spin_unlock_irqrestore(&desc->lock, flags);
2140b525903cSJulien Thierry 		return -EINVAL;
2141b525903cSJulien Thierry 	}
2142b525903cSJulien Thierry 
2143b525903cSJulien Thierry 	raw_spin_unlock_irqrestore(&desc->lock, flags);
2144b525903cSJulien Thierry 
2145b525903cSJulien Thierry 	return 0;
2146b525903cSJulien Thierry 
2147b525903cSJulien Thierry err_irq_setup:
2148b525903cSJulien Thierry 	irq_chip_pm_put(&desc->irq_data);
2149b525903cSJulien Thierry err_out:
2150b525903cSJulien Thierry 	kfree(action);
2151b525903cSJulien Thierry 
2152b525903cSJulien Thierry 	return retval;
2153b525903cSJulien Thierry }
2154b525903cSJulien Thierry 
21551e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type)
215631d9d9b6SMarc Zyngier {
215731d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
215831d9d9b6SMarc Zyngier 	unsigned long flags;
215931d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
216031d9d9b6SMarc Zyngier 
216131d9d9b6SMarc Zyngier 	if (!desc)
216231d9d9b6SMarc Zyngier 		return;
216331d9d9b6SMarc Zyngier 
2164f35ad083SMarc Zyngier 	/*
2165f35ad083SMarc Zyngier 	 * If the trigger type is not specified by the caller, then
2166f35ad083SMarc Zyngier 	 * use the default for this interrupt.
2167f35ad083SMarc Zyngier 	 */
21681e7c5fd2SMarc Zyngier 	type &= IRQ_TYPE_SENSE_MASK;
2169f35ad083SMarc Zyngier 	if (type == IRQ_TYPE_NONE)
2170f35ad083SMarc Zyngier 		type = irqd_get_trigger_type(&desc->irq_data);
2171f35ad083SMarc Zyngier 
21721e7c5fd2SMarc Zyngier 	if (type != IRQ_TYPE_NONE) {
21731e7c5fd2SMarc Zyngier 		int ret;
21741e7c5fd2SMarc Zyngier 
2175a1ff541aSJiang Liu 		ret = __irq_set_trigger(desc, type);
21761e7c5fd2SMarc Zyngier 
21771e7c5fd2SMarc Zyngier 		if (ret) {
217832cffddeSThomas Gleixner 			WARN(1, "failed to set type for IRQ%d\n", irq);
21791e7c5fd2SMarc Zyngier 			goto out;
21801e7c5fd2SMarc Zyngier 		}
21811e7c5fd2SMarc Zyngier 	}
21821e7c5fd2SMarc Zyngier 
218331d9d9b6SMarc Zyngier 	irq_percpu_enable(desc, cpu);
21841e7c5fd2SMarc Zyngier out:
218531d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
218631d9d9b6SMarc Zyngier }
218736a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq);
218831d9d9b6SMarc Zyngier 
21894b078c3fSJulien Thierry void enable_percpu_nmi(unsigned int irq, unsigned int type)
21904b078c3fSJulien Thierry {
21914b078c3fSJulien Thierry 	enable_percpu_irq(irq, type);
21924b078c3fSJulien Thierry }
21934b078c3fSJulien Thierry 
2194f0cb3220SThomas Petazzoni /**
2195f0cb3220SThomas Petazzoni  * irq_percpu_is_enabled - Check whether the per cpu irq is enabled
2196f0cb3220SThomas Petazzoni  * @irq:	Linux irq number to check for
2197f0cb3220SThomas Petazzoni  *
2198f0cb3220SThomas Petazzoni  * Must be called from a non migratable context. Returns the enable
2199f0cb3220SThomas Petazzoni  * state of a per cpu interrupt on the current cpu.
2200f0cb3220SThomas Petazzoni  */
2201f0cb3220SThomas Petazzoni bool irq_percpu_is_enabled(unsigned int irq)
2202f0cb3220SThomas Petazzoni {
2203f0cb3220SThomas Petazzoni 	unsigned int cpu = smp_processor_id();
2204f0cb3220SThomas Petazzoni 	struct irq_desc *desc;
2205f0cb3220SThomas Petazzoni 	unsigned long flags;
2206f0cb3220SThomas Petazzoni 	bool is_enabled;
2207f0cb3220SThomas Petazzoni 
2208f0cb3220SThomas Petazzoni 	desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
2209f0cb3220SThomas Petazzoni 	if (!desc)
2210f0cb3220SThomas Petazzoni 		return false;
2211f0cb3220SThomas Petazzoni 
2212f0cb3220SThomas Petazzoni 	is_enabled = cpumask_test_cpu(cpu, desc->percpu_enabled);
2213f0cb3220SThomas Petazzoni 	irq_put_desc_unlock(desc, flags);
2214f0cb3220SThomas Petazzoni 
2215f0cb3220SThomas Petazzoni 	return is_enabled;
2216f0cb3220SThomas Petazzoni }
2217f0cb3220SThomas Petazzoni EXPORT_SYMBOL_GPL(irq_percpu_is_enabled);
2218f0cb3220SThomas Petazzoni 
221931d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq)
222031d9d9b6SMarc Zyngier {
222131d9d9b6SMarc Zyngier 	unsigned int cpu = smp_processor_id();
222231d9d9b6SMarc Zyngier 	unsigned long flags;
222331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU);
222431d9d9b6SMarc Zyngier 
222531d9d9b6SMarc Zyngier 	if (!desc)
222631d9d9b6SMarc Zyngier 		return;
222731d9d9b6SMarc Zyngier 
222831d9d9b6SMarc Zyngier 	irq_percpu_disable(desc, cpu);
222931d9d9b6SMarc Zyngier 	irq_put_desc_unlock(desc, flags);
223031d9d9b6SMarc Zyngier }
223136a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq);
223231d9d9b6SMarc Zyngier 
22334b078c3fSJulien Thierry void disable_percpu_nmi(unsigned int irq)
22344b078c3fSJulien Thierry {
22354b078c3fSJulien Thierry 	disable_percpu_irq(irq);
22364b078c3fSJulien Thierry }
22374b078c3fSJulien Thierry 
223831d9d9b6SMarc Zyngier /*
223931d9d9b6SMarc Zyngier  * Internal function to unregister a percpu irqaction.
224031d9d9b6SMarc Zyngier  */
224131d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id)
224231d9d9b6SMarc Zyngier {
224331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
224431d9d9b6SMarc Zyngier 	struct irqaction *action;
224531d9d9b6SMarc Zyngier 	unsigned long flags;
224631d9d9b6SMarc Zyngier 
224731d9d9b6SMarc Zyngier 	WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq);
224831d9d9b6SMarc Zyngier 
224931d9d9b6SMarc Zyngier 	if (!desc)
225031d9d9b6SMarc Zyngier 		return NULL;
225131d9d9b6SMarc Zyngier 
225231d9d9b6SMarc Zyngier 	raw_spin_lock_irqsave(&desc->lock, flags);
225331d9d9b6SMarc Zyngier 
225431d9d9b6SMarc Zyngier 	action = desc->action;
225531d9d9b6SMarc Zyngier 	if (!action || action->percpu_dev_id != dev_id) {
225631d9d9b6SMarc Zyngier 		WARN(1, "Trying to free already-free IRQ %d\n", irq);
225731d9d9b6SMarc Zyngier 		goto bad;
225831d9d9b6SMarc Zyngier 	}
225931d9d9b6SMarc Zyngier 
226031d9d9b6SMarc Zyngier 	if (!cpumask_empty(desc->percpu_enabled)) {
226131d9d9b6SMarc Zyngier 		WARN(1, "percpu IRQ %d still enabled on CPU%d!\n",
226231d9d9b6SMarc Zyngier 		     irq, cpumask_first(desc->percpu_enabled));
226331d9d9b6SMarc Zyngier 		goto bad;
226431d9d9b6SMarc Zyngier 	}
226531d9d9b6SMarc Zyngier 
226631d9d9b6SMarc Zyngier 	/* Found it - now remove it from the list of entries: */
226731d9d9b6SMarc Zyngier 	desc->action = NULL;
226831d9d9b6SMarc Zyngier 
22694b078c3fSJulien Thierry 	desc->istate &= ~IRQS_NMI;
22704b078c3fSJulien Thierry 
227131d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
227231d9d9b6SMarc Zyngier 
227331d9d9b6SMarc Zyngier 	unregister_handler_proc(irq, action);
227431d9d9b6SMarc Zyngier 
2275be45beb2SJon Hunter 	irq_chip_pm_put(&desc->irq_data);
227631d9d9b6SMarc Zyngier 	module_put(desc->owner);
227731d9d9b6SMarc Zyngier 	return action;
227831d9d9b6SMarc Zyngier 
227931d9d9b6SMarc Zyngier bad:
228031d9d9b6SMarc Zyngier 	raw_spin_unlock_irqrestore(&desc->lock, flags);
228131d9d9b6SMarc Zyngier 	return NULL;
228231d9d9b6SMarc Zyngier }
228331d9d9b6SMarc Zyngier 
228431d9d9b6SMarc Zyngier /**
228531d9d9b6SMarc Zyngier  *	remove_percpu_irq - free a per-cpu interrupt
228631d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
228731d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
228831d9d9b6SMarc Zyngier  *
228931d9d9b6SMarc Zyngier  * Used to remove interrupts statically setup by the early boot process.
229031d9d9b6SMarc Zyngier  */
229131d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act)
229231d9d9b6SMarc Zyngier {
229331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
229431d9d9b6SMarc Zyngier 
229531d9d9b6SMarc Zyngier 	if (desc && irq_settings_is_per_cpu_devid(desc))
229631d9d9b6SMarc Zyngier 	    __free_percpu_irq(irq, act->percpu_dev_id);
229731d9d9b6SMarc Zyngier }
229831d9d9b6SMarc Zyngier 
229931d9d9b6SMarc Zyngier /**
230031d9d9b6SMarc Zyngier  *	free_percpu_irq - free an interrupt allocated with request_percpu_irq
230131d9d9b6SMarc Zyngier  *	@irq: Interrupt line to free
230231d9d9b6SMarc Zyngier  *	@dev_id: Device identity to free
230331d9d9b6SMarc Zyngier  *
230431d9d9b6SMarc Zyngier  *	Remove a percpu interrupt handler. The handler is removed, but
230531d9d9b6SMarc Zyngier  *	the interrupt line is not disabled. This must be done on each
230631d9d9b6SMarc Zyngier  *	CPU before calling this function. The function does not return
230731d9d9b6SMarc Zyngier  *	until any executing interrupts for this IRQ have completed.
230831d9d9b6SMarc Zyngier  *
230931d9d9b6SMarc Zyngier  *	This function must not be called from interrupt context.
231031d9d9b6SMarc Zyngier  */
231131d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id)
231231d9d9b6SMarc Zyngier {
231331d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
231431d9d9b6SMarc Zyngier 
231531d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
231631d9d9b6SMarc Zyngier 		return;
231731d9d9b6SMarc Zyngier 
231831d9d9b6SMarc Zyngier 	chip_bus_lock(desc);
231931d9d9b6SMarc Zyngier 	kfree(__free_percpu_irq(irq, dev_id));
232031d9d9b6SMarc Zyngier 	chip_bus_sync_unlock(desc);
232131d9d9b6SMarc Zyngier }
2322aec2e2adSMaxime Ripard EXPORT_SYMBOL_GPL(free_percpu_irq);
232331d9d9b6SMarc Zyngier 
23244b078c3fSJulien Thierry void free_percpu_nmi(unsigned int irq, void __percpu *dev_id)
23254b078c3fSJulien Thierry {
23264b078c3fSJulien Thierry 	struct irq_desc *desc = irq_to_desc(irq);
23274b078c3fSJulien Thierry 
23284b078c3fSJulien Thierry 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
23294b078c3fSJulien Thierry 		return;
23304b078c3fSJulien Thierry 
23314b078c3fSJulien Thierry 	if (WARN_ON(!(desc->istate & IRQS_NMI)))
23324b078c3fSJulien Thierry 		return;
23334b078c3fSJulien Thierry 
23344b078c3fSJulien Thierry 	kfree(__free_percpu_irq(irq, dev_id));
23354b078c3fSJulien Thierry }
23364b078c3fSJulien Thierry 
233731d9d9b6SMarc Zyngier /**
233831d9d9b6SMarc Zyngier  *	setup_percpu_irq - setup a per-cpu interrupt
233931d9d9b6SMarc Zyngier  *	@irq: Interrupt line to setup
234031d9d9b6SMarc Zyngier  *	@act: irqaction for the interrupt
234131d9d9b6SMarc Zyngier  *
234231d9d9b6SMarc Zyngier  * Used to statically setup per-cpu interrupts in the early boot process.
234331d9d9b6SMarc Zyngier  */
234431d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act)
234531d9d9b6SMarc Zyngier {
234631d9d9b6SMarc Zyngier 	struct irq_desc *desc = irq_to_desc(irq);
234731d9d9b6SMarc Zyngier 	int retval;
234831d9d9b6SMarc Zyngier 
234931d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_is_per_cpu_devid(desc))
235031d9d9b6SMarc Zyngier 		return -EINVAL;
2351be45beb2SJon Hunter 
2352be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
2353be45beb2SJon Hunter 	if (retval < 0)
2354be45beb2SJon Hunter 		return retval;
2355be45beb2SJon Hunter 
235631d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, act);
235731d9d9b6SMarc Zyngier 
2358be45beb2SJon Hunter 	if (retval)
2359be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
2360be45beb2SJon Hunter 
236131d9d9b6SMarc Zyngier 	return retval;
236231d9d9b6SMarc Zyngier }
236331d9d9b6SMarc Zyngier 
236431d9d9b6SMarc Zyngier /**
2365c80081b9SDaniel Lezcano  *	__request_percpu_irq - allocate a percpu interrupt line
236631d9d9b6SMarc Zyngier  *	@irq: Interrupt line to allocate
236731d9d9b6SMarc Zyngier  *	@handler: Function to be called when the IRQ occurs.
2368c80081b9SDaniel Lezcano  *	@flags: Interrupt type flags (IRQF_TIMER only)
236931d9d9b6SMarc Zyngier  *	@devname: An ascii name for the claiming device
237031d9d9b6SMarc Zyngier  *	@dev_id: A percpu cookie passed back to the handler function
237131d9d9b6SMarc Zyngier  *
2372a1b7febdSMaxime Ripard  *	This call allocates interrupt resources and enables the
2373a1b7febdSMaxime Ripard  *	interrupt on the local CPU. If the interrupt is supposed to be
2374a1b7febdSMaxime Ripard  *	enabled on other CPUs, it has to be done on each CPU using
2375a1b7febdSMaxime Ripard  *	enable_percpu_irq().
237631d9d9b6SMarc Zyngier  *
237731d9d9b6SMarc Zyngier  *	Dev_id must be globally unique. It is a per-cpu variable, and
237831d9d9b6SMarc Zyngier  *	the handler gets called with the interrupted CPU's instance of
237931d9d9b6SMarc Zyngier  *	that variable.
238031d9d9b6SMarc Zyngier  */
2381c80081b9SDaniel Lezcano int __request_percpu_irq(unsigned int irq, irq_handler_t handler,
2382c80081b9SDaniel Lezcano 			 unsigned long flags, const char *devname,
2383c80081b9SDaniel Lezcano 			 void __percpu *dev_id)
238431d9d9b6SMarc Zyngier {
238531d9d9b6SMarc Zyngier 	struct irqaction *action;
238631d9d9b6SMarc Zyngier 	struct irq_desc *desc;
238731d9d9b6SMarc Zyngier 	int retval;
238831d9d9b6SMarc Zyngier 
238931d9d9b6SMarc Zyngier 	if (!dev_id)
239031d9d9b6SMarc Zyngier 		return -EINVAL;
239131d9d9b6SMarc Zyngier 
239231d9d9b6SMarc Zyngier 	desc = irq_to_desc(irq);
239331d9d9b6SMarc Zyngier 	if (!desc || !irq_settings_can_request(desc) ||
239431d9d9b6SMarc Zyngier 	    !irq_settings_is_per_cpu_devid(desc))
239531d9d9b6SMarc Zyngier 		return -EINVAL;
239631d9d9b6SMarc Zyngier 
2397c80081b9SDaniel Lezcano 	if (flags && flags != IRQF_TIMER)
2398c80081b9SDaniel Lezcano 		return -EINVAL;
2399c80081b9SDaniel Lezcano 
240031d9d9b6SMarc Zyngier 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
240131d9d9b6SMarc Zyngier 	if (!action)
240231d9d9b6SMarc Zyngier 		return -ENOMEM;
240331d9d9b6SMarc Zyngier 
240431d9d9b6SMarc Zyngier 	action->handler = handler;
2405c80081b9SDaniel Lezcano 	action->flags = flags | IRQF_PERCPU | IRQF_NO_SUSPEND;
240631d9d9b6SMarc Zyngier 	action->name = devname;
240731d9d9b6SMarc Zyngier 	action->percpu_dev_id = dev_id;
240831d9d9b6SMarc Zyngier 
2409be45beb2SJon Hunter 	retval = irq_chip_pm_get(&desc->irq_data);
24104396f46cSShawn Lin 	if (retval < 0) {
24114396f46cSShawn Lin 		kfree(action);
2412be45beb2SJon Hunter 		return retval;
24134396f46cSShawn Lin 	}
2414be45beb2SJon Hunter 
241531d9d9b6SMarc Zyngier 	retval = __setup_irq(irq, desc, action);
241631d9d9b6SMarc Zyngier 
2417be45beb2SJon Hunter 	if (retval) {
2418be45beb2SJon Hunter 		irq_chip_pm_put(&desc->irq_data);
241931d9d9b6SMarc Zyngier 		kfree(action);
2420be45beb2SJon Hunter 	}
242131d9d9b6SMarc Zyngier 
242231d9d9b6SMarc Zyngier 	return retval;
242331d9d9b6SMarc Zyngier }
2424c80081b9SDaniel Lezcano EXPORT_SYMBOL_GPL(__request_percpu_irq);
24251b7047edSMarc Zyngier 
24261b7047edSMarc Zyngier /**
24274b078c3fSJulien Thierry  *	request_percpu_nmi - allocate a percpu interrupt line for NMI delivery
24284b078c3fSJulien Thierry  *	@irq: Interrupt line to allocate
24294b078c3fSJulien Thierry  *	@handler: Function to be called when the IRQ occurs.
24304b078c3fSJulien Thierry  *	@name: An ascii name for the claiming device
24314b078c3fSJulien Thierry  *	@dev_id: A percpu cookie passed back to the handler function
24324b078c3fSJulien Thierry  *
24334b078c3fSJulien Thierry  *	This call allocates interrupt resources for a per CPU NMI. Per CPU NMIs
2434a5186694SJulien Thierry  *	have to be setup on each CPU by calling prepare_percpu_nmi() before
2435a5186694SJulien Thierry  *	being enabled on the same CPU by using enable_percpu_nmi().
24364b078c3fSJulien Thierry  *
24374b078c3fSJulien Thierry  *	Dev_id must be globally unique. It is a per-cpu variable, and
24384b078c3fSJulien Thierry  *	the handler gets called with the interrupted CPU's instance of
24394b078c3fSJulien Thierry  *	that variable.
24404b078c3fSJulien Thierry  *
24414b078c3fSJulien Thierry  *	Interrupt lines requested for NMI delivering should have auto enabling
24424b078c3fSJulien Thierry  *	setting disabled.
24434b078c3fSJulien Thierry  *
24444b078c3fSJulien Thierry  *	If the interrupt line cannot be used to deliver NMIs, function
24454b078c3fSJulien Thierry  *	will fail returning a negative value.
24464b078c3fSJulien Thierry  */
24474b078c3fSJulien Thierry int request_percpu_nmi(unsigned int irq, irq_handler_t handler,
24484b078c3fSJulien Thierry 		       const char *name, void __percpu *dev_id)
24494b078c3fSJulien Thierry {
24504b078c3fSJulien Thierry 	struct irqaction *action;
24514b078c3fSJulien Thierry 	struct irq_desc *desc;
24524b078c3fSJulien Thierry 	unsigned long flags;
24534b078c3fSJulien Thierry 	int retval;
24544b078c3fSJulien Thierry 
24554b078c3fSJulien Thierry 	if (!handler)
24564b078c3fSJulien Thierry 		return -EINVAL;
24574b078c3fSJulien Thierry 
24584b078c3fSJulien Thierry 	desc = irq_to_desc(irq);
24594b078c3fSJulien Thierry 
24604b078c3fSJulien Thierry 	if (!desc || !irq_settings_can_request(desc) ||
24614b078c3fSJulien Thierry 	    !irq_settings_is_per_cpu_devid(desc) ||
24624b078c3fSJulien Thierry 	    irq_settings_can_autoenable(desc) ||
24634b078c3fSJulien Thierry 	    !irq_supports_nmi(desc))
24644b078c3fSJulien Thierry 		return -EINVAL;
24654b078c3fSJulien Thierry 
24664b078c3fSJulien Thierry 	/* The line cannot already be NMI */
24674b078c3fSJulien Thierry 	if (desc->istate & IRQS_NMI)
24684b078c3fSJulien Thierry 		return -EINVAL;
24694b078c3fSJulien Thierry 
24704b078c3fSJulien Thierry 	action = kzalloc(sizeof(struct irqaction), GFP_KERNEL);
24714b078c3fSJulien Thierry 	if (!action)
24724b078c3fSJulien Thierry 		return -ENOMEM;
24734b078c3fSJulien Thierry 
24744b078c3fSJulien Thierry 	action->handler = handler;
24754b078c3fSJulien Thierry 	action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND | IRQF_NO_THREAD
24764b078c3fSJulien Thierry 		| IRQF_NOBALANCING;
24774b078c3fSJulien Thierry 	action->name = name;
24784b078c3fSJulien Thierry 	action->percpu_dev_id = dev_id;
24794b078c3fSJulien Thierry 
24804b078c3fSJulien Thierry 	retval = irq_chip_pm_get(&desc->irq_data);
24814b078c3fSJulien Thierry 	if (retval < 0)
24824b078c3fSJulien Thierry 		goto err_out;
24834b078c3fSJulien Thierry 
24844b078c3fSJulien Thierry 	retval = __setup_irq(irq, desc, action);
24854b078c3fSJulien Thierry 	if (retval)
24864b078c3fSJulien Thierry 		goto err_irq_setup;
24874b078c3fSJulien Thierry 
24884b078c3fSJulien Thierry 	raw_spin_lock_irqsave(&desc->lock, flags);
24894b078c3fSJulien Thierry 	desc->istate |= IRQS_NMI;
24904b078c3fSJulien Thierry 	raw_spin_unlock_irqrestore(&desc->lock, flags);
24914b078c3fSJulien Thierry 
24924b078c3fSJulien Thierry 	return 0;
24934b078c3fSJulien Thierry 
24944b078c3fSJulien Thierry err_irq_setup:
24954b078c3fSJulien Thierry 	irq_chip_pm_put(&desc->irq_data);
24964b078c3fSJulien Thierry err_out:
24974b078c3fSJulien Thierry 	kfree(action);
24984b078c3fSJulien Thierry 
24994b078c3fSJulien Thierry 	return retval;
25004b078c3fSJulien Thierry }
25014b078c3fSJulien Thierry 
25024b078c3fSJulien Thierry /**
25034b078c3fSJulien Thierry  *	prepare_percpu_nmi - performs CPU local setup for NMI delivery
25044b078c3fSJulien Thierry  *	@irq: Interrupt line to prepare for NMI delivery
25054b078c3fSJulien Thierry  *
25064b078c3fSJulien Thierry  *	This call prepares an interrupt line to deliver NMI on the current CPU,
25074b078c3fSJulien Thierry  *	before that interrupt line gets enabled with enable_percpu_nmi().
25084b078c3fSJulien Thierry  *
25094b078c3fSJulien Thierry  *	As a CPU local operation, this should be called from non-preemptible
25104b078c3fSJulien Thierry  *	context.
25114b078c3fSJulien Thierry  *
25124b078c3fSJulien Thierry  *	If the interrupt line cannot be used to deliver NMIs, function
25134b078c3fSJulien Thierry  *	will fail returning a negative value.
25144b078c3fSJulien Thierry  */
25154b078c3fSJulien Thierry int prepare_percpu_nmi(unsigned int irq)
25164b078c3fSJulien Thierry {
25174b078c3fSJulien Thierry 	unsigned long flags;
25184b078c3fSJulien Thierry 	struct irq_desc *desc;
25194b078c3fSJulien Thierry 	int ret = 0;
25204b078c3fSJulien Thierry 
25214b078c3fSJulien Thierry 	WARN_ON(preemptible());
25224b078c3fSJulien Thierry 
25234b078c3fSJulien Thierry 	desc = irq_get_desc_lock(irq, &flags,
25244b078c3fSJulien Thierry 				 IRQ_GET_DESC_CHECK_PERCPU);
25254b078c3fSJulien Thierry 	if (!desc)
25264b078c3fSJulien Thierry 		return -EINVAL;
25274b078c3fSJulien Thierry 
25284b078c3fSJulien Thierry 	if (WARN(!(desc->istate & IRQS_NMI),
25294b078c3fSJulien Thierry 		 KERN_ERR "prepare_percpu_nmi called for a non-NMI interrupt: irq %u\n",
25304b078c3fSJulien Thierry 		 irq)) {
25314b078c3fSJulien Thierry 		ret = -EINVAL;
25324b078c3fSJulien Thierry 		goto out;
25334b078c3fSJulien Thierry 	}
25344b078c3fSJulien Thierry 
25354b078c3fSJulien Thierry 	ret = irq_nmi_setup(desc);
25364b078c3fSJulien Thierry 	if (ret) {
25374b078c3fSJulien Thierry 		pr_err("Failed to setup NMI delivery: irq %u\n", irq);
25384b078c3fSJulien Thierry 		goto out;
25394b078c3fSJulien Thierry 	}
25404b078c3fSJulien Thierry 
25414b078c3fSJulien Thierry out:
25424b078c3fSJulien Thierry 	irq_put_desc_unlock(desc, flags);
25434b078c3fSJulien Thierry 	return ret;
25444b078c3fSJulien Thierry }
25454b078c3fSJulien Thierry 
25464b078c3fSJulien Thierry /**
25474b078c3fSJulien Thierry  *	teardown_percpu_nmi - undoes NMI setup of IRQ line
25484b078c3fSJulien Thierry  *	@irq: Interrupt line from which CPU local NMI configuration should be
25494b078c3fSJulien Thierry  *	      removed
25504b078c3fSJulien Thierry  *
25514b078c3fSJulien Thierry  *	This call undoes the setup done by prepare_percpu_nmi().
25524b078c3fSJulien Thierry  *
25534b078c3fSJulien Thierry  *	IRQ line should not be enabled for the current CPU.
25544b078c3fSJulien Thierry  *
25554b078c3fSJulien Thierry  *	As a CPU local operation, this should be called from non-preemptible
25564b078c3fSJulien Thierry  *	context.
25574b078c3fSJulien Thierry  */
25584b078c3fSJulien Thierry void teardown_percpu_nmi(unsigned int irq)
25594b078c3fSJulien Thierry {
25604b078c3fSJulien Thierry 	unsigned long flags;
25614b078c3fSJulien Thierry 	struct irq_desc *desc;
25624b078c3fSJulien Thierry 
25634b078c3fSJulien Thierry 	WARN_ON(preemptible());
25644b078c3fSJulien Thierry 
25654b078c3fSJulien Thierry 	desc = irq_get_desc_lock(irq, &flags,
25664b078c3fSJulien Thierry 				 IRQ_GET_DESC_CHECK_PERCPU);
25674b078c3fSJulien Thierry 	if (!desc)
25684b078c3fSJulien Thierry 		return;
25694b078c3fSJulien Thierry 
25704b078c3fSJulien Thierry 	if (WARN_ON(!(desc->istate & IRQS_NMI)))
25714b078c3fSJulien Thierry 		goto out;
25724b078c3fSJulien Thierry 
25734b078c3fSJulien Thierry 	irq_nmi_teardown(desc);
25744b078c3fSJulien Thierry out:
25754b078c3fSJulien Thierry 	irq_put_desc_unlock(desc, flags);
25764b078c3fSJulien Thierry }
25774b078c3fSJulien Thierry 
25784b078c3fSJulien Thierry /**
25791b7047edSMarc Zyngier  *	irq_get_irqchip_state - returns the irqchip state of a interrupt.
25801b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
25811b7047edSMarc Zyngier  *	@which: One of IRQCHIP_STATE_* the caller wants to know about
25821b7047edSMarc Zyngier  *	@state: a pointer to a boolean where the state is to be storeed
25831b7047edSMarc Zyngier  *
25841b7047edSMarc Zyngier  *	This call snapshots the internal irqchip state of an
25851b7047edSMarc Zyngier  *	interrupt, returning into @state the bit corresponding to
25861b7047edSMarc Zyngier  *	stage @which
25871b7047edSMarc Zyngier  *
25881b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
25891b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
25901b7047edSMarc Zyngier  */
25911b7047edSMarc Zyngier int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
25921b7047edSMarc Zyngier 			  bool *state)
25931b7047edSMarc Zyngier {
25941b7047edSMarc Zyngier 	struct irq_desc *desc;
25951b7047edSMarc Zyngier 	struct irq_data *data;
25961b7047edSMarc Zyngier 	struct irq_chip *chip;
25971b7047edSMarc Zyngier 	unsigned long flags;
25981b7047edSMarc Zyngier 	int err = -EINVAL;
25991b7047edSMarc Zyngier 
26001b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
26011b7047edSMarc Zyngier 	if (!desc)
26021b7047edSMarc Zyngier 		return err;
26031b7047edSMarc Zyngier 
26041b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
26051b7047edSMarc Zyngier 
26061b7047edSMarc Zyngier 	do {
26071b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
26081b7047edSMarc Zyngier 		if (chip->irq_get_irqchip_state)
26091b7047edSMarc Zyngier 			break;
26101b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
26111b7047edSMarc Zyngier 		data = data->parent_data;
26121b7047edSMarc Zyngier #else
26131b7047edSMarc Zyngier 		data = NULL;
26141b7047edSMarc Zyngier #endif
26151b7047edSMarc Zyngier 	} while (data);
26161b7047edSMarc Zyngier 
26171b7047edSMarc Zyngier 	if (data)
26181b7047edSMarc Zyngier 		err = chip->irq_get_irqchip_state(data, which, state);
26191b7047edSMarc Zyngier 
26201b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
26211b7047edSMarc Zyngier 	return err;
26221b7047edSMarc Zyngier }
26231ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_get_irqchip_state);
26241b7047edSMarc Zyngier 
26251b7047edSMarc Zyngier /**
26261b7047edSMarc Zyngier  *	irq_set_irqchip_state - set the state of a forwarded interrupt.
26271b7047edSMarc Zyngier  *	@irq: Interrupt line that is forwarded to a VM
26281b7047edSMarc Zyngier  *	@which: State to be restored (one of IRQCHIP_STATE_*)
26291b7047edSMarc Zyngier  *	@val: Value corresponding to @which
26301b7047edSMarc Zyngier  *
26311b7047edSMarc Zyngier  *	This call sets the internal irqchip state of an interrupt,
26321b7047edSMarc Zyngier  *	depending on the value of @which.
26331b7047edSMarc Zyngier  *
26341b7047edSMarc Zyngier  *	This function should be called with preemption disabled if the
26351b7047edSMarc Zyngier  *	interrupt controller has per-cpu registers.
26361b7047edSMarc Zyngier  */
26371b7047edSMarc Zyngier int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which,
26381b7047edSMarc Zyngier 			  bool val)
26391b7047edSMarc Zyngier {
26401b7047edSMarc Zyngier 	struct irq_desc *desc;
26411b7047edSMarc Zyngier 	struct irq_data *data;
26421b7047edSMarc Zyngier 	struct irq_chip *chip;
26431b7047edSMarc Zyngier 	unsigned long flags;
26441b7047edSMarc Zyngier 	int err = -EINVAL;
26451b7047edSMarc Zyngier 
26461b7047edSMarc Zyngier 	desc = irq_get_desc_buslock(irq, &flags, 0);
26471b7047edSMarc Zyngier 	if (!desc)
26481b7047edSMarc Zyngier 		return err;
26491b7047edSMarc Zyngier 
26501b7047edSMarc Zyngier 	data = irq_desc_get_irq_data(desc);
26511b7047edSMarc Zyngier 
26521b7047edSMarc Zyngier 	do {
26531b7047edSMarc Zyngier 		chip = irq_data_get_irq_chip(data);
26541b7047edSMarc Zyngier 		if (chip->irq_set_irqchip_state)
26551b7047edSMarc Zyngier 			break;
26561b7047edSMarc Zyngier #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
26571b7047edSMarc Zyngier 		data = data->parent_data;
26581b7047edSMarc Zyngier #else
26591b7047edSMarc Zyngier 		data = NULL;
26601b7047edSMarc Zyngier #endif
26611b7047edSMarc Zyngier 	} while (data);
26621b7047edSMarc Zyngier 
26631b7047edSMarc Zyngier 	if (data)
26641b7047edSMarc Zyngier 		err = chip->irq_set_irqchip_state(data, which, val);
26651b7047edSMarc Zyngier 
26661b7047edSMarc Zyngier 	irq_put_desc_busunlock(desc, flags);
26671b7047edSMarc Zyngier 	return err;
26681b7047edSMarc Zyngier }
26691ee4fb3eSBjorn Andersson EXPORT_SYMBOL_GPL(irq_set_irqchip_state);
2670