11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * linux/kernel/irq/manage.c 31da177e4SLinus Torvalds * 4a34db9b2SIngo Molnar * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar 5a34db9b2SIngo Molnar * Copyright (C) 2005-2006 Thomas Gleixner 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * This file contains driver APIs to the irq subsystem. 81da177e4SLinus Torvalds */ 91da177e4SLinus Torvalds 1097fd75b7SAndrew Morton #define pr_fmt(fmt) "genirq: " fmt 1197fd75b7SAndrew Morton 121da177e4SLinus Torvalds #include <linux/irq.h> 133aa551c9SThomas Gleixner #include <linux/kthread.h> 141da177e4SLinus Torvalds #include <linux/module.h> 151da177e4SLinus Torvalds #include <linux/random.h> 161da177e4SLinus Torvalds #include <linux/interrupt.h> 171aeb272cSRobert P. J. Day #include <linux/slab.h> 183aa551c9SThomas Gleixner #include <linux/sched.h> 198bd75c77SClark Williams #include <linux/sched/rt.h> 204d1d61a6SOleg Nesterov #include <linux/task_work.h> 211da177e4SLinus Torvalds 221da177e4SLinus Torvalds #include "internals.h" 231da177e4SLinus Torvalds 248d32a307SThomas Gleixner #ifdef CONFIG_IRQ_FORCED_THREADING 258d32a307SThomas Gleixner __read_mostly bool force_irqthreads; 268d32a307SThomas Gleixner 278d32a307SThomas Gleixner static int __init setup_forced_irqthreads(char *arg) 288d32a307SThomas Gleixner { 298d32a307SThomas Gleixner force_irqthreads = true; 308d32a307SThomas Gleixner return 0; 318d32a307SThomas Gleixner } 328d32a307SThomas Gleixner early_param("threadirqs", setup_forced_irqthreads); 338d32a307SThomas Gleixner #endif 348d32a307SThomas Gleixner 3518258f72SThomas Gleixner static void __synchronize_hardirq(struct irq_desc *desc) 361da177e4SLinus Torvalds { 3732f4125eSThomas Gleixner bool inprogress; 381da177e4SLinus Torvalds 39a98ce5c6SHerbert Xu do { 40a98ce5c6SHerbert Xu unsigned long flags; 41a98ce5c6SHerbert Xu 42a98ce5c6SHerbert Xu /* 43a98ce5c6SHerbert Xu * Wait until we're out of the critical section. This might 44a98ce5c6SHerbert Xu * give the wrong answer due to the lack of memory barriers. 45a98ce5c6SHerbert Xu */ 4632f4125eSThomas Gleixner while (irqd_irq_inprogress(&desc->irq_data)) 471da177e4SLinus Torvalds cpu_relax(); 48a98ce5c6SHerbert Xu 49a98ce5c6SHerbert Xu /* Ok, that indicated we're done: double-check carefully. */ 50239007b8SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 5132f4125eSThomas Gleixner inprogress = irqd_irq_inprogress(&desc->irq_data); 52239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 53a98ce5c6SHerbert Xu 54a98ce5c6SHerbert Xu /* Oops, that failed? */ 5532f4125eSThomas Gleixner } while (inprogress); 5618258f72SThomas Gleixner } 573aa551c9SThomas Gleixner 5818258f72SThomas Gleixner /** 5918258f72SThomas Gleixner * synchronize_hardirq - wait for pending hard IRQ handlers (on other CPUs) 6018258f72SThomas Gleixner * @irq: interrupt number to wait for 6118258f72SThomas Gleixner * 6218258f72SThomas Gleixner * This function waits for any pending hard IRQ handlers for this 6318258f72SThomas Gleixner * interrupt to complete before returning. If you use this 6418258f72SThomas Gleixner * function while holding a resource the IRQ handler may need you 6518258f72SThomas Gleixner * will deadlock. It does not take associated threaded handlers 6618258f72SThomas Gleixner * into account. 6718258f72SThomas Gleixner * 6818258f72SThomas Gleixner * Do not use this for shutdown scenarios where you must be sure 6918258f72SThomas Gleixner * that all parts (hardirq and threaded handler) have completed. 7018258f72SThomas Gleixner * 7118258f72SThomas Gleixner * This function may be called - with care - from IRQ context. 723aa551c9SThomas Gleixner */ 7318258f72SThomas Gleixner void synchronize_hardirq(unsigned int irq) 7418258f72SThomas Gleixner { 7518258f72SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 7618258f72SThomas Gleixner 7718258f72SThomas Gleixner if (desc) 7818258f72SThomas Gleixner __synchronize_hardirq(desc); 7918258f72SThomas Gleixner } 8018258f72SThomas Gleixner EXPORT_SYMBOL(synchronize_hardirq); 8118258f72SThomas Gleixner 8218258f72SThomas Gleixner /** 8318258f72SThomas Gleixner * synchronize_irq - wait for pending IRQ handlers (on other CPUs) 8418258f72SThomas Gleixner * @irq: interrupt number to wait for 8518258f72SThomas Gleixner * 8618258f72SThomas Gleixner * This function waits for any pending IRQ handlers for this interrupt 8718258f72SThomas Gleixner * to complete before returning. If you use this function while 8818258f72SThomas Gleixner * holding a resource the IRQ handler may need you will deadlock. 8918258f72SThomas Gleixner * 9018258f72SThomas Gleixner * This function may be called - with care - from IRQ context. 9118258f72SThomas Gleixner */ 9218258f72SThomas Gleixner void synchronize_irq(unsigned int irq) 9318258f72SThomas Gleixner { 9418258f72SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 9518258f72SThomas Gleixner 9618258f72SThomas Gleixner if (desc) { 9718258f72SThomas Gleixner __synchronize_hardirq(desc); 9818258f72SThomas Gleixner /* 9918258f72SThomas Gleixner * We made sure that no hardirq handler is 10018258f72SThomas Gleixner * running. Now verify that no threaded handlers are 10118258f72SThomas Gleixner * active. 10218258f72SThomas Gleixner */ 10318258f72SThomas Gleixner wait_event(desc->wait_for_threads, 10418258f72SThomas Gleixner !atomic_read(&desc->threads_active)); 10518258f72SThomas Gleixner } 1061da177e4SLinus Torvalds } 1071da177e4SLinus Torvalds EXPORT_SYMBOL(synchronize_irq); 1081da177e4SLinus Torvalds 1093aa551c9SThomas Gleixner #ifdef CONFIG_SMP 1103aa551c9SThomas Gleixner cpumask_var_t irq_default_affinity; 1113aa551c9SThomas Gleixner 112771ee3b0SThomas Gleixner /** 113771ee3b0SThomas Gleixner * irq_can_set_affinity - Check if the affinity of a given irq can be set 114771ee3b0SThomas Gleixner * @irq: Interrupt to check 115771ee3b0SThomas Gleixner * 116771ee3b0SThomas Gleixner */ 117771ee3b0SThomas Gleixner int irq_can_set_affinity(unsigned int irq) 118771ee3b0SThomas Gleixner { 11908678b08SYinghai Lu struct irq_desc *desc = irq_to_desc(irq); 120771ee3b0SThomas Gleixner 121bce43032SThomas Gleixner if (!desc || !irqd_can_balance(&desc->irq_data) || 122bce43032SThomas Gleixner !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity) 123771ee3b0SThomas Gleixner return 0; 124771ee3b0SThomas Gleixner 125771ee3b0SThomas Gleixner return 1; 126771ee3b0SThomas Gleixner } 127771ee3b0SThomas Gleixner 128591d2fb0SThomas Gleixner /** 129591d2fb0SThomas Gleixner * irq_set_thread_affinity - Notify irq threads to adjust affinity 130591d2fb0SThomas Gleixner * @desc: irq descriptor which has affitnity changed 131591d2fb0SThomas Gleixner * 132591d2fb0SThomas Gleixner * We just set IRQTF_AFFINITY and delegate the affinity setting 133591d2fb0SThomas Gleixner * to the interrupt thread itself. We can not call 134591d2fb0SThomas Gleixner * set_cpus_allowed_ptr() here as we hold desc->lock and this 135591d2fb0SThomas Gleixner * code can be called from hard interrupt context. 136591d2fb0SThomas Gleixner */ 137591d2fb0SThomas Gleixner void irq_set_thread_affinity(struct irq_desc *desc) 1383aa551c9SThomas Gleixner { 1393aa551c9SThomas Gleixner struct irqaction *action = desc->action; 1403aa551c9SThomas Gleixner 1413aa551c9SThomas Gleixner while (action) { 1423aa551c9SThomas Gleixner if (action->thread) 143591d2fb0SThomas Gleixner set_bit(IRQTF_AFFINITY, &action->thread_flags); 1443aa551c9SThomas Gleixner action = action->next; 1453aa551c9SThomas Gleixner } 1463aa551c9SThomas Gleixner } 1473aa551c9SThomas Gleixner 1481fa46f1fSThomas Gleixner #ifdef CONFIG_GENERIC_PENDING_IRQ 1490ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) 1501fa46f1fSThomas Gleixner { 1510ef5ca1eSThomas Gleixner return irqd_can_move_in_process_context(data); 1521fa46f1fSThomas Gleixner } 1530ef5ca1eSThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) 1541fa46f1fSThomas Gleixner { 1550ef5ca1eSThomas Gleixner return irqd_is_setaffinity_pending(data); 1561fa46f1fSThomas Gleixner } 1571fa46f1fSThomas Gleixner static inline void 1581fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) 1591fa46f1fSThomas Gleixner { 1601fa46f1fSThomas Gleixner cpumask_copy(desc->pending_mask, mask); 1611fa46f1fSThomas Gleixner } 1621fa46f1fSThomas Gleixner static inline void 1631fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) 1641fa46f1fSThomas Gleixner { 1651fa46f1fSThomas Gleixner cpumask_copy(mask, desc->pending_mask); 1661fa46f1fSThomas Gleixner } 1671fa46f1fSThomas Gleixner #else 1680ef5ca1eSThomas Gleixner static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; } 169cd22c0e4SThomas Gleixner static inline bool irq_move_pending(struct irq_data *data) { return false; } 1701fa46f1fSThomas Gleixner static inline void 1711fa46f1fSThomas Gleixner irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { } 1721fa46f1fSThomas Gleixner static inline void 1731fa46f1fSThomas Gleixner irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { } 1741fa46f1fSThomas Gleixner #endif 1751fa46f1fSThomas Gleixner 176818b0f3bSJiang Liu int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask, 177818b0f3bSJiang Liu bool force) 178818b0f3bSJiang Liu { 179818b0f3bSJiang Liu struct irq_desc *desc = irq_data_to_desc(data); 180818b0f3bSJiang Liu struct irq_chip *chip = irq_data_get_irq_chip(data); 181818b0f3bSJiang Liu int ret; 182818b0f3bSJiang Liu 18301f8fa4fSThomas Gleixner ret = chip->irq_set_affinity(data, mask, force); 184818b0f3bSJiang Liu switch (ret) { 185818b0f3bSJiang Liu case IRQ_SET_MASK_OK: 1862cb62547SJiang Liu case IRQ_SET_MASK_OK_DONE: 187818b0f3bSJiang Liu cpumask_copy(data->affinity, mask); 188818b0f3bSJiang Liu case IRQ_SET_MASK_OK_NOCOPY: 189818b0f3bSJiang Liu irq_set_thread_affinity(desc); 190818b0f3bSJiang Liu ret = 0; 191818b0f3bSJiang Liu } 192818b0f3bSJiang Liu 193818b0f3bSJiang Liu return ret; 194818b0f3bSJiang Liu } 195818b0f3bSJiang Liu 19601f8fa4fSThomas Gleixner int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask, 19701f8fa4fSThomas Gleixner bool force) 198c2d0c555SDavid Daney { 199c2d0c555SDavid Daney struct irq_chip *chip = irq_data_get_irq_chip(data); 200c2d0c555SDavid Daney struct irq_desc *desc = irq_data_to_desc(data); 201c2d0c555SDavid Daney int ret = 0; 202c2d0c555SDavid Daney 203c2d0c555SDavid Daney if (!chip || !chip->irq_set_affinity) 204c2d0c555SDavid Daney return -EINVAL; 205c2d0c555SDavid Daney 2060ef5ca1eSThomas Gleixner if (irq_can_move_pcntxt(data)) { 20701f8fa4fSThomas Gleixner ret = irq_do_set_affinity(data, mask, force); 208c2d0c555SDavid Daney } else { 209c2d0c555SDavid Daney irqd_set_move_pending(data); 210c2d0c555SDavid Daney irq_copy_pending(desc, mask); 211c2d0c555SDavid Daney } 212c2d0c555SDavid Daney 213c2d0c555SDavid Daney if (desc->affinity_notify) { 214c2d0c555SDavid Daney kref_get(&desc->affinity_notify->kref); 215c2d0c555SDavid Daney schedule_work(&desc->affinity_notify->work); 216c2d0c555SDavid Daney } 217c2d0c555SDavid Daney irqd_set(data, IRQD_AFFINITY_SET); 218c2d0c555SDavid Daney 219c2d0c555SDavid Daney return ret; 220c2d0c555SDavid Daney } 221c2d0c555SDavid Daney 22201f8fa4fSThomas Gleixner int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force) 223771ee3b0SThomas Gleixner { 22408678b08SYinghai Lu struct irq_desc *desc = irq_to_desc(irq); 225f6d87f4bSThomas Gleixner unsigned long flags; 226c2d0c555SDavid Daney int ret; 227771ee3b0SThomas Gleixner 228c2d0c555SDavid Daney if (!desc) 229771ee3b0SThomas Gleixner return -EINVAL; 230771ee3b0SThomas Gleixner 231239007b8SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 23201f8fa4fSThomas Gleixner ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force); 233239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 2341fa46f1fSThomas Gleixner return ret; 235771ee3b0SThomas Gleixner } 236771ee3b0SThomas Gleixner 237e7a297b0SPeter P Waskiewicz Jr int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m) 238e7a297b0SPeter P Waskiewicz Jr { 239e7a297b0SPeter P Waskiewicz Jr unsigned long flags; 24031d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 241e7a297b0SPeter P Waskiewicz Jr 242e7a297b0SPeter P Waskiewicz Jr if (!desc) 243e7a297b0SPeter P Waskiewicz Jr return -EINVAL; 244e7a297b0SPeter P Waskiewicz Jr desc->affinity_hint = m; 24502725e74SThomas Gleixner irq_put_desc_unlock(desc, flags); 246e2e64a93SJesse Brandeburg /* set the initial affinity to prevent every interrupt being on CPU0 */ 247*4fe7ffb7SJesse Brandeburg if (m) 248e2e64a93SJesse Brandeburg __irq_set_affinity(irq, m, false); 249e7a297b0SPeter P Waskiewicz Jr return 0; 250e7a297b0SPeter P Waskiewicz Jr } 251e7a297b0SPeter P Waskiewicz Jr EXPORT_SYMBOL_GPL(irq_set_affinity_hint); 252e7a297b0SPeter P Waskiewicz Jr 253cd7eab44SBen Hutchings static void irq_affinity_notify(struct work_struct *work) 254cd7eab44SBen Hutchings { 255cd7eab44SBen Hutchings struct irq_affinity_notify *notify = 256cd7eab44SBen Hutchings container_of(work, struct irq_affinity_notify, work); 257cd7eab44SBen Hutchings struct irq_desc *desc = irq_to_desc(notify->irq); 258cd7eab44SBen Hutchings cpumask_var_t cpumask; 259cd7eab44SBen Hutchings unsigned long flags; 260cd7eab44SBen Hutchings 2611fa46f1fSThomas Gleixner if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL)) 262cd7eab44SBen Hutchings goto out; 263cd7eab44SBen Hutchings 264cd7eab44SBen Hutchings raw_spin_lock_irqsave(&desc->lock, flags); 2650ef5ca1eSThomas Gleixner if (irq_move_pending(&desc->irq_data)) 2661fa46f1fSThomas Gleixner irq_get_pending(cpumask, desc); 267cd7eab44SBen Hutchings else 2681fb0ef31SThomas Gleixner cpumask_copy(cpumask, desc->irq_data.affinity); 269cd7eab44SBen Hutchings raw_spin_unlock_irqrestore(&desc->lock, flags); 270cd7eab44SBen Hutchings 271cd7eab44SBen Hutchings notify->notify(notify, cpumask); 272cd7eab44SBen Hutchings 273cd7eab44SBen Hutchings free_cpumask_var(cpumask); 274cd7eab44SBen Hutchings out: 275cd7eab44SBen Hutchings kref_put(¬ify->kref, notify->release); 276cd7eab44SBen Hutchings } 277cd7eab44SBen Hutchings 278cd7eab44SBen Hutchings /** 279cd7eab44SBen Hutchings * irq_set_affinity_notifier - control notification of IRQ affinity changes 280cd7eab44SBen Hutchings * @irq: Interrupt for which to enable/disable notification 281cd7eab44SBen Hutchings * @notify: Context for notification, or %NULL to disable 282cd7eab44SBen Hutchings * notification. Function pointers must be initialised; 283cd7eab44SBen Hutchings * the other fields will be initialised by this function. 284cd7eab44SBen Hutchings * 285cd7eab44SBen Hutchings * Must be called in process context. Notification may only be enabled 286cd7eab44SBen Hutchings * after the IRQ is allocated and must be disabled before the IRQ is 287cd7eab44SBen Hutchings * freed using free_irq(). 288cd7eab44SBen Hutchings */ 289cd7eab44SBen Hutchings int 290cd7eab44SBen Hutchings irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify) 291cd7eab44SBen Hutchings { 292cd7eab44SBen Hutchings struct irq_desc *desc = irq_to_desc(irq); 293cd7eab44SBen Hutchings struct irq_affinity_notify *old_notify; 294cd7eab44SBen Hutchings unsigned long flags; 295cd7eab44SBen Hutchings 296cd7eab44SBen Hutchings /* The release function is promised process context */ 297cd7eab44SBen Hutchings might_sleep(); 298cd7eab44SBen Hutchings 299cd7eab44SBen Hutchings if (!desc) 300cd7eab44SBen Hutchings return -EINVAL; 301cd7eab44SBen Hutchings 302cd7eab44SBen Hutchings /* Complete initialisation of *notify */ 303cd7eab44SBen Hutchings if (notify) { 304cd7eab44SBen Hutchings notify->irq = irq; 305cd7eab44SBen Hutchings kref_init(¬ify->kref); 306cd7eab44SBen Hutchings INIT_WORK(¬ify->work, irq_affinity_notify); 307cd7eab44SBen Hutchings } 308cd7eab44SBen Hutchings 309cd7eab44SBen Hutchings raw_spin_lock_irqsave(&desc->lock, flags); 310cd7eab44SBen Hutchings old_notify = desc->affinity_notify; 311cd7eab44SBen Hutchings desc->affinity_notify = notify; 312cd7eab44SBen Hutchings raw_spin_unlock_irqrestore(&desc->lock, flags); 313cd7eab44SBen Hutchings 314cd7eab44SBen Hutchings if (old_notify) 315cd7eab44SBen Hutchings kref_put(&old_notify->kref, old_notify->release); 316cd7eab44SBen Hutchings 317cd7eab44SBen Hutchings return 0; 318cd7eab44SBen Hutchings } 319cd7eab44SBen Hutchings EXPORT_SYMBOL_GPL(irq_set_affinity_notifier); 320cd7eab44SBen Hutchings 32118404756SMax Krasnyansky #ifndef CONFIG_AUTO_IRQ_AFFINITY 32218404756SMax Krasnyansky /* 32318404756SMax Krasnyansky * Generic version of the affinity autoselector. 32418404756SMax Krasnyansky */ 3253b8249e7SThomas Gleixner static int 3263b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask) 32718404756SMax Krasnyansky { 328569bda8dSThomas Gleixner struct cpumask *set = irq_default_affinity; 329818b0f3bSJiang Liu int node = desc->irq_data.node; 330569bda8dSThomas Gleixner 331b008207cSThomas Gleixner /* Excludes PER_CPU and NO_BALANCE interrupts */ 33218404756SMax Krasnyansky if (!irq_can_set_affinity(irq)) 33318404756SMax Krasnyansky return 0; 33418404756SMax Krasnyansky 335f6d87f4bSThomas Gleixner /* 336f6d87f4bSThomas Gleixner * Preserve an userspace affinity setup, but make sure that 337f6d87f4bSThomas Gleixner * one of the targets is online. 338f6d87f4bSThomas Gleixner */ 3392bdd1055SThomas Gleixner if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) { 340569bda8dSThomas Gleixner if (cpumask_intersects(desc->irq_data.affinity, 341569bda8dSThomas Gleixner cpu_online_mask)) 342569bda8dSThomas Gleixner set = desc->irq_data.affinity; 3430c6f8a8bSThomas Gleixner else 3442bdd1055SThomas Gleixner irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET); 3452bdd1055SThomas Gleixner } 34618404756SMax Krasnyansky 3473b8249e7SThomas Gleixner cpumask_and(mask, cpu_online_mask, set); 348241fc640SPrarit Bhargava if (node != NUMA_NO_NODE) { 349241fc640SPrarit Bhargava const struct cpumask *nodemask = cpumask_of_node(node); 350241fc640SPrarit Bhargava 351241fc640SPrarit Bhargava /* make sure at least one of the cpus in nodemask is online */ 352241fc640SPrarit Bhargava if (cpumask_intersects(mask, nodemask)) 353241fc640SPrarit Bhargava cpumask_and(mask, mask, nodemask); 354241fc640SPrarit Bhargava } 355818b0f3bSJiang Liu irq_do_set_affinity(&desc->irq_data, mask, false); 35618404756SMax Krasnyansky return 0; 35718404756SMax Krasnyansky } 358f6d87f4bSThomas Gleixner #else 3593b8249e7SThomas Gleixner static inline int 3603b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *d, struct cpumask *mask) 361f6d87f4bSThomas Gleixner { 362f6d87f4bSThomas Gleixner return irq_select_affinity(irq); 363f6d87f4bSThomas Gleixner } 36418404756SMax Krasnyansky #endif 36518404756SMax Krasnyansky 366f6d87f4bSThomas Gleixner /* 367f6d87f4bSThomas Gleixner * Called when affinity is set via /proc/irq 368f6d87f4bSThomas Gleixner */ 3693b8249e7SThomas Gleixner int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask) 370f6d87f4bSThomas Gleixner { 371f6d87f4bSThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 372f6d87f4bSThomas Gleixner unsigned long flags; 373f6d87f4bSThomas Gleixner int ret; 374f6d87f4bSThomas Gleixner 375239007b8SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 3763b8249e7SThomas Gleixner ret = setup_affinity(irq, desc, mask); 377239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 378f6d87f4bSThomas Gleixner return ret; 379f6d87f4bSThomas Gleixner } 380f6d87f4bSThomas Gleixner 381f6d87f4bSThomas Gleixner #else 3823b8249e7SThomas Gleixner static inline int 3833b8249e7SThomas Gleixner setup_affinity(unsigned int irq, struct irq_desc *desc, struct cpumask *mask) 384f6d87f4bSThomas Gleixner { 385f6d87f4bSThomas Gleixner return 0; 386f6d87f4bSThomas Gleixner } 3871da177e4SLinus Torvalds #endif 3881da177e4SLinus Torvalds 3898df2e02cSThomas Gleixner void __disable_irq(struct irq_desc *desc, unsigned int irq) 3900a0c5168SRafael J. Wysocki { 3913aae994fSThomas Gleixner if (!desc->depth++) 39287923470SThomas Gleixner irq_disable(desc); 3930a0c5168SRafael J. Wysocki } 3940a0c5168SRafael J. Wysocki 39502725e74SThomas Gleixner static int __disable_irq_nosync(unsigned int irq) 39602725e74SThomas Gleixner { 39702725e74SThomas Gleixner unsigned long flags; 39831d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 39902725e74SThomas Gleixner 40002725e74SThomas Gleixner if (!desc) 40102725e74SThomas Gleixner return -EINVAL; 4028df2e02cSThomas Gleixner __disable_irq(desc, irq); 40302725e74SThomas Gleixner irq_put_desc_busunlock(desc, flags); 40402725e74SThomas Gleixner return 0; 40502725e74SThomas Gleixner } 40602725e74SThomas Gleixner 4071da177e4SLinus Torvalds /** 4081da177e4SLinus Torvalds * disable_irq_nosync - disable an irq without waiting 4091da177e4SLinus Torvalds * @irq: Interrupt to disable 4101da177e4SLinus Torvalds * 4111da177e4SLinus Torvalds * Disable the selected interrupt line. Disables and Enables are 4121da177e4SLinus Torvalds * nested. 4131da177e4SLinus Torvalds * Unlike disable_irq(), this function does not ensure existing 4141da177e4SLinus Torvalds * instances of the IRQ handler have completed before returning. 4151da177e4SLinus Torvalds * 4161da177e4SLinus Torvalds * This function may be called from IRQ context. 4171da177e4SLinus Torvalds */ 4181da177e4SLinus Torvalds void disable_irq_nosync(unsigned int irq) 4191da177e4SLinus Torvalds { 42002725e74SThomas Gleixner __disable_irq_nosync(irq); 4211da177e4SLinus Torvalds } 4221da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq_nosync); 4231da177e4SLinus Torvalds 4241da177e4SLinus Torvalds /** 4251da177e4SLinus Torvalds * disable_irq - disable an irq and wait for completion 4261da177e4SLinus Torvalds * @irq: Interrupt to disable 4271da177e4SLinus Torvalds * 4281da177e4SLinus Torvalds * Disable the selected interrupt line. Enables and Disables are 4291da177e4SLinus Torvalds * nested. 4301da177e4SLinus Torvalds * This function waits for any pending IRQ handlers for this interrupt 4311da177e4SLinus Torvalds * to complete before returning. If you use this function while 4321da177e4SLinus Torvalds * holding a resource the IRQ handler may need you will deadlock. 4331da177e4SLinus Torvalds * 4341da177e4SLinus Torvalds * This function may be called - with care - from IRQ context. 4351da177e4SLinus Torvalds */ 4361da177e4SLinus Torvalds void disable_irq(unsigned int irq) 4371da177e4SLinus Torvalds { 43802725e74SThomas Gleixner if (!__disable_irq_nosync(irq)) 4391da177e4SLinus Torvalds synchronize_irq(irq); 4401da177e4SLinus Torvalds } 4411da177e4SLinus Torvalds EXPORT_SYMBOL(disable_irq); 4421da177e4SLinus Torvalds 4438df2e02cSThomas Gleixner void __enable_irq(struct irq_desc *desc, unsigned int irq) 4441adb0850SThomas Gleixner { 4451adb0850SThomas Gleixner switch (desc->depth) { 4461adb0850SThomas Gleixner case 0: 4470a0c5168SRafael J. Wysocki err_out: 448b8c512f6SArjan van de Ven WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq); 4491adb0850SThomas Gleixner break; 4501adb0850SThomas Gleixner case 1: { 451c531e836SThomas Gleixner if (desc->istate & IRQS_SUSPENDED) 4520a0c5168SRafael J. Wysocki goto err_out; 4531adb0850SThomas Gleixner /* Prevent probing on this irq: */ 4541ccb4e61SThomas Gleixner irq_settings_set_noprobe(desc); 4553aae994fSThomas Gleixner irq_enable(desc); 4561adb0850SThomas Gleixner check_irq_resend(desc, irq); 4571adb0850SThomas Gleixner /* fall-through */ 4581adb0850SThomas Gleixner } 4591adb0850SThomas Gleixner default: 4601adb0850SThomas Gleixner desc->depth--; 4611adb0850SThomas Gleixner } 4621adb0850SThomas Gleixner } 4631adb0850SThomas Gleixner 4641da177e4SLinus Torvalds /** 4651da177e4SLinus Torvalds * enable_irq - enable handling of an irq 4661da177e4SLinus Torvalds * @irq: Interrupt to enable 4671da177e4SLinus Torvalds * 4681da177e4SLinus Torvalds * Undoes the effect of one call to disable_irq(). If this 4691da177e4SLinus Torvalds * matches the last disable, processing of interrupts on this 4701da177e4SLinus Torvalds * IRQ line is re-enabled. 4711da177e4SLinus Torvalds * 47270aedd24SThomas Gleixner * This function may be called from IRQ context only when 4736b8ff312SThomas Gleixner * desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL ! 4741da177e4SLinus Torvalds */ 4751da177e4SLinus Torvalds void enable_irq(unsigned int irq) 4761da177e4SLinus Torvalds { 4771da177e4SLinus Torvalds unsigned long flags; 47831d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 4791da177e4SLinus Torvalds 4807d94f7caSYinghai Lu if (!desc) 481c2b5a251SMatthew Wilcox return; 48250f7c032SThomas Gleixner if (WARN(!desc->irq_data.chip, 4832656c366SThomas Gleixner KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq)) 48402725e74SThomas Gleixner goto out; 4852656c366SThomas Gleixner 4868df2e02cSThomas Gleixner __enable_irq(desc, irq); 48702725e74SThomas Gleixner out: 48802725e74SThomas Gleixner irq_put_desc_busunlock(desc, flags); 4891da177e4SLinus Torvalds } 4901da177e4SLinus Torvalds EXPORT_SYMBOL(enable_irq); 4911da177e4SLinus Torvalds 4920c5d1eb7SDavid Brownell static int set_irq_wake_real(unsigned int irq, unsigned int on) 4932db87321SUwe Kleine-König { 49408678b08SYinghai Lu struct irq_desc *desc = irq_to_desc(irq); 4952db87321SUwe Kleine-König int ret = -ENXIO; 4962db87321SUwe Kleine-König 49760f96b41SSantosh Shilimkar if (irq_desc_get_chip(desc)->flags & IRQCHIP_SKIP_SET_WAKE) 49860f96b41SSantosh Shilimkar return 0; 49960f96b41SSantosh Shilimkar 5002f7e99bbSThomas Gleixner if (desc->irq_data.chip->irq_set_wake) 5012f7e99bbSThomas Gleixner ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on); 5022db87321SUwe Kleine-König 5032db87321SUwe Kleine-König return ret; 5042db87321SUwe Kleine-König } 5052db87321SUwe Kleine-König 506ba9a2331SThomas Gleixner /** 507a0cd9ca2SThomas Gleixner * irq_set_irq_wake - control irq power management wakeup 508ba9a2331SThomas Gleixner * @irq: interrupt to control 509ba9a2331SThomas Gleixner * @on: enable/disable power management wakeup 510ba9a2331SThomas Gleixner * 51115a647ebSDavid Brownell * Enable/disable power management wakeup mode, which is 51215a647ebSDavid Brownell * disabled by default. Enables and disables must match, 51315a647ebSDavid Brownell * just as they match for non-wakeup mode support. 51415a647ebSDavid Brownell * 51515a647ebSDavid Brownell * Wakeup mode lets this IRQ wake the system from sleep 51615a647ebSDavid Brownell * states like "suspend to RAM". 517ba9a2331SThomas Gleixner */ 518a0cd9ca2SThomas Gleixner int irq_set_irq_wake(unsigned int irq, unsigned int on) 519ba9a2331SThomas Gleixner { 520ba9a2331SThomas Gleixner unsigned long flags; 52131d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 5222db87321SUwe Kleine-König int ret = 0; 523ba9a2331SThomas Gleixner 52413863a66SJesper Juhl if (!desc) 52513863a66SJesper Juhl return -EINVAL; 52613863a66SJesper Juhl 52715a647ebSDavid Brownell /* wakeup-capable irqs can be shared between drivers that 52815a647ebSDavid Brownell * don't need to have the same sleep mode behaviors. 52915a647ebSDavid Brownell */ 53015a647ebSDavid Brownell if (on) { 5312db87321SUwe Kleine-König if (desc->wake_depth++ == 0) { 5322db87321SUwe Kleine-König ret = set_irq_wake_real(irq, on); 5332db87321SUwe Kleine-König if (ret) 5342db87321SUwe Kleine-König desc->wake_depth = 0; 53515a647ebSDavid Brownell else 5367f94226fSThomas Gleixner irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE); 5372db87321SUwe Kleine-König } 53815a647ebSDavid Brownell } else { 53915a647ebSDavid Brownell if (desc->wake_depth == 0) { 5407a2c4770SArjan van de Ven WARN(1, "Unbalanced IRQ %d wake disable\n", irq); 5412db87321SUwe Kleine-König } else if (--desc->wake_depth == 0) { 5422db87321SUwe Kleine-König ret = set_irq_wake_real(irq, on); 5432db87321SUwe Kleine-König if (ret) 5442db87321SUwe Kleine-König desc->wake_depth = 1; 54515a647ebSDavid Brownell else 5467f94226fSThomas Gleixner irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE); 54715a647ebSDavid Brownell } 5482db87321SUwe Kleine-König } 54902725e74SThomas Gleixner irq_put_desc_busunlock(desc, flags); 550ba9a2331SThomas Gleixner return ret; 551ba9a2331SThomas Gleixner } 552a0cd9ca2SThomas Gleixner EXPORT_SYMBOL(irq_set_irq_wake); 553ba9a2331SThomas Gleixner 5541da177e4SLinus Torvalds /* 5551da177e4SLinus Torvalds * Internal function that tells the architecture code whether a 5561da177e4SLinus Torvalds * particular irq has been exclusively allocated or is available 5571da177e4SLinus Torvalds * for driver use. 5581da177e4SLinus Torvalds */ 5591da177e4SLinus Torvalds int can_request_irq(unsigned int irq, unsigned long irqflags) 5601da177e4SLinus Torvalds { 561cc8c3b78SThomas Gleixner unsigned long flags; 56231d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0); 56302725e74SThomas Gleixner int canrequest = 0; 5641da177e4SLinus Torvalds 5657d94f7caSYinghai Lu if (!desc) 5667d94f7caSYinghai Lu return 0; 5677d94f7caSYinghai Lu 56802725e74SThomas Gleixner if (irq_settings_can_request(desc)) { 5692779db8dSBen Hutchings if (!desc->action || 5702779db8dSBen Hutchings irqflags & desc->action->flags & IRQF_SHARED) 57102725e74SThomas Gleixner canrequest = 1; 57202725e74SThomas Gleixner } 57302725e74SThomas Gleixner irq_put_desc_unlock(desc, flags); 57402725e74SThomas Gleixner return canrequest; 5751da177e4SLinus Torvalds } 5761da177e4SLinus Torvalds 5770c5d1eb7SDavid Brownell int __irq_set_trigger(struct irq_desc *desc, unsigned int irq, 57882736f4dSUwe Kleine-König unsigned long flags) 57982736f4dSUwe Kleine-König { 5806b8ff312SThomas Gleixner struct irq_chip *chip = desc->irq_data.chip; 581d4d5e089SThomas Gleixner int ret, unmask = 0; 58282736f4dSUwe Kleine-König 583b2ba2c30SThomas Gleixner if (!chip || !chip->irq_set_type) { 58482736f4dSUwe Kleine-König /* 58582736f4dSUwe Kleine-König * IRQF_TRIGGER_* but the PIC does not support multiple 58682736f4dSUwe Kleine-König * flow-types? 58782736f4dSUwe Kleine-König */ 58897fd75b7SAndrew Morton pr_debug("No set_type function for IRQ %d (%s)\n", irq, 58982736f4dSUwe Kleine-König chip ? (chip->name ? : "unknown") : "unknown"); 59082736f4dSUwe Kleine-König return 0; 59182736f4dSUwe Kleine-König } 59282736f4dSUwe Kleine-König 593876dbd4cSThomas Gleixner flags &= IRQ_TYPE_SENSE_MASK; 594d4d5e089SThomas Gleixner 595d4d5e089SThomas Gleixner if (chip->flags & IRQCHIP_SET_TYPE_MASKED) { 59632f4125eSThomas Gleixner if (!irqd_irq_masked(&desc->irq_data)) 597d4d5e089SThomas Gleixner mask_irq(desc); 59832f4125eSThomas Gleixner if (!irqd_irq_disabled(&desc->irq_data)) 599d4d5e089SThomas Gleixner unmask = 1; 600d4d5e089SThomas Gleixner } 601d4d5e089SThomas Gleixner 602f2b662daSDavid Brownell /* caller masked out all except trigger mode flags */ 603b2ba2c30SThomas Gleixner ret = chip->irq_set_type(&desc->irq_data, flags); 60482736f4dSUwe Kleine-König 605876dbd4cSThomas Gleixner switch (ret) { 606876dbd4cSThomas Gleixner case IRQ_SET_MASK_OK: 6072cb62547SJiang Liu case IRQ_SET_MASK_OK_DONE: 608876dbd4cSThomas Gleixner irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK); 609876dbd4cSThomas Gleixner irqd_set(&desc->irq_data, flags); 610876dbd4cSThomas Gleixner 611876dbd4cSThomas Gleixner case IRQ_SET_MASK_OK_NOCOPY: 612876dbd4cSThomas Gleixner flags = irqd_get_trigger_type(&desc->irq_data); 613876dbd4cSThomas Gleixner irq_settings_set_trigger_mask(desc, flags); 614876dbd4cSThomas Gleixner irqd_clear(&desc->irq_data, IRQD_LEVEL); 615876dbd4cSThomas Gleixner irq_settings_clr_level(desc); 616876dbd4cSThomas Gleixner if (flags & IRQ_TYPE_LEVEL_MASK) { 617876dbd4cSThomas Gleixner irq_settings_set_level(desc); 618876dbd4cSThomas Gleixner irqd_set(&desc->irq_data, IRQD_LEVEL); 619876dbd4cSThomas Gleixner } 62046732475SThomas Gleixner 621d4d5e089SThomas Gleixner ret = 0; 6228fff39e0SThomas Gleixner break; 623876dbd4cSThomas Gleixner default: 62497fd75b7SAndrew Morton pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n", 625876dbd4cSThomas Gleixner flags, irq, chip->irq_set_type); 6260c5d1eb7SDavid Brownell } 627d4d5e089SThomas Gleixner if (unmask) 628d4d5e089SThomas Gleixner unmask_irq(desc); 62982736f4dSUwe Kleine-König return ret; 63082736f4dSUwe Kleine-König } 63182736f4dSUwe Kleine-König 632293a7a0aSThomas Gleixner #ifdef CONFIG_HARDIRQS_SW_RESEND 633293a7a0aSThomas Gleixner int irq_set_parent(int irq, int parent_irq) 634293a7a0aSThomas Gleixner { 635293a7a0aSThomas Gleixner unsigned long flags; 636293a7a0aSThomas Gleixner struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0); 637293a7a0aSThomas Gleixner 638293a7a0aSThomas Gleixner if (!desc) 639293a7a0aSThomas Gleixner return -EINVAL; 640293a7a0aSThomas Gleixner 641293a7a0aSThomas Gleixner desc->parent_irq = parent_irq; 642293a7a0aSThomas Gleixner 643293a7a0aSThomas Gleixner irq_put_desc_unlock(desc, flags); 644293a7a0aSThomas Gleixner return 0; 645293a7a0aSThomas Gleixner } 646293a7a0aSThomas Gleixner #endif 647293a7a0aSThomas Gleixner 648b25c340cSThomas Gleixner /* 649b25c340cSThomas Gleixner * Default primary interrupt handler for threaded interrupts. Is 650b25c340cSThomas Gleixner * assigned as primary handler when request_threaded_irq is called 651b25c340cSThomas Gleixner * with handler == NULL. Useful for oneshot interrupts. 652b25c340cSThomas Gleixner */ 653b25c340cSThomas Gleixner static irqreturn_t irq_default_primary_handler(int irq, void *dev_id) 654b25c340cSThomas Gleixner { 655b25c340cSThomas Gleixner return IRQ_WAKE_THREAD; 656b25c340cSThomas Gleixner } 657b25c340cSThomas Gleixner 658399b5da2SThomas Gleixner /* 659399b5da2SThomas Gleixner * Primary handler for nested threaded interrupts. Should never be 660399b5da2SThomas Gleixner * called. 661399b5da2SThomas Gleixner */ 662399b5da2SThomas Gleixner static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id) 663399b5da2SThomas Gleixner { 664399b5da2SThomas Gleixner WARN(1, "Primary handler called for nested irq %d\n", irq); 665399b5da2SThomas Gleixner return IRQ_NONE; 666399b5da2SThomas Gleixner } 667399b5da2SThomas Gleixner 6683aa551c9SThomas Gleixner static int irq_wait_for_interrupt(struct irqaction *action) 6693aa551c9SThomas Gleixner { 6703aa551c9SThomas Gleixner set_current_state(TASK_INTERRUPTIBLE); 671f48fe81eSThomas Gleixner 672550acb19SIdo Yariv while (!kthread_should_stop()) { 673550acb19SIdo Yariv 674f48fe81eSThomas Gleixner if (test_and_clear_bit(IRQTF_RUNTHREAD, 675f48fe81eSThomas Gleixner &action->thread_flags)) { 6763aa551c9SThomas Gleixner __set_current_state(TASK_RUNNING); 6773aa551c9SThomas Gleixner return 0; 678f48fe81eSThomas Gleixner } 6793aa551c9SThomas Gleixner schedule(); 680550acb19SIdo Yariv set_current_state(TASK_INTERRUPTIBLE); 6813aa551c9SThomas Gleixner } 682550acb19SIdo Yariv __set_current_state(TASK_RUNNING); 6833aa551c9SThomas Gleixner return -1; 6843aa551c9SThomas Gleixner } 6853aa551c9SThomas Gleixner 686b25c340cSThomas Gleixner /* 687b25c340cSThomas Gleixner * Oneshot interrupts keep the irq line masked until the threaded 688b25c340cSThomas Gleixner * handler finished. unmask if the interrupt has not been disabled and 689b25c340cSThomas Gleixner * is marked MASKED. 690b25c340cSThomas Gleixner */ 691b5faba21SThomas Gleixner static void irq_finalize_oneshot(struct irq_desc *desc, 692f3f79e38SAlexander Gordeev struct irqaction *action) 693b25c340cSThomas Gleixner { 694b5faba21SThomas Gleixner if (!(desc->istate & IRQS_ONESHOT)) 695b5faba21SThomas Gleixner return; 6960b1adaa0SThomas Gleixner again: 6973876ec9eSThomas Gleixner chip_bus_lock(desc); 698239007b8SThomas Gleixner raw_spin_lock_irq(&desc->lock); 6990b1adaa0SThomas Gleixner 7000b1adaa0SThomas Gleixner /* 7010b1adaa0SThomas Gleixner * Implausible though it may be we need to protect us against 7020b1adaa0SThomas Gleixner * the following scenario: 7030b1adaa0SThomas Gleixner * 7040b1adaa0SThomas Gleixner * The thread is faster done than the hard interrupt handler 7050b1adaa0SThomas Gleixner * on the other CPU. If we unmask the irq line then the 7060b1adaa0SThomas Gleixner * interrupt can come in again and masks the line, leaves due 707009b4c3bSThomas Gleixner * to IRQS_INPROGRESS and the irq line is masked forever. 708b5faba21SThomas Gleixner * 709b5faba21SThomas Gleixner * This also serializes the state of shared oneshot handlers 710b5faba21SThomas Gleixner * versus "desc->threads_onehsot |= action->thread_mask;" in 711b5faba21SThomas Gleixner * irq_wake_thread(). See the comment there which explains the 712b5faba21SThomas Gleixner * serialization. 7130b1adaa0SThomas Gleixner */ 71432f4125eSThomas Gleixner if (unlikely(irqd_irq_inprogress(&desc->irq_data))) { 7150b1adaa0SThomas Gleixner raw_spin_unlock_irq(&desc->lock); 7163876ec9eSThomas Gleixner chip_bus_sync_unlock(desc); 7170b1adaa0SThomas Gleixner cpu_relax(); 7180b1adaa0SThomas Gleixner goto again; 7190b1adaa0SThomas Gleixner } 7200b1adaa0SThomas Gleixner 721b5faba21SThomas Gleixner /* 722b5faba21SThomas Gleixner * Now check again, whether the thread should run. Otherwise 723b5faba21SThomas Gleixner * we would clear the threads_oneshot bit of this thread which 724b5faba21SThomas Gleixner * was just set. 725b5faba21SThomas Gleixner */ 726f3f79e38SAlexander Gordeev if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags)) 727b5faba21SThomas Gleixner goto out_unlock; 728b5faba21SThomas Gleixner 729b5faba21SThomas Gleixner desc->threads_oneshot &= ~action->thread_mask; 730b5faba21SThomas Gleixner 73132f4125eSThomas Gleixner if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) && 73232f4125eSThomas Gleixner irqd_irq_masked(&desc->irq_data)) 733328a4978SThomas Gleixner unmask_threaded_irq(desc); 73432f4125eSThomas Gleixner 735b5faba21SThomas Gleixner out_unlock: 736239007b8SThomas Gleixner raw_spin_unlock_irq(&desc->lock); 7373876ec9eSThomas Gleixner chip_bus_sync_unlock(desc); 738b25c340cSThomas Gleixner } 739b25c340cSThomas Gleixner 74061f38261SBruno Premont #ifdef CONFIG_SMP 7413aa551c9SThomas Gleixner /* 742b04c644eSChuansheng Liu * Check whether we need to change the affinity of the interrupt thread. 743591d2fb0SThomas Gleixner */ 744591d2fb0SThomas Gleixner static void 745591d2fb0SThomas Gleixner irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) 746591d2fb0SThomas Gleixner { 747591d2fb0SThomas Gleixner cpumask_var_t mask; 74804aa530eSThomas Gleixner bool valid = true; 749591d2fb0SThomas Gleixner 750591d2fb0SThomas Gleixner if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags)) 751591d2fb0SThomas Gleixner return; 752591d2fb0SThomas Gleixner 753591d2fb0SThomas Gleixner /* 754591d2fb0SThomas Gleixner * In case we are out of memory we set IRQTF_AFFINITY again and 755591d2fb0SThomas Gleixner * try again next time 756591d2fb0SThomas Gleixner */ 757591d2fb0SThomas Gleixner if (!alloc_cpumask_var(&mask, GFP_KERNEL)) { 758591d2fb0SThomas Gleixner set_bit(IRQTF_AFFINITY, &action->thread_flags); 759591d2fb0SThomas Gleixner return; 760591d2fb0SThomas Gleixner } 761591d2fb0SThomas Gleixner 762239007b8SThomas Gleixner raw_spin_lock_irq(&desc->lock); 76304aa530eSThomas Gleixner /* 76404aa530eSThomas Gleixner * This code is triggered unconditionally. Check the affinity 76504aa530eSThomas Gleixner * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out. 76604aa530eSThomas Gleixner */ 76704aa530eSThomas Gleixner if (desc->irq_data.affinity) 7686b8ff312SThomas Gleixner cpumask_copy(mask, desc->irq_data.affinity); 76904aa530eSThomas Gleixner else 77004aa530eSThomas Gleixner valid = false; 771239007b8SThomas Gleixner raw_spin_unlock_irq(&desc->lock); 772591d2fb0SThomas Gleixner 77304aa530eSThomas Gleixner if (valid) 774591d2fb0SThomas Gleixner set_cpus_allowed_ptr(current, mask); 775591d2fb0SThomas Gleixner free_cpumask_var(mask); 776591d2fb0SThomas Gleixner } 77761f38261SBruno Premont #else 77861f38261SBruno Premont static inline void 77961f38261SBruno Premont irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { } 78061f38261SBruno Premont #endif 781591d2fb0SThomas Gleixner 782591d2fb0SThomas Gleixner /* 7838d32a307SThomas Gleixner * Interrupts which are not explicitely requested as threaded 7848d32a307SThomas Gleixner * interrupts rely on the implicit bh/preempt disable of the hard irq 7858d32a307SThomas Gleixner * context. So we need to disable bh here to avoid deadlocks and other 7868d32a307SThomas Gleixner * side effects. 7878d32a307SThomas Gleixner */ 7883a43e05fSSebastian Andrzej Siewior static irqreturn_t 7898d32a307SThomas Gleixner irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action) 7908d32a307SThomas Gleixner { 7913a43e05fSSebastian Andrzej Siewior irqreturn_t ret; 7923a43e05fSSebastian Andrzej Siewior 7938d32a307SThomas Gleixner local_bh_disable(); 7943a43e05fSSebastian Andrzej Siewior ret = action->thread_fn(action->irq, action->dev_id); 795f3f79e38SAlexander Gordeev irq_finalize_oneshot(desc, action); 7968d32a307SThomas Gleixner local_bh_enable(); 7973a43e05fSSebastian Andrzej Siewior return ret; 7988d32a307SThomas Gleixner } 7998d32a307SThomas Gleixner 8008d32a307SThomas Gleixner /* 801f788e7bfSXie XiuQi * Interrupts explicitly requested as threaded interrupts want to be 8028d32a307SThomas Gleixner * preemtible - many of them need to sleep and wait for slow busses to 8038d32a307SThomas Gleixner * complete. 8048d32a307SThomas Gleixner */ 8053a43e05fSSebastian Andrzej Siewior static irqreturn_t irq_thread_fn(struct irq_desc *desc, 8063a43e05fSSebastian Andrzej Siewior struct irqaction *action) 8078d32a307SThomas Gleixner { 8083a43e05fSSebastian Andrzej Siewior irqreturn_t ret; 8093a43e05fSSebastian Andrzej Siewior 8103a43e05fSSebastian Andrzej Siewior ret = action->thread_fn(action->irq, action->dev_id); 811f3f79e38SAlexander Gordeev irq_finalize_oneshot(desc, action); 8123a43e05fSSebastian Andrzej Siewior return ret; 8138d32a307SThomas Gleixner } 8148d32a307SThomas Gleixner 8157140ea19SIdo Yariv static void wake_threads_waitq(struct irq_desc *desc) 8167140ea19SIdo Yariv { 817c685689fSChuansheng Liu if (atomic_dec_and_test(&desc->threads_active)) 8187140ea19SIdo Yariv wake_up(&desc->wait_for_threads); 8197140ea19SIdo Yariv } 8207140ea19SIdo Yariv 82167d12145SAl Viro static void irq_thread_dtor(struct callback_head *unused) 8224d1d61a6SOleg Nesterov { 8234d1d61a6SOleg Nesterov struct task_struct *tsk = current; 8244d1d61a6SOleg Nesterov struct irq_desc *desc; 8254d1d61a6SOleg Nesterov struct irqaction *action; 8264d1d61a6SOleg Nesterov 8274d1d61a6SOleg Nesterov if (WARN_ON_ONCE(!(current->flags & PF_EXITING))) 8284d1d61a6SOleg Nesterov return; 8294d1d61a6SOleg Nesterov 8304d1d61a6SOleg Nesterov action = kthread_data(tsk); 8314d1d61a6SOleg Nesterov 832fb21affaSLinus Torvalds pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n", 83319af395dSAlan Cox tsk->comm, tsk->pid, action->irq); 8344d1d61a6SOleg Nesterov 8354d1d61a6SOleg Nesterov 8364d1d61a6SOleg Nesterov desc = irq_to_desc(action->irq); 8374d1d61a6SOleg Nesterov /* 8384d1d61a6SOleg Nesterov * If IRQTF_RUNTHREAD is set, we need to decrement 8394d1d61a6SOleg Nesterov * desc->threads_active and wake possible waiters. 8404d1d61a6SOleg Nesterov */ 8414d1d61a6SOleg Nesterov if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags)) 8424d1d61a6SOleg Nesterov wake_threads_waitq(desc); 8434d1d61a6SOleg Nesterov 8444d1d61a6SOleg Nesterov /* Prevent a stale desc->threads_oneshot */ 8454d1d61a6SOleg Nesterov irq_finalize_oneshot(desc, action); 8464d1d61a6SOleg Nesterov } 8474d1d61a6SOleg Nesterov 8488d32a307SThomas Gleixner /* 8493aa551c9SThomas Gleixner * Interrupt handler thread 8503aa551c9SThomas Gleixner */ 8513aa551c9SThomas Gleixner static int irq_thread(void *data) 8523aa551c9SThomas Gleixner { 85367d12145SAl Viro struct callback_head on_exit_work; 8543aa551c9SThomas Gleixner struct irqaction *action = data; 8553aa551c9SThomas Gleixner struct irq_desc *desc = irq_to_desc(action->irq); 8563a43e05fSSebastian Andrzej Siewior irqreturn_t (*handler_fn)(struct irq_desc *desc, 8573a43e05fSSebastian Andrzej Siewior struct irqaction *action); 8583aa551c9SThomas Gleixner 859540b60e2SAlexander Gordeev if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD, 8608d32a307SThomas Gleixner &action->thread_flags)) 8618d32a307SThomas Gleixner handler_fn = irq_forced_thread_fn; 8628d32a307SThomas Gleixner else 8638d32a307SThomas Gleixner handler_fn = irq_thread_fn; 8648d32a307SThomas Gleixner 86541f9d29fSAl Viro init_task_work(&on_exit_work, irq_thread_dtor); 8664d1d61a6SOleg Nesterov task_work_add(current, &on_exit_work, false); 8673aa551c9SThomas Gleixner 868f3de44edSSankara Muthukrishnan irq_thread_check_affinity(desc, action); 869f3de44edSSankara Muthukrishnan 8703aa551c9SThomas Gleixner while (!irq_wait_for_interrupt(action)) { 8717140ea19SIdo Yariv irqreturn_t action_ret; 8723aa551c9SThomas Gleixner 873591d2fb0SThomas Gleixner irq_thread_check_affinity(desc, action); 874591d2fb0SThomas Gleixner 8753a43e05fSSebastian Andrzej Siewior action_ret = handler_fn(desc, action); 8761e77d0a1SThomas Gleixner if (action_ret == IRQ_HANDLED) 8771e77d0a1SThomas Gleixner atomic_inc(&desc->threads_handled); 8787140ea19SIdo Yariv 8797140ea19SIdo Yariv wake_threads_waitq(desc); 8803aa551c9SThomas Gleixner } 8813aa551c9SThomas Gleixner 8827140ea19SIdo Yariv /* 8837140ea19SIdo Yariv * This is the regular exit path. __free_irq() is stopping the 8847140ea19SIdo Yariv * thread via kthread_stop() after calling 8857140ea19SIdo Yariv * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the 886e04268b0SThomas Gleixner * oneshot mask bit can be set. We cannot verify that as we 887e04268b0SThomas Gleixner * cannot touch the oneshot mask at this point anymore as 888e04268b0SThomas Gleixner * __setup_irq() might have given out currents thread_mask 889e04268b0SThomas Gleixner * again. 8903aa551c9SThomas Gleixner */ 8914d1d61a6SOleg Nesterov task_work_cancel(current, irq_thread_dtor); 8923aa551c9SThomas Gleixner return 0; 8933aa551c9SThomas Gleixner } 8943aa551c9SThomas Gleixner 895a92444c6SThomas Gleixner /** 896a92444c6SThomas Gleixner * irq_wake_thread - wake the irq thread for the action identified by dev_id 897a92444c6SThomas Gleixner * @irq: Interrupt line 898a92444c6SThomas Gleixner * @dev_id: Device identity for which the thread should be woken 899a92444c6SThomas Gleixner * 900a92444c6SThomas Gleixner */ 901a92444c6SThomas Gleixner void irq_wake_thread(unsigned int irq, void *dev_id) 902a92444c6SThomas Gleixner { 903a92444c6SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 904a92444c6SThomas Gleixner struct irqaction *action; 905a92444c6SThomas Gleixner unsigned long flags; 906a92444c6SThomas Gleixner 907a92444c6SThomas Gleixner if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc))) 908a92444c6SThomas Gleixner return; 909a92444c6SThomas Gleixner 910a92444c6SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 911a92444c6SThomas Gleixner for (action = desc->action; action; action = action->next) { 912a92444c6SThomas Gleixner if (action->dev_id == dev_id) { 913a92444c6SThomas Gleixner if (action->thread) 914a92444c6SThomas Gleixner __irq_wake_thread(desc, action); 915a92444c6SThomas Gleixner break; 916a92444c6SThomas Gleixner } 917a92444c6SThomas Gleixner } 918a92444c6SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 919a92444c6SThomas Gleixner } 920a92444c6SThomas Gleixner EXPORT_SYMBOL_GPL(irq_wake_thread); 921a92444c6SThomas Gleixner 9228d32a307SThomas Gleixner static void irq_setup_forced_threading(struct irqaction *new) 9238d32a307SThomas Gleixner { 9248d32a307SThomas Gleixner if (!force_irqthreads) 9258d32a307SThomas Gleixner return; 9268d32a307SThomas Gleixner if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT)) 9278d32a307SThomas Gleixner return; 9288d32a307SThomas Gleixner 9298d32a307SThomas Gleixner new->flags |= IRQF_ONESHOT; 9308d32a307SThomas Gleixner 9318d32a307SThomas Gleixner if (!new->thread_fn) { 9328d32a307SThomas Gleixner set_bit(IRQTF_FORCED_THREAD, &new->thread_flags); 9338d32a307SThomas Gleixner new->thread_fn = new->handler; 9348d32a307SThomas Gleixner new->handler = irq_default_primary_handler; 9358d32a307SThomas Gleixner } 9368d32a307SThomas Gleixner } 9378d32a307SThomas Gleixner 938c1bacbaeSThomas Gleixner static int irq_request_resources(struct irq_desc *desc) 939c1bacbaeSThomas Gleixner { 940c1bacbaeSThomas Gleixner struct irq_data *d = &desc->irq_data; 941c1bacbaeSThomas Gleixner struct irq_chip *c = d->chip; 942c1bacbaeSThomas Gleixner 943c1bacbaeSThomas Gleixner return c->irq_request_resources ? c->irq_request_resources(d) : 0; 944c1bacbaeSThomas Gleixner } 945c1bacbaeSThomas Gleixner 946c1bacbaeSThomas Gleixner static void irq_release_resources(struct irq_desc *desc) 947c1bacbaeSThomas Gleixner { 948c1bacbaeSThomas Gleixner struct irq_data *d = &desc->irq_data; 949c1bacbaeSThomas Gleixner struct irq_chip *c = d->chip; 950c1bacbaeSThomas Gleixner 951c1bacbaeSThomas Gleixner if (c->irq_release_resources) 952c1bacbaeSThomas Gleixner c->irq_release_resources(d); 953c1bacbaeSThomas Gleixner } 954c1bacbaeSThomas Gleixner 9551da177e4SLinus Torvalds /* 9561da177e4SLinus Torvalds * Internal function to register an irqaction - typically used to 9571da177e4SLinus Torvalds * allocate special interrupts that are part of the architecture. 9581da177e4SLinus Torvalds */ 959d3c60047SThomas Gleixner static int 960d3c60047SThomas Gleixner __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new) 9611da177e4SLinus Torvalds { 962f17c7545SIngo Molnar struct irqaction *old, **old_ptr; 963b5faba21SThomas Gleixner unsigned long flags, thread_mask = 0; 9643b8249e7SThomas Gleixner int ret, nested, shared = 0; 9653b8249e7SThomas Gleixner cpumask_var_t mask; 9661da177e4SLinus Torvalds 9677d94f7caSYinghai Lu if (!desc) 968c2b5a251SMatthew Wilcox return -EINVAL; 969c2b5a251SMatthew Wilcox 9706b8ff312SThomas Gleixner if (desc->irq_data.chip == &no_irq_chip) 9711da177e4SLinus Torvalds return -ENOSYS; 972b6873807SSebastian Andrzej Siewior if (!try_module_get(desc->owner)) 973b6873807SSebastian Andrzej Siewior return -ENODEV; 9741da177e4SLinus Torvalds 9751da177e4SLinus Torvalds /* 976399b5da2SThomas Gleixner * Check whether the interrupt nests into another interrupt 977399b5da2SThomas Gleixner * thread. 9783aa551c9SThomas Gleixner */ 9791ccb4e61SThomas Gleixner nested = irq_settings_is_nested_thread(desc); 980399b5da2SThomas Gleixner if (nested) { 981b6873807SSebastian Andrzej Siewior if (!new->thread_fn) { 982b6873807SSebastian Andrzej Siewior ret = -EINVAL; 983b6873807SSebastian Andrzej Siewior goto out_mput; 984b6873807SSebastian Andrzej Siewior } 985399b5da2SThomas Gleixner /* 986399b5da2SThomas Gleixner * Replace the primary handler which was provided from 987399b5da2SThomas Gleixner * the driver for non nested interrupt handling by the 988399b5da2SThomas Gleixner * dummy function which warns when called. 989399b5da2SThomas Gleixner */ 990399b5da2SThomas Gleixner new->handler = irq_nested_primary_handler; 9918d32a307SThomas Gleixner } else { 9927f1b1244SPaul Mundt if (irq_settings_can_thread(desc)) 9938d32a307SThomas Gleixner irq_setup_forced_threading(new); 994399b5da2SThomas Gleixner } 995399b5da2SThomas Gleixner 996399b5da2SThomas Gleixner /* 997399b5da2SThomas Gleixner * Create a handler thread when a thread function is supplied 998399b5da2SThomas Gleixner * and the interrupt does not nest into another interrupt 999399b5da2SThomas Gleixner * thread. 1000399b5da2SThomas Gleixner */ 1001399b5da2SThomas Gleixner if (new->thread_fn && !nested) { 10023aa551c9SThomas Gleixner struct task_struct *t; 1003ee238713SIvo Sieben static const struct sched_param param = { 1004ee238713SIvo Sieben .sched_priority = MAX_USER_RT_PRIO/2, 1005ee238713SIvo Sieben }; 10063aa551c9SThomas Gleixner 10073aa551c9SThomas Gleixner t = kthread_create(irq_thread, new, "irq/%d-%s", irq, 10083aa551c9SThomas Gleixner new->name); 1009b6873807SSebastian Andrzej Siewior if (IS_ERR(t)) { 1010b6873807SSebastian Andrzej Siewior ret = PTR_ERR(t); 1011b6873807SSebastian Andrzej Siewior goto out_mput; 1012b6873807SSebastian Andrzej Siewior } 1013ee238713SIvo Sieben 1014bbfe65c2SThomas Pfaff sched_setscheduler_nocheck(t, SCHED_FIFO, ¶m); 1015ee238713SIvo Sieben 10163aa551c9SThomas Gleixner /* 10173aa551c9SThomas Gleixner * We keep the reference to the task struct even if 10183aa551c9SThomas Gleixner * the thread dies to avoid that the interrupt code 10193aa551c9SThomas Gleixner * references an already freed task_struct. 10203aa551c9SThomas Gleixner */ 10213aa551c9SThomas Gleixner get_task_struct(t); 10223aa551c9SThomas Gleixner new->thread = t; 102304aa530eSThomas Gleixner /* 102404aa530eSThomas Gleixner * Tell the thread to set its affinity. This is 102504aa530eSThomas Gleixner * important for shared interrupt handlers as we do 102604aa530eSThomas Gleixner * not invoke setup_affinity() for the secondary 102704aa530eSThomas Gleixner * handlers as everything is already set up. Even for 102804aa530eSThomas Gleixner * interrupts marked with IRQF_NO_BALANCE this is 102904aa530eSThomas Gleixner * correct as we want the thread to move to the cpu(s) 103004aa530eSThomas Gleixner * on which the requesting code placed the interrupt. 103104aa530eSThomas Gleixner */ 103204aa530eSThomas Gleixner set_bit(IRQTF_AFFINITY, &new->thread_flags); 10333aa551c9SThomas Gleixner } 10343aa551c9SThomas Gleixner 10353b8249e7SThomas Gleixner if (!alloc_cpumask_var(&mask, GFP_KERNEL)) { 10363b8249e7SThomas Gleixner ret = -ENOMEM; 10373b8249e7SThomas Gleixner goto out_thread; 10383b8249e7SThomas Gleixner } 10393b8249e7SThomas Gleixner 10403aa551c9SThomas Gleixner /* 1041dc9b229aSThomas Gleixner * Drivers are often written to work w/o knowledge about the 1042dc9b229aSThomas Gleixner * underlying irq chip implementation, so a request for a 1043dc9b229aSThomas Gleixner * threaded irq without a primary hard irq context handler 1044dc9b229aSThomas Gleixner * requires the ONESHOT flag to be set. Some irq chips like 1045dc9b229aSThomas Gleixner * MSI based interrupts are per se one shot safe. Check the 1046dc9b229aSThomas Gleixner * chip flags, so we can avoid the unmask dance at the end of 1047dc9b229aSThomas Gleixner * the threaded handler for those. 1048dc9b229aSThomas Gleixner */ 1049dc9b229aSThomas Gleixner if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE) 1050dc9b229aSThomas Gleixner new->flags &= ~IRQF_ONESHOT; 1051dc9b229aSThomas Gleixner 1052dc9b229aSThomas Gleixner /* 10531da177e4SLinus Torvalds * The following block of code has to be executed atomically 10541da177e4SLinus Torvalds */ 1055239007b8SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 1056f17c7545SIngo Molnar old_ptr = &desc->action; 1057f17c7545SIngo Molnar old = *old_ptr; 105806fcb0c6SIngo Molnar if (old) { 1059e76de9f8SThomas Gleixner /* 1060e76de9f8SThomas Gleixner * Can't share interrupts unless both agree to and are 1061e76de9f8SThomas Gleixner * the same type (level, edge, polarity). So both flag 10623cca53b0SThomas Gleixner * fields must have IRQF_SHARED set and the bits which 10639d591eddSThomas Gleixner * set the trigger type must match. Also all must 10649d591eddSThomas Gleixner * agree on ONESHOT. 1065e76de9f8SThomas Gleixner */ 10663cca53b0SThomas Gleixner if (!((old->flags & new->flags) & IRQF_SHARED) || 10679d591eddSThomas Gleixner ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) || 1068f5d89470SThomas Gleixner ((old->flags ^ new->flags) & IRQF_ONESHOT)) 1069f5163427SDimitri Sivanich goto mismatch; 1070f5163427SDimitri Sivanich 1071f5163427SDimitri Sivanich /* All handlers must agree on per-cpuness */ 10723cca53b0SThomas Gleixner if ((old->flags & IRQF_PERCPU) != 10733cca53b0SThomas Gleixner (new->flags & IRQF_PERCPU)) 1074f5163427SDimitri Sivanich goto mismatch; 10751da177e4SLinus Torvalds 10761da177e4SLinus Torvalds /* add new interrupt at end of irq queue */ 10771da177e4SLinus Torvalds do { 107852abb700SThomas Gleixner /* 107952abb700SThomas Gleixner * Or all existing action->thread_mask bits, 108052abb700SThomas Gleixner * so we can find the next zero bit for this 108152abb700SThomas Gleixner * new action. 108252abb700SThomas Gleixner */ 1083b5faba21SThomas Gleixner thread_mask |= old->thread_mask; 1084f17c7545SIngo Molnar old_ptr = &old->next; 1085f17c7545SIngo Molnar old = *old_ptr; 10861da177e4SLinus Torvalds } while (old); 10871da177e4SLinus Torvalds shared = 1; 10881da177e4SLinus Torvalds } 10891da177e4SLinus Torvalds 1090b5faba21SThomas Gleixner /* 109152abb700SThomas Gleixner * Setup the thread mask for this irqaction for ONESHOT. For 109252abb700SThomas Gleixner * !ONESHOT irqs the thread mask is 0 so we can avoid a 109352abb700SThomas Gleixner * conditional in irq_wake_thread(). 1094b5faba21SThomas Gleixner */ 109552abb700SThomas Gleixner if (new->flags & IRQF_ONESHOT) { 109652abb700SThomas Gleixner /* 109752abb700SThomas Gleixner * Unlikely to have 32 resp 64 irqs sharing one line, 109852abb700SThomas Gleixner * but who knows. 109952abb700SThomas Gleixner */ 110052abb700SThomas Gleixner if (thread_mask == ~0UL) { 1101b5faba21SThomas Gleixner ret = -EBUSY; 1102b5faba21SThomas Gleixner goto out_mask; 1103b5faba21SThomas Gleixner } 110452abb700SThomas Gleixner /* 110552abb700SThomas Gleixner * The thread_mask for the action is or'ed to 110652abb700SThomas Gleixner * desc->thread_active to indicate that the 110752abb700SThomas Gleixner * IRQF_ONESHOT thread handler has been woken, but not 110852abb700SThomas Gleixner * yet finished. The bit is cleared when a thread 110952abb700SThomas Gleixner * completes. When all threads of a shared interrupt 111052abb700SThomas Gleixner * line have completed desc->threads_active becomes 111152abb700SThomas Gleixner * zero and the interrupt line is unmasked. See 111252abb700SThomas Gleixner * handle.c:irq_wake_thread() for further information. 111352abb700SThomas Gleixner * 111452abb700SThomas Gleixner * If no thread is woken by primary (hard irq context) 111552abb700SThomas Gleixner * interrupt handlers, then desc->threads_active is 111652abb700SThomas Gleixner * also checked for zero to unmask the irq line in the 111752abb700SThomas Gleixner * affected hard irq flow handlers 111852abb700SThomas Gleixner * (handle_[fasteoi|level]_irq). 111952abb700SThomas Gleixner * 112052abb700SThomas Gleixner * The new action gets the first zero bit of 112152abb700SThomas Gleixner * thread_mask assigned. See the loop above which or's 112252abb700SThomas Gleixner * all existing action->thread_mask bits. 112352abb700SThomas Gleixner */ 1124b5faba21SThomas Gleixner new->thread_mask = 1 << ffz(thread_mask); 11251c6c6952SThomas Gleixner 1126dc9b229aSThomas Gleixner } else if (new->handler == irq_default_primary_handler && 1127dc9b229aSThomas Gleixner !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) { 11281c6c6952SThomas Gleixner /* 11291c6c6952SThomas Gleixner * The interrupt was requested with handler = NULL, so 11301c6c6952SThomas Gleixner * we use the default primary handler for it. But it 11311c6c6952SThomas Gleixner * does not have the oneshot flag set. In combination 11321c6c6952SThomas Gleixner * with level interrupts this is deadly, because the 11331c6c6952SThomas Gleixner * default primary handler just wakes the thread, then 11341c6c6952SThomas Gleixner * the irq lines is reenabled, but the device still 11351c6c6952SThomas Gleixner * has the level irq asserted. Rinse and repeat.... 11361c6c6952SThomas Gleixner * 11371c6c6952SThomas Gleixner * While this works for edge type interrupts, we play 11381c6c6952SThomas Gleixner * it safe and reject unconditionally because we can't 11391c6c6952SThomas Gleixner * say for sure which type this interrupt really 11401c6c6952SThomas Gleixner * has. The type flags are unreliable as the 11411c6c6952SThomas Gleixner * underlying chip implementation can override them. 11421c6c6952SThomas Gleixner */ 114397fd75b7SAndrew Morton pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n", 11441c6c6952SThomas Gleixner irq); 11451c6c6952SThomas Gleixner ret = -EINVAL; 11461c6c6952SThomas Gleixner goto out_mask; 114752abb700SThomas Gleixner } 1148b5faba21SThomas Gleixner 11491da177e4SLinus Torvalds if (!shared) { 1150c1bacbaeSThomas Gleixner ret = irq_request_resources(desc); 1151c1bacbaeSThomas Gleixner if (ret) { 1152c1bacbaeSThomas Gleixner pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n", 1153c1bacbaeSThomas Gleixner new->name, irq, desc->irq_data.chip->name); 1154c1bacbaeSThomas Gleixner goto out_mask; 1155c1bacbaeSThomas Gleixner } 1156c1bacbaeSThomas Gleixner 11573aa551c9SThomas Gleixner init_waitqueue_head(&desc->wait_for_threads); 11583aa551c9SThomas Gleixner 115982736f4dSUwe Kleine-König /* Setup the type (level, edge polarity) if configured: */ 116082736f4dSUwe Kleine-König if (new->flags & IRQF_TRIGGER_MASK) { 1161f2b662daSDavid Brownell ret = __irq_set_trigger(desc, irq, 1162f2b662daSDavid Brownell new->flags & IRQF_TRIGGER_MASK); 116382736f4dSUwe Kleine-König 11643aa551c9SThomas Gleixner if (ret) 11653b8249e7SThomas Gleixner goto out_mask; 1166091738a2SThomas Gleixner } 1167f75d222bSAhmed S. Darwish 1168009b4c3bSThomas Gleixner desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \ 116932f4125eSThomas Gleixner IRQS_ONESHOT | IRQS_WAITING); 117032f4125eSThomas Gleixner irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS); 117194d39e1fSThomas Gleixner 1172a005677bSThomas Gleixner if (new->flags & IRQF_PERCPU) { 1173a005677bSThomas Gleixner irqd_set(&desc->irq_data, IRQD_PER_CPU); 1174a005677bSThomas Gleixner irq_settings_set_per_cpu(desc); 1175a005677bSThomas Gleixner } 11766a58fb3bSThomas Gleixner 1177b25c340cSThomas Gleixner if (new->flags & IRQF_ONESHOT) 11783d67baecSThomas Gleixner desc->istate |= IRQS_ONESHOT; 1179b25c340cSThomas Gleixner 11801ccb4e61SThomas Gleixner if (irq_settings_can_autoenable(desc)) 1181b4bc724eSThomas Gleixner irq_startup(desc, true); 118246999238SThomas Gleixner else 1183e76de9f8SThomas Gleixner /* Undo nested disables: */ 1184e76de9f8SThomas Gleixner desc->depth = 1; 118518404756SMax Krasnyansky 1186612e3684SThomas Gleixner /* Exclude IRQ from balancing if requested */ 1187a005677bSThomas Gleixner if (new->flags & IRQF_NOBALANCING) { 1188a005677bSThomas Gleixner irq_settings_set_no_balancing(desc); 1189a005677bSThomas Gleixner irqd_set(&desc->irq_data, IRQD_NO_BALANCING); 1190a005677bSThomas Gleixner } 1191612e3684SThomas Gleixner 119218404756SMax Krasnyansky /* Set default affinity mask once everything is setup */ 11933b8249e7SThomas Gleixner setup_affinity(irq, desc, mask); 11940c5d1eb7SDavid Brownell 1195876dbd4cSThomas Gleixner } else if (new->flags & IRQF_TRIGGER_MASK) { 1196876dbd4cSThomas Gleixner unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK; 1197876dbd4cSThomas Gleixner unsigned int omsk = irq_settings_get_trigger_mask(desc); 1198876dbd4cSThomas Gleixner 1199876dbd4cSThomas Gleixner if (nmsk != omsk) 1200876dbd4cSThomas Gleixner /* hope the handler works with current trigger mode */ 120197fd75b7SAndrew Morton pr_warning("irq %d uses trigger mode %u; requested %u\n", 1202876dbd4cSThomas Gleixner irq, nmsk, omsk); 120394d39e1fSThomas Gleixner } 120482736f4dSUwe Kleine-König 120569ab8494SThomas Gleixner new->irq = irq; 1206f17c7545SIngo Molnar *old_ptr = new; 120782736f4dSUwe Kleine-König 1208cab303beSThomas Gleixner irq_pm_install_action(desc, new); 1209cab303beSThomas Gleixner 12108528b0f1SLinus Torvalds /* Reset broken irq detection when installing new handler */ 12118528b0f1SLinus Torvalds desc->irq_count = 0; 12128528b0f1SLinus Torvalds desc->irqs_unhandled = 0; 12131adb0850SThomas Gleixner 12141adb0850SThomas Gleixner /* 12151adb0850SThomas Gleixner * Check whether we disabled the irq via the spurious handler 12161adb0850SThomas Gleixner * before. Reenable it and give it another chance. 12171adb0850SThomas Gleixner */ 12187acdd53eSThomas Gleixner if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) { 12197acdd53eSThomas Gleixner desc->istate &= ~IRQS_SPURIOUS_DISABLED; 12208df2e02cSThomas Gleixner __enable_irq(desc, irq); 12211adb0850SThomas Gleixner } 12221adb0850SThomas Gleixner 1223239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 12241da177e4SLinus Torvalds 122569ab8494SThomas Gleixner /* 122669ab8494SThomas Gleixner * Strictly no need to wake it up, but hung_task complains 122769ab8494SThomas Gleixner * when no hard interrupt wakes the thread up. 122869ab8494SThomas Gleixner */ 122969ab8494SThomas Gleixner if (new->thread) 123069ab8494SThomas Gleixner wake_up_process(new->thread); 123169ab8494SThomas Gleixner 12322c6927a3SYinghai Lu register_irq_proc(irq, desc); 12331da177e4SLinus Torvalds new->dir = NULL; 12341da177e4SLinus Torvalds register_handler_proc(irq, new); 12354f5058c3SXiaotian Feng free_cpumask_var(mask); 12361da177e4SLinus Torvalds 12371da177e4SLinus Torvalds return 0; 1238f5163427SDimitri Sivanich 1239f5163427SDimitri Sivanich mismatch: 12403cca53b0SThomas Gleixner if (!(new->flags & IRQF_PROBE_SHARED)) { 124197fd75b7SAndrew Morton pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n", 1242f5d89470SThomas Gleixner irq, new->flags, new->name, old->flags, old->name); 1243f5d89470SThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ 1244f5163427SDimitri Sivanich dump_stack(); 12453f050447SAlan Cox #endif 1246f5d89470SThomas Gleixner } 12473aa551c9SThomas Gleixner ret = -EBUSY; 12483aa551c9SThomas Gleixner 12493b8249e7SThomas Gleixner out_mask: 12501c389795SDan Carpenter raw_spin_unlock_irqrestore(&desc->lock, flags); 12513b8249e7SThomas Gleixner free_cpumask_var(mask); 12523b8249e7SThomas Gleixner 12533aa551c9SThomas Gleixner out_thread: 12543aa551c9SThomas Gleixner if (new->thread) { 12553aa551c9SThomas Gleixner struct task_struct *t = new->thread; 12563aa551c9SThomas Gleixner 12573aa551c9SThomas Gleixner new->thread = NULL; 12583aa551c9SThomas Gleixner kthread_stop(t); 12593aa551c9SThomas Gleixner put_task_struct(t); 12603aa551c9SThomas Gleixner } 1261b6873807SSebastian Andrzej Siewior out_mput: 1262b6873807SSebastian Andrzej Siewior module_put(desc->owner); 12633aa551c9SThomas Gleixner return ret; 12641da177e4SLinus Torvalds } 12651da177e4SLinus Torvalds 12661da177e4SLinus Torvalds /** 1267d3c60047SThomas Gleixner * setup_irq - setup an interrupt 1268d3c60047SThomas Gleixner * @irq: Interrupt line to setup 1269d3c60047SThomas Gleixner * @act: irqaction for the interrupt 1270d3c60047SThomas Gleixner * 1271d3c60047SThomas Gleixner * Used to statically setup interrupts in the early boot process. 1272d3c60047SThomas Gleixner */ 1273d3c60047SThomas Gleixner int setup_irq(unsigned int irq, struct irqaction *act) 1274d3c60047SThomas Gleixner { 1275986c011dSDavid Daney int retval; 1276d3c60047SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 1277d3c60047SThomas Gleixner 127831d9d9b6SMarc Zyngier if (WARN_ON(irq_settings_is_per_cpu_devid(desc))) 127931d9d9b6SMarc Zyngier return -EINVAL; 1280986c011dSDavid Daney chip_bus_lock(desc); 1281986c011dSDavid Daney retval = __setup_irq(irq, desc, act); 1282986c011dSDavid Daney chip_bus_sync_unlock(desc); 1283986c011dSDavid Daney 1284986c011dSDavid Daney return retval; 1285d3c60047SThomas Gleixner } 1286eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(setup_irq); 1287d3c60047SThomas Gleixner 1288cbf94f06SMagnus Damm /* 1289cbf94f06SMagnus Damm * Internal function to unregister an irqaction - used to free 1290cbf94f06SMagnus Damm * regular and special interrupts that are part of the architecture. 12911da177e4SLinus Torvalds */ 1292cbf94f06SMagnus Damm static struct irqaction *__free_irq(unsigned int irq, void *dev_id) 12931da177e4SLinus Torvalds { 1294d3c60047SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 1295f17c7545SIngo Molnar struct irqaction *action, **action_ptr; 12961da177e4SLinus Torvalds unsigned long flags; 12971da177e4SLinus Torvalds 1298ae88a23bSIngo Molnar WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq); 12997d94f7caSYinghai Lu 13007d94f7caSYinghai Lu if (!desc) 1301f21cfb25SMagnus Damm return NULL; 13021da177e4SLinus Torvalds 1303239007b8SThomas Gleixner raw_spin_lock_irqsave(&desc->lock, flags); 1304ae88a23bSIngo Molnar 1305ae88a23bSIngo Molnar /* 1306ae88a23bSIngo Molnar * There can be multiple actions per IRQ descriptor, find the right 1307ae88a23bSIngo Molnar * one based on the dev_id: 1308ae88a23bSIngo Molnar */ 1309f17c7545SIngo Molnar action_ptr = &desc->action; 13101da177e4SLinus Torvalds for (;;) { 1311f17c7545SIngo Molnar action = *action_ptr; 13121da177e4SLinus Torvalds 1313ae88a23bSIngo Molnar if (!action) { 1314ae88a23bSIngo Molnar WARN(1, "Trying to free already-free IRQ %d\n", irq); 1315239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 1316ae88a23bSIngo Molnar 1317f21cfb25SMagnus Damm return NULL; 1318ae88a23bSIngo Molnar } 13191da177e4SLinus Torvalds 13208316e381SIngo Molnar if (action->dev_id == dev_id) 1321ae88a23bSIngo Molnar break; 1322f17c7545SIngo Molnar action_ptr = &action->next; 1323ae88a23bSIngo Molnar } 1324ae88a23bSIngo Molnar 1325ae88a23bSIngo Molnar /* Found it - now remove it from the list of entries: */ 1326f17c7545SIngo Molnar *action_ptr = action->next; 1327dbce706eSPaolo 'Blaisorblade' Giarrusso 1328cab303beSThomas Gleixner irq_pm_remove_action(desc, action); 1329cab303beSThomas Gleixner 1330ae88a23bSIngo Molnar /* If this was the last handler, shut down the IRQ line: */ 1331c1bacbaeSThomas Gleixner if (!desc->action) { 133246999238SThomas Gleixner irq_shutdown(desc); 1333c1bacbaeSThomas Gleixner irq_release_resources(desc); 1334c1bacbaeSThomas Gleixner } 13353aa551c9SThomas Gleixner 1336e7a297b0SPeter P Waskiewicz Jr #ifdef CONFIG_SMP 1337e7a297b0SPeter P Waskiewicz Jr /* make sure affinity_hint is cleaned up */ 1338e7a297b0SPeter P Waskiewicz Jr if (WARN_ON_ONCE(desc->affinity_hint)) 1339e7a297b0SPeter P Waskiewicz Jr desc->affinity_hint = NULL; 1340e7a297b0SPeter P Waskiewicz Jr #endif 1341e7a297b0SPeter P Waskiewicz Jr 1342239007b8SThomas Gleixner raw_spin_unlock_irqrestore(&desc->lock, flags); 1343ae88a23bSIngo Molnar 13441da177e4SLinus Torvalds unregister_handler_proc(irq, action); 13451da177e4SLinus Torvalds 1346ae88a23bSIngo Molnar /* Make sure it's not being used on another CPU: */ 13471da177e4SLinus Torvalds synchronize_irq(irq); 1348ae88a23bSIngo Molnar 13491d99493bSDavid Woodhouse #ifdef CONFIG_DEBUG_SHIRQ 13501d99493bSDavid Woodhouse /* 1351ae88a23bSIngo Molnar * It's a shared IRQ -- the driver ought to be prepared for an IRQ 1352ae88a23bSIngo Molnar * event to happen even now it's being freed, so let's make sure that 1353ae88a23bSIngo Molnar * is so by doing an extra call to the handler .... 1354ae88a23bSIngo Molnar * 1355ae88a23bSIngo Molnar * ( We do this after actually deregistering it, to make sure that a 1356ae88a23bSIngo Molnar * 'real' IRQ doesn't run in * parallel with our fake. ) 13571d99493bSDavid Woodhouse */ 13581d99493bSDavid Woodhouse if (action->flags & IRQF_SHARED) { 13591d99493bSDavid Woodhouse local_irq_save(flags); 13601d99493bSDavid Woodhouse action->handler(irq, dev_id); 13611d99493bSDavid Woodhouse local_irq_restore(flags); 13621d99493bSDavid Woodhouse } 13631d99493bSDavid Woodhouse #endif 13642d860ad7SLinus Torvalds 13652d860ad7SLinus Torvalds if (action->thread) { 13662d860ad7SLinus Torvalds kthread_stop(action->thread); 13672d860ad7SLinus Torvalds put_task_struct(action->thread); 13682d860ad7SLinus Torvalds } 13692d860ad7SLinus Torvalds 1370b6873807SSebastian Andrzej Siewior module_put(desc->owner); 1371f21cfb25SMagnus Damm return action; 1372f21cfb25SMagnus Damm } 13731da177e4SLinus Torvalds 13741da177e4SLinus Torvalds /** 1375cbf94f06SMagnus Damm * remove_irq - free an interrupt 1376cbf94f06SMagnus Damm * @irq: Interrupt line to free 1377cbf94f06SMagnus Damm * @act: irqaction for the interrupt 1378cbf94f06SMagnus Damm * 1379cbf94f06SMagnus Damm * Used to remove interrupts statically setup by the early boot process. 1380cbf94f06SMagnus Damm */ 1381cbf94f06SMagnus Damm void remove_irq(unsigned int irq, struct irqaction *act) 1382cbf94f06SMagnus Damm { 138331d9d9b6SMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 138431d9d9b6SMarc Zyngier 138531d9d9b6SMarc Zyngier if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc))) 1386cbf94f06SMagnus Damm __free_irq(irq, act->dev_id); 1387cbf94f06SMagnus Damm } 1388eb53b4e8SMagnus Damm EXPORT_SYMBOL_GPL(remove_irq); 1389cbf94f06SMagnus Damm 1390cbf94f06SMagnus Damm /** 1391f21cfb25SMagnus Damm * free_irq - free an interrupt allocated with request_irq 13921da177e4SLinus Torvalds * @irq: Interrupt line to free 13931da177e4SLinus Torvalds * @dev_id: Device identity to free 13941da177e4SLinus Torvalds * 13951da177e4SLinus Torvalds * Remove an interrupt handler. The handler is removed and if the 13961da177e4SLinus Torvalds * interrupt line is no longer in use by any driver it is disabled. 13971da177e4SLinus Torvalds * On a shared IRQ the caller must ensure the interrupt is disabled 13981da177e4SLinus Torvalds * on the card it drives before calling this function. The function 13991da177e4SLinus Torvalds * does not return until any executing interrupts for this IRQ 14001da177e4SLinus Torvalds * have completed. 14011da177e4SLinus Torvalds * 14021da177e4SLinus Torvalds * This function must not be called from interrupt context. 14031da177e4SLinus Torvalds */ 14041da177e4SLinus Torvalds void free_irq(unsigned int irq, void *dev_id) 14051da177e4SLinus Torvalds { 140670aedd24SThomas Gleixner struct irq_desc *desc = irq_to_desc(irq); 140770aedd24SThomas Gleixner 140831d9d9b6SMarc Zyngier if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc))) 140970aedd24SThomas Gleixner return; 141070aedd24SThomas Gleixner 1411cd7eab44SBen Hutchings #ifdef CONFIG_SMP 1412cd7eab44SBen Hutchings if (WARN_ON(desc->affinity_notify)) 1413cd7eab44SBen Hutchings desc->affinity_notify = NULL; 1414cd7eab44SBen Hutchings #endif 1415cd7eab44SBen Hutchings 14163876ec9eSThomas Gleixner chip_bus_lock(desc); 1417cbf94f06SMagnus Damm kfree(__free_irq(irq, dev_id)); 14183876ec9eSThomas Gleixner chip_bus_sync_unlock(desc); 14191da177e4SLinus Torvalds } 14201da177e4SLinus Torvalds EXPORT_SYMBOL(free_irq); 14211da177e4SLinus Torvalds 14221da177e4SLinus Torvalds /** 14233aa551c9SThomas Gleixner * request_threaded_irq - allocate an interrupt line 14241da177e4SLinus Torvalds * @irq: Interrupt line to allocate 14253aa551c9SThomas Gleixner * @handler: Function to be called when the IRQ occurs. 14263aa551c9SThomas Gleixner * Primary handler for threaded interrupts 1427b25c340cSThomas Gleixner * If NULL and thread_fn != NULL the default 1428b25c340cSThomas Gleixner * primary handler is installed 14293aa551c9SThomas Gleixner * @thread_fn: Function called from the irq handler thread 14303aa551c9SThomas Gleixner * If NULL, no irq thread is created 14311da177e4SLinus Torvalds * @irqflags: Interrupt type flags 14321da177e4SLinus Torvalds * @devname: An ascii name for the claiming device 14331da177e4SLinus Torvalds * @dev_id: A cookie passed back to the handler function 14341da177e4SLinus Torvalds * 14351da177e4SLinus Torvalds * This call allocates interrupt resources and enables the 14361da177e4SLinus Torvalds * interrupt line and IRQ handling. From the point this 14371da177e4SLinus Torvalds * call is made your handler function may be invoked. Since 14381da177e4SLinus Torvalds * your handler function must clear any interrupt the board 14391da177e4SLinus Torvalds * raises, you must take care both to initialise your hardware 14401da177e4SLinus Torvalds * and to set up the interrupt handler in the right order. 14411da177e4SLinus Torvalds * 14423aa551c9SThomas Gleixner * If you want to set up a threaded irq handler for your device 14436d21af4fSJavi Merino * then you need to supply @handler and @thread_fn. @handler is 14443aa551c9SThomas Gleixner * still called in hard interrupt context and has to check 14453aa551c9SThomas Gleixner * whether the interrupt originates from the device. If yes it 14463aa551c9SThomas Gleixner * needs to disable the interrupt on the device and return 144739a2eddbSSteven Rostedt * IRQ_WAKE_THREAD which will wake up the handler thread and run 14483aa551c9SThomas Gleixner * @thread_fn. This split handler design is necessary to support 14493aa551c9SThomas Gleixner * shared interrupts. 14503aa551c9SThomas Gleixner * 14511da177e4SLinus Torvalds * Dev_id must be globally unique. Normally the address of the 14521da177e4SLinus Torvalds * device data structure is used as the cookie. Since the handler 14531da177e4SLinus Torvalds * receives this value it makes sense to use it. 14541da177e4SLinus Torvalds * 14551da177e4SLinus Torvalds * If your interrupt is shared you must pass a non NULL dev_id 14561da177e4SLinus Torvalds * as this is required when freeing the interrupt. 14571da177e4SLinus Torvalds * 14581da177e4SLinus Torvalds * Flags: 14591da177e4SLinus Torvalds * 14603cca53b0SThomas Gleixner * IRQF_SHARED Interrupt is shared 14610c5d1eb7SDavid Brownell * IRQF_TRIGGER_* Specify active edge(s) or level 14621da177e4SLinus Torvalds * 14631da177e4SLinus Torvalds */ 14643aa551c9SThomas Gleixner int request_threaded_irq(unsigned int irq, irq_handler_t handler, 14653aa551c9SThomas Gleixner irq_handler_t thread_fn, unsigned long irqflags, 14663aa551c9SThomas Gleixner const char *devname, void *dev_id) 14671da177e4SLinus Torvalds { 14681da177e4SLinus Torvalds struct irqaction *action; 146908678b08SYinghai Lu struct irq_desc *desc; 1470d3c60047SThomas Gleixner int retval; 14711da177e4SLinus Torvalds 1472470c6623SDavid Brownell /* 14731da177e4SLinus Torvalds * Sanity-check: shared interrupts must pass in a real dev-ID, 14741da177e4SLinus Torvalds * otherwise we'll have trouble later trying to figure out 14751da177e4SLinus Torvalds * which interrupt is which (messes up the interrupt freeing 14761da177e4SLinus Torvalds * logic etc). 14771da177e4SLinus Torvalds */ 14783cca53b0SThomas Gleixner if ((irqflags & IRQF_SHARED) && !dev_id) 14791da177e4SLinus Torvalds return -EINVAL; 14807d94f7caSYinghai Lu 1481cb5bc832SYinghai Lu desc = irq_to_desc(irq); 14827d94f7caSYinghai Lu if (!desc) 14831da177e4SLinus Torvalds return -EINVAL; 14847d94f7caSYinghai Lu 148531d9d9b6SMarc Zyngier if (!irq_settings_can_request(desc) || 148631d9d9b6SMarc Zyngier WARN_ON(irq_settings_is_per_cpu_devid(desc))) 14876550c775SThomas Gleixner return -EINVAL; 1488b25c340cSThomas Gleixner 1489b25c340cSThomas Gleixner if (!handler) { 1490b25c340cSThomas Gleixner if (!thread_fn) 14911da177e4SLinus Torvalds return -EINVAL; 1492b25c340cSThomas Gleixner handler = irq_default_primary_handler; 1493b25c340cSThomas Gleixner } 14941da177e4SLinus Torvalds 149545535732SThomas Gleixner action = kzalloc(sizeof(struct irqaction), GFP_KERNEL); 14961da177e4SLinus Torvalds if (!action) 14971da177e4SLinus Torvalds return -ENOMEM; 14981da177e4SLinus Torvalds 14991da177e4SLinus Torvalds action->handler = handler; 15003aa551c9SThomas Gleixner action->thread_fn = thread_fn; 15011da177e4SLinus Torvalds action->flags = irqflags; 15021da177e4SLinus Torvalds action->name = devname; 15031da177e4SLinus Torvalds action->dev_id = dev_id; 15041da177e4SLinus Torvalds 15053876ec9eSThomas Gleixner chip_bus_lock(desc); 1506d3c60047SThomas Gleixner retval = __setup_irq(irq, desc, action); 15073876ec9eSThomas Gleixner chip_bus_sync_unlock(desc); 150870aedd24SThomas Gleixner 1509377bf1e4SAnton Vorontsov if (retval) 1510377bf1e4SAnton Vorontsov kfree(action); 1511377bf1e4SAnton Vorontsov 15126d83f94dSThomas Gleixner #ifdef CONFIG_DEBUG_SHIRQ_FIXME 15136ce51c43SLuis Henriques if (!retval && (irqflags & IRQF_SHARED)) { 1514a304e1b8SDavid Woodhouse /* 1515a304e1b8SDavid Woodhouse * It's a shared IRQ -- the driver ought to be prepared for it 1516a304e1b8SDavid Woodhouse * to happen immediately, so let's make sure.... 1517377bf1e4SAnton Vorontsov * We disable the irq to make sure that a 'real' IRQ doesn't 1518377bf1e4SAnton Vorontsov * run in parallel with our fake. 1519a304e1b8SDavid Woodhouse */ 1520a304e1b8SDavid Woodhouse unsigned long flags; 1521a304e1b8SDavid Woodhouse 1522377bf1e4SAnton Vorontsov disable_irq(irq); 1523a304e1b8SDavid Woodhouse local_irq_save(flags); 1524377bf1e4SAnton Vorontsov 1525a304e1b8SDavid Woodhouse handler(irq, dev_id); 1526377bf1e4SAnton Vorontsov 1527a304e1b8SDavid Woodhouse local_irq_restore(flags); 1528377bf1e4SAnton Vorontsov enable_irq(irq); 1529a304e1b8SDavid Woodhouse } 1530a304e1b8SDavid Woodhouse #endif 15311da177e4SLinus Torvalds return retval; 15321da177e4SLinus Torvalds } 15333aa551c9SThomas Gleixner EXPORT_SYMBOL(request_threaded_irq); 1534ae731f8dSMarc Zyngier 1535ae731f8dSMarc Zyngier /** 1536ae731f8dSMarc Zyngier * request_any_context_irq - allocate an interrupt line 1537ae731f8dSMarc Zyngier * @irq: Interrupt line to allocate 1538ae731f8dSMarc Zyngier * @handler: Function to be called when the IRQ occurs. 1539ae731f8dSMarc Zyngier * Threaded handler for threaded interrupts. 1540ae731f8dSMarc Zyngier * @flags: Interrupt type flags 1541ae731f8dSMarc Zyngier * @name: An ascii name for the claiming device 1542ae731f8dSMarc Zyngier * @dev_id: A cookie passed back to the handler function 1543ae731f8dSMarc Zyngier * 1544ae731f8dSMarc Zyngier * This call allocates interrupt resources and enables the 1545ae731f8dSMarc Zyngier * interrupt line and IRQ handling. It selects either a 1546ae731f8dSMarc Zyngier * hardirq or threaded handling method depending on the 1547ae731f8dSMarc Zyngier * context. 1548ae731f8dSMarc Zyngier * 1549ae731f8dSMarc Zyngier * On failure, it returns a negative value. On success, 1550ae731f8dSMarc Zyngier * it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED. 1551ae731f8dSMarc Zyngier */ 1552ae731f8dSMarc Zyngier int request_any_context_irq(unsigned int irq, irq_handler_t handler, 1553ae731f8dSMarc Zyngier unsigned long flags, const char *name, void *dev_id) 1554ae731f8dSMarc Zyngier { 1555ae731f8dSMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 1556ae731f8dSMarc Zyngier int ret; 1557ae731f8dSMarc Zyngier 1558ae731f8dSMarc Zyngier if (!desc) 1559ae731f8dSMarc Zyngier return -EINVAL; 1560ae731f8dSMarc Zyngier 15611ccb4e61SThomas Gleixner if (irq_settings_is_nested_thread(desc)) { 1562ae731f8dSMarc Zyngier ret = request_threaded_irq(irq, NULL, handler, 1563ae731f8dSMarc Zyngier flags, name, dev_id); 1564ae731f8dSMarc Zyngier return !ret ? IRQC_IS_NESTED : ret; 1565ae731f8dSMarc Zyngier } 1566ae731f8dSMarc Zyngier 1567ae731f8dSMarc Zyngier ret = request_irq(irq, handler, flags, name, dev_id); 1568ae731f8dSMarc Zyngier return !ret ? IRQC_IS_HARDIRQ : ret; 1569ae731f8dSMarc Zyngier } 1570ae731f8dSMarc Zyngier EXPORT_SYMBOL_GPL(request_any_context_irq); 157131d9d9b6SMarc Zyngier 15721e7c5fd2SMarc Zyngier void enable_percpu_irq(unsigned int irq, unsigned int type) 157331d9d9b6SMarc Zyngier { 157431d9d9b6SMarc Zyngier unsigned int cpu = smp_processor_id(); 157531d9d9b6SMarc Zyngier unsigned long flags; 157631d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU); 157731d9d9b6SMarc Zyngier 157831d9d9b6SMarc Zyngier if (!desc) 157931d9d9b6SMarc Zyngier return; 158031d9d9b6SMarc Zyngier 15811e7c5fd2SMarc Zyngier type &= IRQ_TYPE_SENSE_MASK; 15821e7c5fd2SMarc Zyngier if (type != IRQ_TYPE_NONE) { 15831e7c5fd2SMarc Zyngier int ret; 15841e7c5fd2SMarc Zyngier 15851e7c5fd2SMarc Zyngier ret = __irq_set_trigger(desc, irq, type); 15861e7c5fd2SMarc Zyngier 15871e7c5fd2SMarc Zyngier if (ret) { 158832cffddeSThomas Gleixner WARN(1, "failed to set type for IRQ%d\n", irq); 15891e7c5fd2SMarc Zyngier goto out; 15901e7c5fd2SMarc Zyngier } 15911e7c5fd2SMarc Zyngier } 15921e7c5fd2SMarc Zyngier 159331d9d9b6SMarc Zyngier irq_percpu_enable(desc, cpu); 15941e7c5fd2SMarc Zyngier out: 159531d9d9b6SMarc Zyngier irq_put_desc_unlock(desc, flags); 159631d9d9b6SMarc Zyngier } 159736a5df85SChris Metcalf EXPORT_SYMBOL_GPL(enable_percpu_irq); 159831d9d9b6SMarc Zyngier 159931d9d9b6SMarc Zyngier void disable_percpu_irq(unsigned int irq) 160031d9d9b6SMarc Zyngier { 160131d9d9b6SMarc Zyngier unsigned int cpu = smp_processor_id(); 160231d9d9b6SMarc Zyngier unsigned long flags; 160331d9d9b6SMarc Zyngier struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU); 160431d9d9b6SMarc Zyngier 160531d9d9b6SMarc Zyngier if (!desc) 160631d9d9b6SMarc Zyngier return; 160731d9d9b6SMarc Zyngier 160831d9d9b6SMarc Zyngier irq_percpu_disable(desc, cpu); 160931d9d9b6SMarc Zyngier irq_put_desc_unlock(desc, flags); 161031d9d9b6SMarc Zyngier } 161136a5df85SChris Metcalf EXPORT_SYMBOL_GPL(disable_percpu_irq); 161231d9d9b6SMarc Zyngier 161331d9d9b6SMarc Zyngier /* 161431d9d9b6SMarc Zyngier * Internal function to unregister a percpu irqaction. 161531d9d9b6SMarc Zyngier */ 161631d9d9b6SMarc Zyngier static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id) 161731d9d9b6SMarc Zyngier { 161831d9d9b6SMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 161931d9d9b6SMarc Zyngier struct irqaction *action; 162031d9d9b6SMarc Zyngier unsigned long flags; 162131d9d9b6SMarc Zyngier 162231d9d9b6SMarc Zyngier WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq); 162331d9d9b6SMarc Zyngier 162431d9d9b6SMarc Zyngier if (!desc) 162531d9d9b6SMarc Zyngier return NULL; 162631d9d9b6SMarc Zyngier 162731d9d9b6SMarc Zyngier raw_spin_lock_irqsave(&desc->lock, flags); 162831d9d9b6SMarc Zyngier 162931d9d9b6SMarc Zyngier action = desc->action; 163031d9d9b6SMarc Zyngier if (!action || action->percpu_dev_id != dev_id) { 163131d9d9b6SMarc Zyngier WARN(1, "Trying to free already-free IRQ %d\n", irq); 163231d9d9b6SMarc Zyngier goto bad; 163331d9d9b6SMarc Zyngier } 163431d9d9b6SMarc Zyngier 163531d9d9b6SMarc Zyngier if (!cpumask_empty(desc->percpu_enabled)) { 163631d9d9b6SMarc Zyngier WARN(1, "percpu IRQ %d still enabled on CPU%d!\n", 163731d9d9b6SMarc Zyngier irq, cpumask_first(desc->percpu_enabled)); 163831d9d9b6SMarc Zyngier goto bad; 163931d9d9b6SMarc Zyngier } 164031d9d9b6SMarc Zyngier 164131d9d9b6SMarc Zyngier /* Found it - now remove it from the list of entries: */ 164231d9d9b6SMarc Zyngier desc->action = NULL; 164331d9d9b6SMarc Zyngier 164431d9d9b6SMarc Zyngier raw_spin_unlock_irqrestore(&desc->lock, flags); 164531d9d9b6SMarc Zyngier 164631d9d9b6SMarc Zyngier unregister_handler_proc(irq, action); 164731d9d9b6SMarc Zyngier 164831d9d9b6SMarc Zyngier module_put(desc->owner); 164931d9d9b6SMarc Zyngier return action; 165031d9d9b6SMarc Zyngier 165131d9d9b6SMarc Zyngier bad: 165231d9d9b6SMarc Zyngier raw_spin_unlock_irqrestore(&desc->lock, flags); 165331d9d9b6SMarc Zyngier return NULL; 165431d9d9b6SMarc Zyngier } 165531d9d9b6SMarc Zyngier 165631d9d9b6SMarc Zyngier /** 165731d9d9b6SMarc Zyngier * remove_percpu_irq - free a per-cpu interrupt 165831d9d9b6SMarc Zyngier * @irq: Interrupt line to free 165931d9d9b6SMarc Zyngier * @act: irqaction for the interrupt 166031d9d9b6SMarc Zyngier * 166131d9d9b6SMarc Zyngier * Used to remove interrupts statically setup by the early boot process. 166231d9d9b6SMarc Zyngier */ 166331d9d9b6SMarc Zyngier void remove_percpu_irq(unsigned int irq, struct irqaction *act) 166431d9d9b6SMarc Zyngier { 166531d9d9b6SMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 166631d9d9b6SMarc Zyngier 166731d9d9b6SMarc Zyngier if (desc && irq_settings_is_per_cpu_devid(desc)) 166831d9d9b6SMarc Zyngier __free_percpu_irq(irq, act->percpu_dev_id); 166931d9d9b6SMarc Zyngier } 167031d9d9b6SMarc Zyngier 167131d9d9b6SMarc Zyngier /** 167231d9d9b6SMarc Zyngier * free_percpu_irq - free an interrupt allocated with request_percpu_irq 167331d9d9b6SMarc Zyngier * @irq: Interrupt line to free 167431d9d9b6SMarc Zyngier * @dev_id: Device identity to free 167531d9d9b6SMarc Zyngier * 167631d9d9b6SMarc Zyngier * Remove a percpu interrupt handler. The handler is removed, but 167731d9d9b6SMarc Zyngier * the interrupt line is not disabled. This must be done on each 167831d9d9b6SMarc Zyngier * CPU before calling this function. The function does not return 167931d9d9b6SMarc Zyngier * until any executing interrupts for this IRQ have completed. 168031d9d9b6SMarc Zyngier * 168131d9d9b6SMarc Zyngier * This function must not be called from interrupt context. 168231d9d9b6SMarc Zyngier */ 168331d9d9b6SMarc Zyngier void free_percpu_irq(unsigned int irq, void __percpu *dev_id) 168431d9d9b6SMarc Zyngier { 168531d9d9b6SMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 168631d9d9b6SMarc Zyngier 168731d9d9b6SMarc Zyngier if (!desc || !irq_settings_is_per_cpu_devid(desc)) 168831d9d9b6SMarc Zyngier return; 168931d9d9b6SMarc Zyngier 169031d9d9b6SMarc Zyngier chip_bus_lock(desc); 169131d9d9b6SMarc Zyngier kfree(__free_percpu_irq(irq, dev_id)); 169231d9d9b6SMarc Zyngier chip_bus_sync_unlock(desc); 169331d9d9b6SMarc Zyngier } 169431d9d9b6SMarc Zyngier 169531d9d9b6SMarc Zyngier /** 169631d9d9b6SMarc Zyngier * setup_percpu_irq - setup a per-cpu interrupt 169731d9d9b6SMarc Zyngier * @irq: Interrupt line to setup 169831d9d9b6SMarc Zyngier * @act: irqaction for the interrupt 169931d9d9b6SMarc Zyngier * 170031d9d9b6SMarc Zyngier * Used to statically setup per-cpu interrupts in the early boot process. 170131d9d9b6SMarc Zyngier */ 170231d9d9b6SMarc Zyngier int setup_percpu_irq(unsigned int irq, struct irqaction *act) 170331d9d9b6SMarc Zyngier { 170431d9d9b6SMarc Zyngier struct irq_desc *desc = irq_to_desc(irq); 170531d9d9b6SMarc Zyngier int retval; 170631d9d9b6SMarc Zyngier 170731d9d9b6SMarc Zyngier if (!desc || !irq_settings_is_per_cpu_devid(desc)) 170831d9d9b6SMarc Zyngier return -EINVAL; 170931d9d9b6SMarc Zyngier chip_bus_lock(desc); 171031d9d9b6SMarc Zyngier retval = __setup_irq(irq, desc, act); 171131d9d9b6SMarc Zyngier chip_bus_sync_unlock(desc); 171231d9d9b6SMarc Zyngier 171331d9d9b6SMarc Zyngier return retval; 171431d9d9b6SMarc Zyngier } 171531d9d9b6SMarc Zyngier 171631d9d9b6SMarc Zyngier /** 171731d9d9b6SMarc Zyngier * request_percpu_irq - allocate a percpu interrupt line 171831d9d9b6SMarc Zyngier * @irq: Interrupt line to allocate 171931d9d9b6SMarc Zyngier * @handler: Function to be called when the IRQ occurs. 172031d9d9b6SMarc Zyngier * @devname: An ascii name for the claiming device 172131d9d9b6SMarc Zyngier * @dev_id: A percpu cookie passed back to the handler function 172231d9d9b6SMarc Zyngier * 172331d9d9b6SMarc Zyngier * This call allocates interrupt resources, but doesn't 172431d9d9b6SMarc Zyngier * automatically enable the interrupt. It has to be done on each 172531d9d9b6SMarc Zyngier * CPU using enable_percpu_irq(). 172631d9d9b6SMarc Zyngier * 172731d9d9b6SMarc Zyngier * Dev_id must be globally unique. It is a per-cpu variable, and 172831d9d9b6SMarc Zyngier * the handler gets called with the interrupted CPU's instance of 172931d9d9b6SMarc Zyngier * that variable. 173031d9d9b6SMarc Zyngier */ 173131d9d9b6SMarc Zyngier int request_percpu_irq(unsigned int irq, irq_handler_t handler, 173231d9d9b6SMarc Zyngier const char *devname, void __percpu *dev_id) 173331d9d9b6SMarc Zyngier { 173431d9d9b6SMarc Zyngier struct irqaction *action; 173531d9d9b6SMarc Zyngier struct irq_desc *desc; 173631d9d9b6SMarc Zyngier int retval; 173731d9d9b6SMarc Zyngier 173831d9d9b6SMarc Zyngier if (!dev_id) 173931d9d9b6SMarc Zyngier return -EINVAL; 174031d9d9b6SMarc Zyngier 174131d9d9b6SMarc Zyngier desc = irq_to_desc(irq); 174231d9d9b6SMarc Zyngier if (!desc || !irq_settings_can_request(desc) || 174331d9d9b6SMarc Zyngier !irq_settings_is_per_cpu_devid(desc)) 174431d9d9b6SMarc Zyngier return -EINVAL; 174531d9d9b6SMarc Zyngier 174631d9d9b6SMarc Zyngier action = kzalloc(sizeof(struct irqaction), GFP_KERNEL); 174731d9d9b6SMarc Zyngier if (!action) 174831d9d9b6SMarc Zyngier return -ENOMEM; 174931d9d9b6SMarc Zyngier 175031d9d9b6SMarc Zyngier action->handler = handler; 17512ed0e645SMarc Zyngier action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND; 175231d9d9b6SMarc Zyngier action->name = devname; 175331d9d9b6SMarc Zyngier action->percpu_dev_id = dev_id; 175431d9d9b6SMarc Zyngier 175531d9d9b6SMarc Zyngier chip_bus_lock(desc); 175631d9d9b6SMarc Zyngier retval = __setup_irq(irq, desc, action); 175731d9d9b6SMarc Zyngier chip_bus_sync_unlock(desc); 175831d9d9b6SMarc Zyngier 175931d9d9b6SMarc Zyngier if (retval) 176031d9d9b6SMarc Zyngier kfree(action); 176131d9d9b6SMarc Zyngier 176231d9d9b6SMarc Zyngier return retval; 176331d9d9b6SMarc Zyngier } 1764