1/* 2 * linux/kernel/irq/manage.c 3 * 4 * Copyright (C) 1992, 1998-2006 Linus Torvalds, Ingo Molnar 5 * Copyright (C) 2005-2006 Thomas Gleixner 6 * 7 * This file contains driver APIs to the irq subsystem. 8 */ 9 10#define pr_fmt(fmt) "genirq: " fmt 11 12#include <linux/irq.h> 13#include <linux/kthread.h> 14#include <linux/module.h> 15#include <linux/random.h> 16#include <linux/interrupt.h> 17#include <linux/slab.h> 18#include <linux/sched.h> 19#include <linux/sched/rt.h> 20#include <linux/task_work.h> 21 22#include "internals.h" 23 24#ifdef CONFIG_IRQ_FORCED_THREADING 25__read_mostly bool force_irqthreads; 26 27static int __init setup_forced_irqthreads(char *arg) 28{ 29 force_irqthreads = true; 30 return 0; 31} 32early_param("threadirqs", setup_forced_irqthreads); 33#endif 34 35static void __synchronize_hardirq(struct irq_desc *desc) 36{ 37 bool inprogress; 38 39 do { 40 unsigned long flags; 41 42 /* 43 * Wait until we're out of the critical section. This might 44 * give the wrong answer due to the lack of memory barriers. 45 */ 46 while (irqd_irq_inprogress(&desc->irq_data)) 47 cpu_relax(); 48 49 /* Ok, that indicated we're done: double-check carefully. */ 50 raw_spin_lock_irqsave(&desc->lock, flags); 51 inprogress = irqd_irq_inprogress(&desc->irq_data); 52 raw_spin_unlock_irqrestore(&desc->lock, flags); 53 54 /* Oops, that failed? */ 55 } while (inprogress); 56} 57 58/** 59 * synchronize_hardirq - wait for pending hard IRQ handlers (on other CPUs) 60 * @irq: interrupt number to wait for 61 * 62 * This function waits for any pending hard IRQ handlers for this 63 * interrupt to complete before returning. If you use this 64 * function while holding a resource the IRQ handler may need you 65 * will deadlock. It does not take associated threaded handlers 66 * into account. 67 * 68 * Do not use this for shutdown scenarios where you must be sure 69 * that all parts (hardirq and threaded handler) have completed. 70 * 71 * Returns: false if a threaded handler is active. 72 * 73 * This function may be called - with care - from IRQ context. 74 */ 75bool synchronize_hardirq(unsigned int irq) 76{ 77 struct irq_desc *desc = irq_to_desc(irq); 78 79 if (desc) { 80 __synchronize_hardirq(desc); 81 return !atomic_read(&desc->threads_active); 82 } 83 84 return true; 85} 86EXPORT_SYMBOL(synchronize_hardirq); 87 88/** 89 * synchronize_irq - wait for pending IRQ handlers (on other CPUs) 90 * @irq: interrupt number to wait for 91 * 92 * This function waits for any pending IRQ handlers for this interrupt 93 * to complete before returning. If you use this function while 94 * holding a resource the IRQ handler may need you will deadlock. 95 * 96 * This function may be called - with care - from IRQ context. 97 */ 98void synchronize_irq(unsigned int irq) 99{ 100 struct irq_desc *desc = irq_to_desc(irq); 101 102 if (desc) { 103 __synchronize_hardirq(desc); 104 /* 105 * We made sure that no hardirq handler is 106 * running. Now verify that no threaded handlers are 107 * active. 108 */ 109 wait_event(desc->wait_for_threads, 110 !atomic_read(&desc->threads_active)); 111 } 112} 113EXPORT_SYMBOL(synchronize_irq); 114 115#ifdef CONFIG_SMP 116cpumask_var_t irq_default_affinity; 117 118static int __irq_can_set_affinity(struct irq_desc *desc) 119{ 120 if (!desc || !irqd_can_balance(&desc->irq_data) || 121 !desc->irq_data.chip || !desc->irq_data.chip->irq_set_affinity) 122 return 0; 123 return 1; 124} 125 126/** 127 * irq_can_set_affinity - Check if the affinity of a given irq can be set 128 * @irq: Interrupt to check 129 * 130 */ 131int irq_can_set_affinity(unsigned int irq) 132{ 133 return __irq_can_set_affinity(irq_to_desc(irq)); 134} 135 136/** 137 * irq_set_thread_affinity - Notify irq threads to adjust affinity 138 * @desc: irq descriptor which has affitnity changed 139 * 140 * We just set IRQTF_AFFINITY and delegate the affinity setting 141 * to the interrupt thread itself. We can not call 142 * set_cpus_allowed_ptr() here as we hold desc->lock and this 143 * code can be called from hard interrupt context. 144 */ 145void irq_set_thread_affinity(struct irq_desc *desc) 146{ 147 struct irqaction *action = desc->action; 148 149 while (action) { 150 if (action->thread) 151 set_bit(IRQTF_AFFINITY, &action->thread_flags); 152 action = action->next; 153 } 154} 155 156#ifdef CONFIG_GENERIC_PENDING_IRQ 157static inline bool irq_can_move_pcntxt(struct irq_data *data) 158{ 159 return irqd_can_move_in_process_context(data); 160} 161static inline bool irq_move_pending(struct irq_data *data) 162{ 163 return irqd_is_setaffinity_pending(data); 164} 165static inline void 166irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) 167{ 168 cpumask_copy(desc->pending_mask, mask); 169} 170static inline void 171irq_get_pending(struct cpumask *mask, struct irq_desc *desc) 172{ 173 cpumask_copy(mask, desc->pending_mask); 174} 175#else 176static inline bool irq_can_move_pcntxt(struct irq_data *data) { return true; } 177static inline bool irq_move_pending(struct irq_data *data) { return false; } 178static inline void 179irq_copy_pending(struct irq_desc *desc, const struct cpumask *mask) { } 180static inline void 181irq_get_pending(struct cpumask *mask, struct irq_desc *desc) { } 182#endif 183 184int irq_do_set_affinity(struct irq_data *data, const struct cpumask *mask, 185 bool force) 186{ 187 struct irq_desc *desc = irq_data_to_desc(data); 188 struct irq_chip *chip = irq_data_get_irq_chip(data); 189 int ret; 190 191 ret = chip->irq_set_affinity(data, mask, force); 192 switch (ret) { 193 case IRQ_SET_MASK_OK: 194 case IRQ_SET_MASK_OK_DONE: 195 cpumask_copy(desc->irq_common_data.affinity, mask); 196 case IRQ_SET_MASK_OK_NOCOPY: 197 irq_set_thread_affinity(desc); 198 ret = 0; 199 } 200 201 return ret; 202} 203 204int irq_set_affinity_locked(struct irq_data *data, const struct cpumask *mask, 205 bool force) 206{ 207 struct irq_chip *chip = irq_data_get_irq_chip(data); 208 struct irq_desc *desc = irq_data_to_desc(data); 209 int ret = 0; 210 211 if (!chip || !chip->irq_set_affinity) 212 return -EINVAL; 213 214 if (irq_can_move_pcntxt(data)) { 215 ret = irq_do_set_affinity(data, mask, force); 216 } else { 217 irqd_set_move_pending(data); 218 irq_copy_pending(desc, mask); 219 } 220 221 if (desc->affinity_notify) { 222 kref_get(&desc->affinity_notify->kref); 223 schedule_work(&desc->affinity_notify->work); 224 } 225 irqd_set(data, IRQD_AFFINITY_SET); 226 227 return ret; 228} 229 230int __irq_set_affinity(unsigned int irq, const struct cpumask *mask, bool force) 231{ 232 struct irq_desc *desc = irq_to_desc(irq); 233 unsigned long flags; 234 int ret; 235 236 if (!desc) 237 return -EINVAL; 238 239 raw_spin_lock_irqsave(&desc->lock, flags); 240 ret = irq_set_affinity_locked(irq_desc_get_irq_data(desc), mask, force); 241 raw_spin_unlock_irqrestore(&desc->lock, flags); 242 return ret; 243} 244 245int irq_set_affinity_hint(unsigned int irq, const struct cpumask *m) 246{ 247 unsigned long flags; 248 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 249 250 if (!desc) 251 return -EINVAL; 252 desc->affinity_hint = m; 253 irq_put_desc_unlock(desc, flags); 254 /* set the initial affinity to prevent every interrupt being on CPU0 */ 255 if (m) 256 __irq_set_affinity(irq, m, false); 257 return 0; 258} 259EXPORT_SYMBOL_GPL(irq_set_affinity_hint); 260 261static void irq_affinity_notify(struct work_struct *work) 262{ 263 struct irq_affinity_notify *notify = 264 container_of(work, struct irq_affinity_notify, work); 265 struct irq_desc *desc = irq_to_desc(notify->irq); 266 cpumask_var_t cpumask; 267 unsigned long flags; 268 269 if (!desc || !alloc_cpumask_var(&cpumask, GFP_KERNEL)) 270 goto out; 271 272 raw_spin_lock_irqsave(&desc->lock, flags); 273 if (irq_move_pending(&desc->irq_data)) 274 irq_get_pending(cpumask, desc); 275 else 276 cpumask_copy(cpumask, desc->irq_common_data.affinity); 277 raw_spin_unlock_irqrestore(&desc->lock, flags); 278 279 notify->notify(notify, cpumask); 280 281 free_cpumask_var(cpumask); 282out: 283 kref_put(¬ify->kref, notify->release); 284} 285 286/** 287 * irq_set_affinity_notifier - control notification of IRQ affinity changes 288 * @irq: Interrupt for which to enable/disable notification 289 * @notify: Context for notification, or %NULL to disable 290 * notification. Function pointers must be initialised; 291 * the other fields will be initialised by this function. 292 * 293 * Must be called in process context. Notification may only be enabled 294 * after the IRQ is allocated and must be disabled before the IRQ is 295 * freed using free_irq(). 296 */ 297int 298irq_set_affinity_notifier(unsigned int irq, struct irq_affinity_notify *notify) 299{ 300 struct irq_desc *desc = irq_to_desc(irq); 301 struct irq_affinity_notify *old_notify; 302 unsigned long flags; 303 304 /* The release function is promised process context */ 305 might_sleep(); 306 307 if (!desc) 308 return -EINVAL; 309 310 /* Complete initialisation of *notify */ 311 if (notify) { 312 notify->irq = irq; 313 kref_init(¬ify->kref); 314 INIT_WORK(¬ify->work, irq_affinity_notify); 315 } 316 317 raw_spin_lock_irqsave(&desc->lock, flags); 318 old_notify = desc->affinity_notify; 319 desc->affinity_notify = notify; 320 raw_spin_unlock_irqrestore(&desc->lock, flags); 321 322 if (old_notify) 323 kref_put(&old_notify->kref, old_notify->release); 324 325 return 0; 326} 327EXPORT_SYMBOL_GPL(irq_set_affinity_notifier); 328 329#ifndef CONFIG_AUTO_IRQ_AFFINITY 330/* 331 * Generic version of the affinity autoselector. 332 */ 333static int setup_affinity(struct irq_desc *desc, struct cpumask *mask) 334{ 335 struct cpumask *set = irq_default_affinity; 336 int node = irq_desc_get_node(desc); 337 338 /* Excludes PER_CPU and NO_BALANCE interrupts */ 339 if (!__irq_can_set_affinity(desc)) 340 return 0; 341 342 /* 343 * Preserve an userspace affinity setup, but make sure that 344 * one of the targets is online. 345 */ 346 if (irqd_has_set(&desc->irq_data, IRQD_AFFINITY_SET)) { 347 if (cpumask_intersects(desc->irq_common_data.affinity, 348 cpu_online_mask)) 349 set = desc->irq_common_data.affinity; 350 else 351 irqd_clear(&desc->irq_data, IRQD_AFFINITY_SET); 352 } 353 354 cpumask_and(mask, cpu_online_mask, set); 355 if (node != NUMA_NO_NODE) { 356 const struct cpumask *nodemask = cpumask_of_node(node); 357 358 /* make sure at least one of the cpus in nodemask is online */ 359 if (cpumask_intersects(mask, nodemask)) 360 cpumask_and(mask, mask, nodemask); 361 } 362 irq_do_set_affinity(&desc->irq_data, mask, false); 363 return 0; 364} 365#else 366/* Wrapper for ALPHA specific affinity selector magic */ 367static inline int setup_affinity(struct irq_desc *d, struct cpumask *mask) 368{ 369 return irq_select_affinity(irq_desc_get_irq(d)); 370} 371#endif 372 373/* 374 * Called when affinity is set via /proc/irq 375 */ 376int irq_select_affinity_usr(unsigned int irq, struct cpumask *mask) 377{ 378 struct irq_desc *desc = irq_to_desc(irq); 379 unsigned long flags; 380 int ret; 381 382 raw_spin_lock_irqsave(&desc->lock, flags); 383 ret = setup_affinity(desc, mask); 384 raw_spin_unlock_irqrestore(&desc->lock, flags); 385 return ret; 386} 387 388#else 389static inline int 390setup_affinity(struct irq_desc *desc, struct cpumask *mask) 391{ 392 return 0; 393} 394#endif 395 396/** 397 * irq_set_vcpu_affinity - Set vcpu affinity for the interrupt 398 * @irq: interrupt number to set affinity 399 * @vcpu_info: vCPU specific data 400 * 401 * This function uses the vCPU specific data to set the vCPU 402 * affinity for an irq. The vCPU specific data is passed from 403 * outside, such as KVM. One example code path is as below: 404 * KVM -> IOMMU -> irq_set_vcpu_affinity(). 405 */ 406int irq_set_vcpu_affinity(unsigned int irq, void *vcpu_info) 407{ 408 unsigned long flags; 409 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0); 410 struct irq_data *data; 411 struct irq_chip *chip; 412 int ret = -ENOSYS; 413 414 if (!desc) 415 return -EINVAL; 416 417 data = irq_desc_get_irq_data(desc); 418 chip = irq_data_get_irq_chip(data); 419 if (chip && chip->irq_set_vcpu_affinity) 420 ret = chip->irq_set_vcpu_affinity(data, vcpu_info); 421 irq_put_desc_unlock(desc, flags); 422 423 return ret; 424} 425EXPORT_SYMBOL_GPL(irq_set_vcpu_affinity); 426 427void __disable_irq(struct irq_desc *desc) 428{ 429 if (!desc->depth++) 430 irq_disable(desc); 431} 432 433static int __disable_irq_nosync(unsigned int irq) 434{ 435 unsigned long flags; 436 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 437 438 if (!desc) 439 return -EINVAL; 440 __disable_irq(desc); 441 irq_put_desc_busunlock(desc, flags); 442 return 0; 443} 444 445/** 446 * disable_irq_nosync - disable an irq without waiting 447 * @irq: Interrupt to disable 448 * 449 * Disable the selected interrupt line. Disables and Enables are 450 * nested. 451 * Unlike disable_irq(), this function does not ensure existing 452 * instances of the IRQ handler have completed before returning. 453 * 454 * This function may be called from IRQ context. 455 */ 456void disable_irq_nosync(unsigned int irq) 457{ 458 __disable_irq_nosync(irq); 459} 460EXPORT_SYMBOL(disable_irq_nosync); 461 462/** 463 * disable_irq - disable an irq and wait for completion 464 * @irq: Interrupt to disable 465 * 466 * Disable the selected interrupt line. Enables and Disables are 467 * nested. 468 * This function waits for any pending IRQ handlers for this interrupt 469 * to complete before returning. If you use this function while 470 * holding a resource the IRQ handler may need you will deadlock. 471 * 472 * This function may be called - with care - from IRQ context. 473 */ 474void disable_irq(unsigned int irq) 475{ 476 if (!__disable_irq_nosync(irq)) 477 synchronize_irq(irq); 478} 479EXPORT_SYMBOL(disable_irq); 480 481/** 482 * disable_hardirq - disables an irq and waits for hardirq completion 483 * @irq: Interrupt to disable 484 * 485 * Disable the selected interrupt line. Enables and Disables are 486 * nested. 487 * This function waits for any pending hard IRQ handlers for this 488 * interrupt to complete before returning. If you use this function while 489 * holding a resource the hard IRQ handler may need you will deadlock. 490 * 491 * When used to optimistically disable an interrupt from atomic context 492 * the return value must be checked. 493 * 494 * Returns: false if a threaded handler is active. 495 * 496 * This function may be called - with care - from IRQ context. 497 */ 498bool disable_hardirq(unsigned int irq) 499{ 500 if (!__disable_irq_nosync(irq)) 501 return synchronize_hardirq(irq); 502 503 return false; 504} 505EXPORT_SYMBOL_GPL(disable_hardirq); 506 507void __enable_irq(struct irq_desc *desc) 508{ 509 switch (desc->depth) { 510 case 0: 511 err_out: 512 WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", 513 irq_desc_get_irq(desc)); 514 break; 515 case 1: { 516 if (desc->istate & IRQS_SUSPENDED) 517 goto err_out; 518 /* Prevent probing on this irq: */ 519 irq_settings_set_noprobe(desc); 520 irq_enable(desc); 521 check_irq_resend(desc); 522 /* fall-through */ 523 } 524 default: 525 desc->depth--; 526 } 527} 528 529/** 530 * enable_irq - enable handling of an irq 531 * @irq: Interrupt to enable 532 * 533 * Undoes the effect of one call to disable_irq(). If this 534 * matches the last disable, processing of interrupts on this 535 * IRQ line is re-enabled. 536 * 537 * This function may be called from IRQ context only when 538 * desc->irq_data.chip->bus_lock and desc->chip->bus_sync_unlock are NULL ! 539 */ 540void enable_irq(unsigned int irq) 541{ 542 unsigned long flags; 543 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 544 545 if (!desc) 546 return; 547 if (WARN(!desc->irq_data.chip, 548 KERN_ERR "enable_irq before setup/request_irq: irq %u\n", irq)) 549 goto out; 550 551 __enable_irq(desc); 552out: 553 irq_put_desc_busunlock(desc, flags); 554} 555EXPORT_SYMBOL(enable_irq); 556 557static int set_irq_wake_real(unsigned int irq, unsigned int on) 558{ 559 struct irq_desc *desc = irq_to_desc(irq); 560 int ret = -ENXIO; 561 562 if (irq_desc_get_chip(desc)->flags & IRQCHIP_SKIP_SET_WAKE) 563 return 0; 564 565 if (desc->irq_data.chip->irq_set_wake) 566 ret = desc->irq_data.chip->irq_set_wake(&desc->irq_data, on); 567 568 return ret; 569} 570 571/** 572 * irq_set_irq_wake - control irq power management wakeup 573 * @irq: interrupt to control 574 * @on: enable/disable power management wakeup 575 * 576 * Enable/disable power management wakeup mode, which is 577 * disabled by default. Enables and disables must match, 578 * just as they match for non-wakeup mode support. 579 * 580 * Wakeup mode lets this IRQ wake the system from sleep 581 * states like "suspend to RAM". 582 */ 583int irq_set_irq_wake(unsigned int irq, unsigned int on) 584{ 585 unsigned long flags; 586 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 587 int ret = 0; 588 589 if (!desc) 590 return -EINVAL; 591 592 /* wakeup-capable irqs can be shared between drivers that 593 * don't need to have the same sleep mode behaviors. 594 */ 595 if (on) { 596 if (desc->wake_depth++ == 0) { 597 ret = set_irq_wake_real(irq, on); 598 if (ret) 599 desc->wake_depth = 0; 600 else 601 irqd_set(&desc->irq_data, IRQD_WAKEUP_STATE); 602 } 603 } else { 604 if (desc->wake_depth == 0) { 605 WARN(1, "Unbalanced IRQ %d wake disable\n", irq); 606 } else if (--desc->wake_depth == 0) { 607 ret = set_irq_wake_real(irq, on); 608 if (ret) 609 desc->wake_depth = 1; 610 else 611 irqd_clear(&desc->irq_data, IRQD_WAKEUP_STATE); 612 } 613 } 614 irq_put_desc_busunlock(desc, flags); 615 return ret; 616} 617EXPORT_SYMBOL(irq_set_irq_wake); 618 619/* 620 * Internal function that tells the architecture code whether a 621 * particular irq has been exclusively allocated or is available 622 * for driver use. 623 */ 624int can_request_irq(unsigned int irq, unsigned long irqflags) 625{ 626 unsigned long flags; 627 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0); 628 int canrequest = 0; 629 630 if (!desc) 631 return 0; 632 633 if (irq_settings_can_request(desc)) { 634 if (!desc->action || 635 irqflags & desc->action->flags & IRQF_SHARED) 636 canrequest = 1; 637 } 638 irq_put_desc_unlock(desc, flags); 639 return canrequest; 640} 641 642int __irq_set_trigger(struct irq_desc *desc, unsigned long flags) 643{ 644 struct irq_chip *chip = desc->irq_data.chip; 645 int ret, unmask = 0; 646 647 if (!chip || !chip->irq_set_type) { 648 /* 649 * IRQF_TRIGGER_* but the PIC does not support multiple 650 * flow-types? 651 */ 652 pr_debug("No set_type function for IRQ %d (%s)\n", 653 irq_desc_get_irq(desc), 654 chip ? (chip->name ? : "unknown") : "unknown"); 655 return 0; 656 } 657 658 flags &= IRQ_TYPE_SENSE_MASK; 659 660 if (chip->flags & IRQCHIP_SET_TYPE_MASKED) { 661 if (!irqd_irq_masked(&desc->irq_data)) 662 mask_irq(desc); 663 if (!irqd_irq_disabled(&desc->irq_data)) 664 unmask = 1; 665 } 666 667 /* caller masked out all except trigger mode flags */ 668 ret = chip->irq_set_type(&desc->irq_data, flags); 669 670 switch (ret) { 671 case IRQ_SET_MASK_OK: 672 case IRQ_SET_MASK_OK_DONE: 673 irqd_clear(&desc->irq_data, IRQD_TRIGGER_MASK); 674 irqd_set(&desc->irq_data, flags); 675 676 case IRQ_SET_MASK_OK_NOCOPY: 677 flags = irqd_get_trigger_type(&desc->irq_data); 678 irq_settings_set_trigger_mask(desc, flags); 679 irqd_clear(&desc->irq_data, IRQD_LEVEL); 680 irq_settings_clr_level(desc); 681 if (flags & IRQ_TYPE_LEVEL_MASK) { 682 irq_settings_set_level(desc); 683 irqd_set(&desc->irq_data, IRQD_LEVEL); 684 } 685 686 ret = 0; 687 break; 688 default: 689 pr_err("Setting trigger mode %lu for irq %u failed (%pF)\n", 690 flags, irq_desc_get_irq(desc), chip->irq_set_type); 691 } 692 if (unmask) 693 unmask_irq(desc); 694 return ret; 695} 696 697#ifdef CONFIG_HARDIRQS_SW_RESEND 698int irq_set_parent(int irq, int parent_irq) 699{ 700 unsigned long flags; 701 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, 0); 702 703 if (!desc) 704 return -EINVAL; 705 706 desc->parent_irq = parent_irq; 707 708 irq_put_desc_unlock(desc, flags); 709 return 0; 710} 711#endif 712 713/* 714 * Default primary interrupt handler for threaded interrupts. Is 715 * assigned as primary handler when request_threaded_irq is called 716 * with handler == NULL. Useful for oneshot interrupts. 717 */ 718static irqreturn_t irq_default_primary_handler(int irq, void *dev_id) 719{ 720 return IRQ_WAKE_THREAD; 721} 722 723/* 724 * Primary handler for nested threaded interrupts. Should never be 725 * called. 726 */ 727static irqreturn_t irq_nested_primary_handler(int irq, void *dev_id) 728{ 729 WARN(1, "Primary handler called for nested irq %d\n", irq); 730 return IRQ_NONE; 731} 732 733static irqreturn_t irq_forced_secondary_handler(int irq, void *dev_id) 734{ 735 WARN(1, "Secondary action handler called for irq %d\n", irq); 736 return IRQ_NONE; 737} 738 739static int irq_wait_for_interrupt(struct irqaction *action) 740{ 741 set_current_state(TASK_INTERRUPTIBLE); 742 743 while (!kthread_should_stop()) { 744 745 if (test_and_clear_bit(IRQTF_RUNTHREAD, 746 &action->thread_flags)) { 747 __set_current_state(TASK_RUNNING); 748 return 0; 749 } 750 schedule(); 751 set_current_state(TASK_INTERRUPTIBLE); 752 } 753 __set_current_state(TASK_RUNNING); 754 return -1; 755} 756 757/* 758 * Oneshot interrupts keep the irq line masked until the threaded 759 * handler finished. unmask if the interrupt has not been disabled and 760 * is marked MASKED. 761 */ 762static void irq_finalize_oneshot(struct irq_desc *desc, 763 struct irqaction *action) 764{ 765 if (!(desc->istate & IRQS_ONESHOT) || 766 action->handler == irq_forced_secondary_handler) 767 return; 768again: 769 chip_bus_lock(desc); 770 raw_spin_lock_irq(&desc->lock); 771 772 /* 773 * Implausible though it may be we need to protect us against 774 * the following scenario: 775 * 776 * The thread is faster done than the hard interrupt handler 777 * on the other CPU. If we unmask the irq line then the 778 * interrupt can come in again and masks the line, leaves due 779 * to IRQS_INPROGRESS and the irq line is masked forever. 780 * 781 * This also serializes the state of shared oneshot handlers 782 * versus "desc->threads_onehsot |= action->thread_mask;" in 783 * irq_wake_thread(). See the comment there which explains the 784 * serialization. 785 */ 786 if (unlikely(irqd_irq_inprogress(&desc->irq_data))) { 787 raw_spin_unlock_irq(&desc->lock); 788 chip_bus_sync_unlock(desc); 789 cpu_relax(); 790 goto again; 791 } 792 793 /* 794 * Now check again, whether the thread should run. Otherwise 795 * we would clear the threads_oneshot bit of this thread which 796 * was just set. 797 */ 798 if (test_bit(IRQTF_RUNTHREAD, &action->thread_flags)) 799 goto out_unlock; 800 801 desc->threads_oneshot &= ~action->thread_mask; 802 803 if (!desc->threads_oneshot && !irqd_irq_disabled(&desc->irq_data) && 804 irqd_irq_masked(&desc->irq_data)) 805 unmask_threaded_irq(desc); 806 807out_unlock: 808 raw_spin_unlock_irq(&desc->lock); 809 chip_bus_sync_unlock(desc); 810} 811 812#ifdef CONFIG_SMP 813/* 814 * Check whether we need to change the affinity of the interrupt thread. 815 */ 816static void 817irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) 818{ 819 cpumask_var_t mask; 820 bool valid = true; 821 822 if (!test_and_clear_bit(IRQTF_AFFINITY, &action->thread_flags)) 823 return; 824 825 /* 826 * In case we are out of memory we set IRQTF_AFFINITY again and 827 * try again next time 828 */ 829 if (!alloc_cpumask_var(&mask, GFP_KERNEL)) { 830 set_bit(IRQTF_AFFINITY, &action->thread_flags); 831 return; 832 } 833 834 raw_spin_lock_irq(&desc->lock); 835 /* 836 * This code is triggered unconditionally. Check the affinity 837 * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out. 838 */ 839 if (desc->irq_common_data.affinity) 840 cpumask_copy(mask, desc->irq_common_data.affinity); 841 else 842 valid = false; 843 raw_spin_unlock_irq(&desc->lock); 844 845 if (valid) 846 set_cpus_allowed_ptr(current, mask); 847 free_cpumask_var(mask); 848} 849#else 850static inline void 851irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) { } 852#endif 853 854/* 855 * Interrupts which are not explicitely requested as threaded 856 * interrupts rely on the implicit bh/preempt disable of the hard irq 857 * context. So we need to disable bh here to avoid deadlocks and other 858 * side effects. 859 */ 860static irqreturn_t 861irq_forced_thread_fn(struct irq_desc *desc, struct irqaction *action) 862{ 863 irqreturn_t ret; 864 865 local_bh_disable(); 866 ret = action->thread_fn(action->irq, action->dev_id); 867 irq_finalize_oneshot(desc, action); 868 local_bh_enable(); 869 return ret; 870} 871 872/* 873 * Interrupts explicitly requested as threaded interrupts want to be 874 * preemtible - many of them need to sleep and wait for slow busses to 875 * complete. 876 */ 877static irqreturn_t irq_thread_fn(struct irq_desc *desc, 878 struct irqaction *action) 879{ 880 irqreturn_t ret; 881 882 ret = action->thread_fn(action->irq, action->dev_id); 883 irq_finalize_oneshot(desc, action); 884 return ret; 885} 886 887static void wake_threads_waitq(struct irq_desc *desc) 888{ 889 if (atomic_dec_and_test(&desc->threads_active)) 890 wake_up(&desc->wait_for_threads); 891} 892 893static void irq_thread_dtor(struct callback_head *unused) 894{ 895 struct task_struct *tsk = current; 896 struct irq_desc *desc; 897 struct irqaction *action; 898 899 if (WARN_ON_ONCE(!(current->flags & PF_EXITING))) 900 return; 901 902 action = kthread_data(tsk); 903 904 pr_err("exiting task \"%s\" (%d) is an active IRQ thread (irq %d)\n", 905 tsk->comm, tsk->pid, action->irq); 906 907 908 desc = irq_to_desc(action->irq); 909 /* 910 * If IRQTF_RUNTHREAD is set, we need to decrement 911 * desc->threads_active and wake possible waiters. 912 */ 913 if (test_and_clear_bit(IRQTF_RUNTHREAD, &action->thread_flags)) 914 wake_threads_waitq(desc); 915 916 /* Prevent a stale desc->threads_oneshot */ 917 irq_finalize_oneshot(desc, action); 918} 919 920static void irq_wake_secondary(struct irq_desc *desc, struct irqaction *action) 921{ 922 struct irqaction *secondary = action->secondary; 923 924 if (WARN_ON_ONCE(!secondary)) 925 return; 926 927 raw_spin_lock_irq(&desc->lock); 928 __irq_wake_thread(desc, secondary); 929 raw_spin_unlock_irq(&desc->lock); 930} 931 932/* 933 * Interrupt handler thread 934 */ 935static int irq_thread(void *data) 936{ 937 struct callback_head on_exit_work; 938 struct irqaction *action = data; 939 struct irq_desc *desc = irq_to_desc(action->irq); 940 irqreturn_t (*handler_fn)(struct irq_desc *desc, 941 struct irqaction *action); 942 943 if (force_irqthreads && test_bit(IRQTF_FORCED_THREAD, 944 &action->thread_flags)) 945 handler_fn = irq_forced_thread_fn; 946 else 947 handler_fn = irq_thread_fn; 948 949 init_task_work(&on_exit_work, irq_thread_dtor); 950 task_work_add(current, &on_exit_work, false); 951 952 irq_thread_check_affinity(desc, action); 953 954 while (!irq_wait_for_interrupt(action)) { 955 irqreturn_t action_ret; 956 957 irq_thread_check_affinity(desc, action); 958 959 action_ret = handler_fn(desc, action); 960 if (action_ret == IRQ_HANDLED) 961 atomic_inc(&desc->threads_handled); 962 if (action_ret == IRQ_WAKE_THREAD) 963 irq_wake_secondary(desc, action); 964 965 wake_threads_waitq(desc); 966 } 967 968 /* 969 * This is the regular exit path. __free_irq() is stopping the 970 * thread via kthread_stop() after calling 971 * synchronize_irq(). So neither IRQTF_RUNTHREAD nor the 972 * oneshot mask bit can be set. We cannot verify that as we 973 * cannot touch the oneshot mask at this point anymore as 974 * __setup_irq() might have given out currents thread_mask 975 * again. 976 */ 977 task_work_cancel(current, irq_thread_dtor); 978 return 0; 979} 980 981/** 982 * irq_wake_thread - wake the irq thread for the action identified by dev_id 983 * @irq: Interrupt line 984 * @dev_id: Device identity for which the thread should be woken 985 * 986 */ 987void irq_wake_thread(unsigned int irq, void *dev_id) 988{ 989 struct irq_desc *desc = irq_to_desc(irq); 990 struct irqaction *action; 991 unsigned long flags; 992 993 if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc))) 994 return; 995 996 raw_spin_lock_irqsave(&desc->lock, flags); 997 for (action = desc->action; action; action = action->next) { 998 if (action->dev_id == dev_id) { 999 if (action->thread) 1000 __irq_wake_thread(desc, action); 1001 break; 1002 } 1003 } 1004 raw_spin_unlock_irqrestore(&desc->lock, flags); 1005} 1006EXPORT_SYMBOL_GPL(irq_wake_thread); 1007 1008static int irq_setup_forced_threading(struct irqaction *new) 1009{ 1010 if (!force_irqthreads) 1011 return 0; 1012 if (new->flags & (IRQF_NO_THREAD | IRQF_PERCPU | IRQF_ONESHOT)) 1013 return 0; 1014 1015 new->flags |= IRQF_ONESHOT; 1016 1017 /* 1018 * Handle the case where we have a real primary handler and a 1019 * thread handler. We force thread them as well by creating a 1020 * secondary action. 1021 */ 1022 if (new->handler != irq_default_primary_handler && new->thread_fn) { 1023 /* Allocate the secondary action */ 1024 new->secondary = kzalloc(sizeof(struct irqaction), GFP_KERNEL); 1025 if (!new->secondary) 1026 return -ENOMEM; 1027 new->secondary->handler = irq_forced_secondary_handler; 1028 new->secondary->thread_fn = new->thread_fn; 1029 new->secondary->dev_id = new->dev_id; 1030 new->secondary->irq = new->irq; 1031 new->secondary->name = new->name; 1032 } 1033 /* Deal with the primary handler */ 1034 set_bit(IRQTF_FORCED_THREAD, &new->thread_flags); 1035 new->thread_fn = new->handler; 1036 new->handler = irq_default_primary_handler; 1037 return 0; 1038} 1039 1040static int irq_request_resources(struct irq_desc *desc) 1041{ 1042 struct irq_data *d = &desc->irq_data; 1043 struct irq_chip *c = d->chip; 1044 1045 return c->irq_request_resources ? c->irq_request_resources(d) : 0; 1046} 1047 1048static void irq_release_resources(struct irq_desc *desc) 1049{ 1050 struct irq_data *d = &desc->irq_data; 1051 struct irq_chip *c = d->chip; 1052 1053 if (c->irq_release_resources) 1054 c->irq_release_resources(d); 1055} 1056 1057static int 1058setup_irq_thread(struct irqaction *new, unsigned int irq, bool secondary) 1059{ 1060 struct task_struct *t; 1061 struct sched_param param = { 1062 .sched_priority = MAX_USER_RT_PRIO/2, 1063 }; 1064 1065 if (!secondary) { 1066 t = kthread_create(irq_thread, new, "irq/%d-%s", irq, 1067 new->name); 1068 } else { 1069 t = kthread_create(irq_thread, new, "irq/%d-s-%s", irq, 1070 new->name); 1071 param.sched_priority -= 1; 1072 } 1073 1074 if (IS_ERR(t)) 1075 return PTR_ERR(t); 1076 1077 sched_setscheduler_nocheck(t, SCHED_FIFO, ¶m); 1078 1079 /* 1080 * We keep the reference to the task struct even if 1081 * the thread dies to avoid that the interrupt code 1082 * references an already freed task_struct. 1083 */ 1084 get_task_struct(t); 1085 new->thread = t; 1086 /* 1087 * Tell the thread to set its affinity. This is 1088 * important for shared interrupt handlers as we do 1089 * not invoke setup_affinity() for the secondary 1090 * handlers as everything is already set up. Even for 1091 * interrupts marked with IRQF_NO_BALANCE this is 1092 * correct as we want the thread to move to the cpu(s) 1093 * on which the requesting code placed the interrupt. 1094 */ 1095 set_bit(IRQTF_AFFINITY, &new->thread_flags); 1096 return 0; 1097} 1098 1099/* 1100 * Internal function to register an irqaction - typically used to 1101 * allocate special interrupts that are part of the architecture. 1102 */ 1103static int 1104__setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new) 1105{ 1106 struct irqaction *old, **old_ptr; 1107 unsigned long flags, thread_mask = 0; 1108 int ret, nested, shared = 0; 1109 cpumask_var_t mask; 1110 1111 if (!desc) 1112 return -EINVAL; 1113 1114 if (desc->irq_data.chip == &no_irq_chip) 1115 return -ENOSYS; 1116 if (!try_module_get(desc->owner)) 1117 return -ENODEV; 1118 1119 new->irq = irq; 1120 1121 /* 1122 * Check whether the interrupt nests into another interrupt 1123 * thread. 1124 */ 1125 nested = irq_settings_is_nested_thread(desc); 1126 if (nested) { 1127 if (!new->thread_fn) { 1128 ret = -EINVAL; 1129 goto out_mput; 1130 } 1131 /* 1132 * Replace the primary handler which was provided from 1133 * the driver for non nested interrupt handling by the 1134 * dummy function which warns when called. 1135 */ 1136 new->handler = irq_nested_primary_handler; 1137 } else { 1138 if (irq_settings_can_thread(desc)) { 1139 ret = irq_setup_forced_threading(new); 1140 if (ret) 1141 goto out_mput; 1142 } 1143 } 1144 1145 /* 1146 * Create a handler thread when a thread function is supplied 1147 * and the interrupt does not nest into another interrupt 1148 * thread. 1149 */ 1150 if (new->thread_fn && !nested) { 1151 ret = setup_irq_thread(new, irq, false); 1152 if (ret) 1153 goto out_mput; 1154 if (new->secondary) { 1155 ret = setup_irq_thread(new->secondary, irq, true); 1156 if (ret) 1157 goto out_thread; 1158 } 1159 } 1160 1161 if (!alloc_cpumask_var(&mask, GFP_KERNEL)) { 1162 ret = -ENOMEM; 1163 goto out_thread; 1164 } 1165 1166 /* 1167 * Drivers are often written to work w/o knowledge about the 1168 * underlying irq chip implementation, so a request for a 1169 * threaded irq without a primary hard irq context handler 1170 * requires the ONESHOT flag to be set. Some irq chips like 1171 * MSI based interrupts are per se one shot safe. Check the 1172 * chip flags, so we can avoid the unmask dance at the end of 1173 * the threaded handler for those. 1174 */ 1175 if (desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE) 1176 new->flags &= ~IRQF_ONESHOT; 1177 1178 /* 1179 * The following block of code has to be executed atomically 1180 */ 1181 raw_spin_lock_irqsave(&desc->lock, flags); 1182 old_ptr = &desc->action; 1183 old = *old_ptr; 1184 if (old) { 1185 /* 1186 * Can't share interrupts unless both agree to and are 1187 * the same type (level, edge, polarity). So both flag 1188 * fields must have IRQF_SHARED set and the bits which 1189 * set the trigger type must match. Also all must 1190 * agree on ONESHOT. 1191 */ 1192 if (!((old->flags & new->flags) & IRQF_SHARED) || 1193 ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) || 1194 ((old->flags ^ new->flags) & IRQF_ONESHOT)) 1195 goto mismatch; 1196 1197 /* All handlers must agree on per-cpuness */ 1198 if ((old->flags & IRQF_PERCPU) != 1199 (new->flags & IRQF_PERCPU)) 1200 goto mismatch; 1201 1202 /* add new interrupt at end of irq queue */ 1203 do { 1204 /* 1205 * Or all existing action->thread_mask bits, 1206 * so we can find the next zero bit for this 1207 * new action. 1208 */ 1209 thread_mask |= old->thread_mask; 1210 old_ptr = &old->next; 1211 old = *old_ptr; 1212 } while (old); 1213 shared = 1; 1214 } 1215 1216 /* 1217 * Setup the thread mask for this irqaction for ONESHOT. For 1218 * !ONESHOT irqs the thread mask is 0 so we can avoid a 1219 * conditional in irq_wake_thread(). 1220 */ 1221 if (new->flags & IRQF_ONESHOT) { 1222 /* 1223 * Unlikely to have 32 resp 64 irqs sharing one line, 1224 * but who knows. 1225 */ 1226 if (thread_mask == ~0UL) { 1227 ret = -EBUSY; 1228 goto out_mask; 1229 } 1230 /* 1231 * The thread_mask for the action is or'ed to 1232 * desc->thread_active to indicate that the 1233 * IRQF_ONESHOT thread handler has been woken, but not 1234 * yet finished. The bit is cleared when a thread 1235 * completes. When all threads of a shared interrupt 1236 * line have completed desc->threads_active becomes 1237 * zero and the interrupt line is unmasked. See 1238 * handle.c:irq_wake_thread() for further information. 1239 * 1240 * If no thread is woken by primary (hard irq context) 1241 * interrupt handlers, then desc->threads_active is 1242 * also checked for zero to unmask the irq line in the 1243 * affected hard irq flow handlers 1244 * (handle_[fasteoi|level]_irq). 1245 * 1246 * The new action gets the first zero bit of 1247 * thread_mask assigned. See the loop above which or's 1248 * all existing action->thread_mask bits. 1249 */ 1250 new->thread_mask = 1 << ffz(thread_mask); 1251 1252 } else if (new->handler == irq_default_primary_handler && 1253 !(desc->irq_data.chip->flags & IRQCHIP_ONESHOT_SAFE)) { 1254 /* 1255 * The interrupt was requested with handler = NULL, so 1256 * we use the default primary handler for it. But it 1257 * does not have the oneshot flag set. In combination 1258 * with level interrupts this is deadly, because the 1259 * default primary handler just wakes the thread, then 1260 * the irq lines is reenabled, but the device still 1261 * has the level irq asserted. Rinse and repeat.... 1262 * 1263 * While this works for edge type interrupts, we play 1264 * it safe and reject unconditionally because we can't 1265 * say for sure which type this interrupt really 1266 * has. The type flags are unreliable as the 1267 * underlying chip implementation can override them. 1268 */ 1269 pr_err("Threaded irq requested with handler=NULL and !ONESHOT for irq %d\n", 1270 irq); 1271 ret = -EINVAL; 1272 goto out_mask; 1273 } 1274 1275 if (!shared) { 1276 ret = irq_request_resources(desc); 1277 if (ret) { 1278 pr_err("Failed to request resources for %s (irq %d) on irqchip %s\n", 1279 new->name, irq, desc->irq_data.chip->name); 1280 goto out_mask; 1281 } 1282 1283 init_waitqueue_head(&desc->wait_for_threads); 1284 1285 /* Setup the type (level, edge polarity) if configured: */ 1286 if (new->flags & IRQF_TRIGGER_MASK) { 1287 ret = __irq_set_trigger(desc, 1288 new->flags & IRQF_TRIGGER_MASK); 1289 1290 if (ret) 1291 goto out_mask; 1292 } 1293 1294 desc->istate &= ~(IRQS_AUTODETECT | IRQS_SPURIOUS_DISABLED | \ 1295 IRQS_ONESHOT | IRQS_WAITING); 1296 irqd_clear(&desc->irq_data, IRQD_IRQ_INPROGRESS); 1297 1298 if (new->flags & IRQF_PERCPU) { 1299 irqd_set(&desc->irq_data, IRQD_PER_CPU); 1300 irq_settings_set_per_cpu(desc); 1301 } 1302 1303 if (new->flags & IRQF_ONESHOT) 1304 desc->istate |= IRQS_ONESHOT; 1305 1306 if (irq_settings_can_autoenable(desc)) 1307 irq_startup(desc, true); 1308 else 1309 /* Undo nested disables: */ 1310 desc->depth = 1; 1311 1312 /* Exclude IRQ from balancing if requested */ 1313 if (new->flags & IRQF_NOBALANCING) { 1314 irq_settings_set_no_balancing(desc); 1315 irqd_set(&desc->irq_data, IRQD_NO_BALANCING); 1316 } 1317 1318 /* Set default affinity mask once everything is setup */ 1319 setup_affinity(desc, mask); 1320 1321 } else if (new->flags & IRQF_TRIGGER_MASK) { 1322 unsigned int nmsk = new->flags & IRQF_TRIGGER_MASK; 1323 unsigned int omsk = irq_settings_get_trigger_mask(desc); 1324 1325 if (nmsk != omsk) 1326 /* hope the handler works with current trigger mode */ 1327 pr_warning("irq %d uses trigger mode %u; requested %u\n", 1328 irq, nmsk, omsk); 1329 } 1330 1331 *old_ptr = new; 1332 1333 irq_pm_install_action(desc, new); 1334 1335 /* Reset broken irq detection when installing new handler */ 1336 desc->irq_count = 0; 1337 desc->irqs_unhandled = 0; 1338 1339 /* 1340 * Check whether we disabled the irq via the spurious handler 1341 * before. Reenable it and give it another chance. 1342 */ 1343 if (shared && (desc->istate & IRQS_SPURIOUS_DISABLED)) { 1344 desc->istate &= ~IRQS_SPURIOUS_DISABLED; 1345 __enable_irq(desc); 1346 } 1347 1348 raw_spin_unlock_irqrestore(&desc->lock, flags); 1349 1350 /* 1351 * Strictly no need to wake it up, but hung_task complains 1352 * when no hard interrupt wakes the thread up. 1353 */ 1354 if (new->thread) 1355 wake_up_process(new->thread); 1356 if (new->secondary) 1357 wake_up_process(new->secondary->thread); 1358 1359 register_irq_proc(irq, desc); 1360 new->dir = NULL; 1361 register_handler_proc(irq, new); 1362 free_cpumask_var(mask); 1363 1364 return 0; 1365 1366mismatch: 1367 if (!(new->flags & IRQF_PROBE_SHARED)) { 1368 pr_err("Flags mismatch irq %d. %08x (%s) vs. %08x (%s)\n", 1369 irq, new->flags, new->name, old->flags, old->name); 1370#ifdef CONFIG_DEBUG_SHIRQ 1371 dump_stack(); 1372#endif 1373 } 1374 ret = -EBUSY; 1375 1376out_mask: 1377 raw_spin_unlock_irqrestore(&desc->lock, flags); 1378 free_cpumask_var(mask); 1379 1380out_thread: 1381 if (new->thread) { 1382 struct task_struct *t = new->thread; 1383 1384 new->thread = NULL; 1385 kthread_stop(t); 1386 put_task_struct(t); 1387 } 1388 if (new->secondary && new->secondary->thread) { 1389 struct task_struct *t = new->secondary->thread; 1390 1391 new->secondary->thread = NULL; 1392 kthread_stop(t); 1393 put_task_struct(t); 1394 } 1395out_mput: 1396 module_put(desc->owner); 1397 return ret; 1398} 1399 1400/** 1401 * setup_irq - setup an interrupt 1402 * @irq: Interrupt line to setup 1403 * @act: irqaction for the interrupt 1404 * 1405 * Used to statically setup interrupts in the early boot process. 1406 */ 1407int setup_irq(unsigned int irq, struct irqaction *act) 1408{ 1409 int retval; 1410 struct irq_desc *desc = irq_to_desc(irq); 1411 1412 if (WARN_ON(irq_settings_is_per_cpu_devid(desc))) 1413 return -EINVAL; 1414 chip_bus_lock(desc); 1415 retval = __setup_irq(irq, desc, act); 1416 chip_bus_sync_unlock(desc); 1417 1418 return retval; 1419} 1420EXPORT_SYMBOL_GPL(setup_irq); 1421 1422/* 1423 * Internal function to unregister an irqaction - used to free 1424 * regular and special interrupts that are part of the architecture. 1425 */ 1426static struct irqaction *__free_irq(unsigned int irq, void *dev_id) 1427{ 1428 struct irq_desc *desc = irq_to_desc(irq); 1429 struct irqaction *action, **action_ptr; 1430 unsigned long flags; 1431 1432 WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq); 1433 1434 if (!desc) 1435 return NULL; 1436 1437 chip_bus_lock(desc); 1438 raw_spin_lock_irqsave(&desc->lock, flags); 1439 1440 /* 1441 * There can be multiple actions per IRQ descriptor, find the right 1442 * one based on the dev_id: 1443 */ 1444 action_ptr = &desc->action; 1445 for (;;) { 1446 action = *action_ptr; 1447 1448 if (!action) { 1449 WARN(1, "Trying to free already-free IRQ %d\n", irq); 1450 raw_spin_unlock_irqrestore(&desc->lock, flags); 1451 chip_bus_sync_unlock(desc); 1452 return NULL; 1453 } 1454 1455 if (action->dev_id == dev_id) 1456 break; 1457 action_ptr = &action->next; 1458 } 1459 1460 /* Found it - now remove it from the list of entries: */ 1461 *action_ptr = action->next; 1462 1463 irq_pm_remove_action(desc, action); 1464 1465 /* If this was the last handler, shut down the IRQ line: */ 1466 if (!desc->action) { 1467 irq_settings_clr_disable_unlazy(desc); 1468 irq_shutdown(desc); 1469 irq_release_resources(desc); 1470 } 1471 1472#ifdef CONFIG_SMP 1473 /* make sure affinity_hint is cleaned up */ 1474 if (WARN_ON_ONCE(desc->affinity_hint)) 1475 desc->affinity_hint = NULL; 1476#endif 1477 1478 raw_spin_unlock_irqrestore(&desc->lock, flags); 1479 chip_bus_sync_unlock(desc); 1480 1481 unregister_handler_proc(irq, action); 1482 1483 /* Make sure it's not being used on another CPU: */ 1484 synchronize_irq(irq); 1485 1486#ifdef CONFIG_DEBUG_SHIRQ 1487 /* 1488 * It's a shared IRQ -- the driver ought to be prepared for an IRQ 1489 * event to happen even now it's being freed, so let's make sure that 1490 * is so by doing an extra call to the handler .... 1491 * 1492 * ( We do this after actually deregistering it, to make sure that a 1493 * 'real' IRQ doesn't run in * parallel with our fake. ) 1494 */ 1495 if (action->flags & IRQF_SHARED) { 1496 local_irq_save(flags); 1497 action->handler(irq, dev_id); 1498 local_irq_restore(flags); 1499 } 1500#endif 1501 1502 if (action->thread) { 1503 kthread_stop(action->thread); 1504 put_task_struct(action->thread); 1505 if (action->secondary && action->secondary->thread) { 1506 kthread_stop(action->secondary->thread); 1507 put_task_struct(action->secondary->thread); 1508 } 1509 } 1510 1511 module_put(desc->owner); 1512 kfree(action->secondary); 1513 return action; 1514} 1515 1516/** 1517 * remove_irq - free an interrupt 1518 * @irq: Interrupt line to free 1519 * @act: irqaction for the interrupt 1520 * 1521 * Used to remove interrupts statically setup by the early boot process. 1522 */ 1523void remove_irq(unsigned int irq, struct irqaction *act) 1524{ 1525 struct irq_desc *desc = irq_to_desc(irq); 1526 1527 if (desc && !WARN_ON(irq_settings_is_per_cpu_devid(desc))) 1528 __free_irq(irq, act->dev_id); 1529} 1530EXPORT_SYMBOL_GPL(remove_irq); 1531 1532/** 1533 * free_irq - free an interrupt allocated with request_irq 1534 * @irq: Interrupt line to free 1535 * @dev_id: Device identity to free 1536 * 1537 * Remove an interrupt handler. The handler is removed and if the 1538 * interrupt line is no longer in use by any driver it is disabled. 1539 * On a shared IRQ the caller must ensure the interrupt is disabled 1540 * on the card it drives before calling this function. The function 1541 * does not return until any executing interrupts for this IRQ 1542 * have completed. 1543 * 1544 * This function must not be called from interrupt context. 1545 */ 1546void free_irq(unsigned int irq, void *dev_id) 1547{ 1548 struct irq_desc *desc = irq_to_desc(irq); 1549 1550 if (!desc || WARN_ON(irq_settings_is_per_cpu_devid(desc))) 1551 return; 1552 1553#ifdef CONFIG_SMP 1554 if (WARN_ON(desc->affinity_notify)) 1555 desc->affinity_notify = NULL; 1556#endif 1557 1558 kfree(__free_irq(irq, dev_id)); 1559} 1560EXPORT_SYMBOL(free_irq); 1561 1562/** 1563 * request_threaded_irq - allocate an interrupt line 1564 * @irq: Interrupt line to allocate 1565 * @handler: Function to be called when the IRQ occurs. 1566 * Primary handler for threaded interrupts 1567 * If NULL and thread_fn != NULL the default 1568 * primary handler is installed 1569 * @thread_fn: Function called from the irq handler thread 1570 * If NULL, no irq thread is created 1571 * @irqflags: Interrupt type flags 1572 * @devname: An ascii name for the claiming device 1573 * @dev_id: A cookie passed back to the handler function 1574 * 1575 * This call allocates interrupt resources and enables the 1576 * interrupt line and IRQ handling. From the point this 1577 * call is made your handler function may be invoked. Since 1578 * your handler function must clear any interrupt the board 1579 * raises, you must take care both to initialise your hardware 1580 * and to set up the interrupt handler in the right order. 1581 * 1582 * If you want to set up a threaded irq handler for your device 1583 * then you need to supply @handler and @thread_fn. @handler is 1584 * still called in hard interrupt context and has to check 1585 * whether the interrupt originates from the device. If yes it 1586 * needs to disable the interrupt on the device and return 1587 * IRQ_WAKE_THREAD which will wake up the handler thread and run 1588 * @thread_fn. This split handler design is necessary to support 1589 * shared interrupts. 1590 * 1591 * Dev_id must be globally unique. Normally the address of the 1592 * device data structure is used as the cookie. Since the handler 1593 * receives this value it makes sense to use it. 1594 * 1595 * If your interrupt is shared you must pass a non NULL dev_id 1596 * as this is required when freeing the interrupt. 1597 * 1598 * Flags: 1599 * 1600 * IRQF_SHARED Interrupt is shared 1601 * IRQF_TRIGGER_* Specify active edge(s) or level 1602 * 1603 */ 1604int request_threaded_irq(unsigned int irq, irq_handler_t handler, 1605 irq_handler_t thread_fn, unsigned long irqflags, 1606 const char *devname, void *dev_id) 1607{ 1608 struct irqaction *action; 1609 struct irq_desc *desc; 1610 int retval; 1611 1612 /* 1613 * Sanity-check: shared interrupts must pass in a real dev-ID, 1614 * otherwise we'll have trouble later trying to figure out 1615 * which interrupt is which (messes up the interrupt freeing 1616 * logic etc). 1617 * 1618 * Also IRQF_COND_SUSPEND only makes sense for shared interrupts and 1619 * it cannot be set along with IRQF_NO_SUSPEND. 1620 */ 1621 if (((irqflags & IRQF_SHARED) && !dev_id) || 1622 (!(irqflags & IRQF_SHARED) && (irqflags & IRQF_COND_SUSPEND)) || 1623 ((irqflags & IRQF_NO_SUSPEND) && (irqflags & IRQF_COND_SUSPEND))) 1624 return -EINVAL; 1625 1626 desc = irq_to_desc(irq); 1627 if (!desc) 1628 return -EINVAL; 1629 1630 if (!irq_settings_can_request(desc) || 1631 WARN_ON(irq_settings_is_per_cpu_devid(desc))) 1632 return -EINVAL; 1633 1634 if (!handler) { 1635 if (!thread_fn) 1636 return -EINVAL; 1637 handler = irq_default_primary_handler; 1638 } 1639 1640 action = kzalloc(sizeof(struct irqaction), GFP_KERNEL); 1641 if (!action) 1642 return -ENOMEM; 1643 1644 action->handler = handler; 1645 action->thread_fn = thread_fn; 1646 action->flags = irqflags; 1647 action->name = devname; 1648 action->dev_id = dev_id; 1649 1650 chip_bus_lock(desc); 1651 retval = __setup_irq(irq, desc, action); 1652 chip_bus_sync_unlock(desc); 1653 1654 if (retval) { 1655 kfree(action->secondary); 1656 kfree(action); 1657 } 1658 1659#ifdef CONFIG_DEBUG_SHIRQ_FIXME 1660 if (!retval && (irqflags & IRQF_SHARED)) { 1661 /* 1662 * It's a shared IRQ -- the driver ought to be prepared for it 1663 * to happen immediately, so let's make sure.... 1664 * We disable the irq to make sure that a 'real' IRQ doesn't 1665 * run in parallel with our fake. 1666 */ 1667 unsigned long flags; 1668 1669 disable_irq(irq); 1670 local_irq_save(flags); 1671 1672 handler(irq, dev_id); 1673 1674 local_irq_restore(flags); 1675 enable_irq(irq); 1676 } 1677#endif 1678 return retval; 1679} 1680EXPORT_SYMBOL(request_threaded_irq); 1681 1682/** 1683 * request_any_context_irq - allocate an interrupt line 1684 * @irq: Interrupt line to allocate 1685 * @handler: Function to be called when the IRQ occurs. 1686 * Threaded handler for threaded interrupts. 1687 * @flags: Interrupt type flags 1688 * @name: An ascii name for the claiming device 1689 * @dev_id: A cookie passed back to the handler function 1690 * 1691 * This call allocates interrupt resources and enables the 1692 * interrupt line and IRQ handling. It selects either a 1693 * hardirq or threaded handling method depending on the 1694 * context. 1695 * 1696 * On failure, it returns a negative value. On success, 1697 * it returns either IRQC_IS_HARDIRQ or IRQC_IS_NESTED. 1698 */ 1699int request_any_context_irq(unsigned int irq, irq_handler_t handler, 1700 unsigned long flags, const char *name, void *dev_id) 1701{ 1702 struct irq_desc *desc = irq_to_desc(irq); 1703 int ret; 1704 1705 if (!desc) 1706 return -EINVAL; 1707 1708 if (irq_settings_is_nested_thread(desc)) { 1709 ret = request_threaded_irq(irq, NULL, handler, 1710 flags, name, dev_id); 1711 return !ret ? IRQC_IS_NESTED : ret; 1712 } 1713 1714 ret = request_irq(irq, handler, flags, name, dev_id); 1715 return !ret ? IRQC_IS_HARDIRQ : ret; 1716} 1717EXPORT_SYMBOL_GPL(request_any_context_irq); 1718 1719void enable_percpu_irq(unsigned int irq, unsigned int type) 1720{ 1721 unsigned int cpu = smp_processor_id(); 1722 unsigned long flags; 1723 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU); 1724 1725 if (!desc) 1726 return; 1727 1728 type &= IRQ_TYPE_SENSE_MASK; 1729 if (type != IRQ_TYPE_NONE) { 1730 int ret; 1731 1732 ret = __irq_set_trigger(desc, type); 1733 1734 if (ret) { 1735 WARN(1, "failed to set type for IRQ%d\n", irq); 1736 goto out; 1737 } 1738 } 1739 1740 irq_percpu_enable(desc, cpu); 1741out: 1742 irq_put_desc_unlock(desc, flags); 1743} 1744EXPORT_SYMBOL_GPL(enable_percpu_irq); 1745 1746void disable_percpu_irq(unsigned int irq) 1747{ 1748 unsigned int cpu = smp_processor_id(); 1749 unsigned long flags; 1750 struct irq_desc *desc = irq_get_desc_lock(irq, &flags, IRQ_GET_DESC_CHECK_PERCPU); 1751 1752 if (!desc) 1753 return; 1754 1755 irq_percpu_disable(desc, cpu); 1756 irq_put_desc_unlock(desc, flags); 1757} 1758EXPORT_SYMBOL_GPL(disable_percpu_irq); 1759 1760/* 1761 * Internal function to unregister a percpu irqaction. 1762 */ 1763static struct irqaction *__free_percpu_irq(unsigned int irq, void __percpu *dev_id) 1764{ 1765 struct irq_desc *desc = irq_to_desc(irq); 1766 struct irqaction *action; 1767 unsigned long flags; 1768 1769 WARN(in_interrupt(), "Trying to free IRQ %d from IRQ context!\n", irq); 1770 1771 if (!desc) 1772 return NULL; 1773 1774 raw_spin_lock_irqsave(&desc->lock, flags); 1775 1776 action = desc->action; 1777 if (!action || action->percpu_dev_id != dev_id) { 1778 WARN(1, "Trying to free already-free IRQ %d\n", irq); 1779 goto bad; 1780 } 1781 1782 if (!cpumask_empty(desc->percpu_enabled)) { 1783 WARN(1, "percpu IRQ %d still enabled on CPU%d!\n", 1784 irq, cpumask_first(desc->percpu_enabled)); 1785 goto bad; 1786 } 1787 1788 /* Found it - now remove it from the list of entries: */ 1789 desc->action = NULL; 1790 1791 raw_spin_unlock_irqrestore(&desc->lock, flags); 1792 1793 unregister_handler_proc(irq, action); 1794 1795 module_put(desc->owner); 1796 return action; 1797 1798bad: 1799 raw_spin_unlock_irqrestore(&desc->lock, flags); 1800 return NULL; 1801} 1802 1803/** 1804 * remove_percpu_irq - free a per-cpu interrupt 1805 * @irq: Interrupt line to free 1806 * @act: irqaction for the interrupt 1807 * 1808 * Used to remove interrupts statically setup by the early boot process. 1809 */ 1810void remove_percpu_irq(unsigned int irq, struct irqaction *act) 1811{ 1812 struct irq_desc *desc = irq_to_desc(irq); 1813 1814 if (desc && irq_settings_is_per_cpu_devid(desc)) 1815 __free_percpu_irq(irq, act->percpu_dev_id); 1816} 1817 1818/** 1819 * free_percpu_irq - free an interrupt allocated with request_percpu_irq 1820 * @irq: Interrupt line to free 1821 * @dev_id: Device identity to free 1822 * 1823 * Remove a percpu interrupt handler. The handler is removed, but 1824 * the interrupt line is not disabled. This must be done on each 1825 * CPU before calling this function. The function does not return 1826 * until any executing interrupts for this IRQ have completed. 1827 * 1828 * This function must not be called from interrupt context. 1829 */ 1830void free_percpu_irq(unsigned int irq, void __percpu *dev_id) 1831{ 1832 struct irq_desc *desc = irq_to_desc(irq); 1833 1834 if (!desc || !irq_settings_is_per_cpu_devid(desc)) 1835 return; 1836 1837 chip_bus_lock(desc); 1838 kfree(__free_percpu_irq(irq, dev_id)); 1839 chip_bus_sync_unlock(desc); 1840} 1841EXPORT_SYMBOL_GPL(free_percpu_irq); 1842 1843/** 1844 * setup_percpu_irq - setup a per-cpu interrupt 1845 * @irq: Interrupt line to setup 1846 * @act: irqaction for the interrupt 1847 * 1848 * Used to statically setup per-cpu interrupts in the early boot process. 1849 */ 1850int setup_percpu_irq(unsigned int irq, struct irqaction *act) 1851{ 1852 struct irq_desc *desc = irq_to_desc(irq); 1853 int retval; 1854 1855 if (!desc || !irq_settings_is_per_cpu_devid(desc)) 1856 return -EINVAL; 1857 chip_bus_lock(desc); 1858 retval = __setup_irq(irq, desc, act); 1859 chip_bus_sync_unlock(desc); 1860 1861 return retval; 1862} 1863 1864/** 1865 * request_percpu_irq - allocate a percpu interrupt line 1866 * @irq: Interrupt line to allocate 1867 * @handler: Function to be called when the IRQ occurs. 1868 * @devname: An ascii name for the claiming device 1869 * @dev_id: A percpu cookie passed back to the handler function 1870 * 1871 * This call allocates interrupt resources and enables the 1872 * interrupt on the local CPU. If the interrupt is supposed to be 1873 * enabled on other CPUs, it has to be done on each CPU using 1874 * enable_percpu_irq(). 1875 * 1876 * Dev_id must be globally unique. It is a per-cpu variable, and 1877 * the handler gets called with the interrupted CPU's instance of 1878 * that variable. 1879 */ 1880int request_percpu_irq(unsigned int irq, irq_handler_t handler, 1881 const char *devname, void __percpu *dev_id) 1882{ 1883 struct irqaction *action; 1884 struct irq_desc *desc; 1885 int retval; 1886 1887 if (!dev_id) 1888 return -EINVAL; 1889 1890 desc = irq_to_desc(irq); 1891 if (!desc || !irq_settings_can_request(desc) || 1892 !irq_settings_is_per_cpu_devid(desc)) 1893 return -EINVAL; 1894 1895 action = kzalloc(sizeof(struct irqaction), GFP_KERNEL); 1896 if (!action) 1897 return -ENOMEM; 1898 1899 action->handler = handler; 1900 action->flags = IRQF_PERCPU | IRQF_NO_SUSPEND; 1901 action->name = devname; 1902 action->percpu_dev_id = dev_id; 1903 1904 chip_bus_lock(desc); 1905 retval = __setup_irq(irq, desc, action); 1906 chip_bus_sync_unlock(desc); 1907 1908 if (retval) 1909 kfree(action); 1910 1911 return retval; 1912} 1913EXPORT_SYMBOL_GPL(request_percpu_irq); 1914 1915/** 1916 * irq_get_irqchip_state - returns the irqchip state of a interrupt. 1917 * @irq: Interrupt line that is forwarded to a VM 1918 * @which: One of IRQCHIP_STATE_* the caller wants to know about 1919 * @state: a pointer to a boolean where the state is to be storeed 1920 * 1921 * This call snapshots the internal irqchip state of an 1922 * interrupt, returning into @state the bit corresponding to 1923 * stage @which 1924 * 1925 * This function should be called with preemption disabled if the 1926 * interrupt controller has per-cpu registers. 1927 */ 1928int irq_get_irqchip_state(unsigned int irq, enum irqchip_irq_state which, 1929 bool *state) 1930{ 1931 struct irq_desc *desc; 1932 struct irq_data *data; 1933 struct irq_chip *chip; 1934 unsigned long flags; 1935 int err = -EINVAL; 1936 1937 desc = irq_get_desc_buslock(irq, &flags, 0); 1938 if (!desc) 1939 return err; 1940 1941 data = irq_desc_get_irq_data(desc); 1942 1943 do { 1944 chip = irq_data_get_irq_chip(data); 1945 if (chip->irq_get_irqchip_state) 1946 break; 1947#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY 1948 data = data->parent_data; 1949#else 1950 data = NULL; 1951#endif 1952 } while (data); 1953 1954 if (data) 1955 err = chip->irq_get_irqchip_state(data, which, state); 1956 1957 irq_put_desc_busunlock(desc, flags); 1958 return err; 1959} 1960EXPORT_SYMBOL_GPL(irq_get_irqchip_state); 1961 1962/** 1963 * irq_set_irqchip_state - set the state of a forwarded interrupt. 1964 * @irq: Interrupt line that is forwarded to a VM 1965 * @which: State to be restored (one of IRQCHIP_STATE_*) 1966 * @val: Value corresponding to @which 1967 * 1968 * This call sets the internal irqchip state of an interrupt, 1969 * depending on the value of @which. 1970 * 1971 * This function should be called with preemption disabled if the 1972 * interrupt controller has per-cpu registers. 1973 */ 1974int irq_set_irqchip_state(unsigned int irq, enum irqchip_irq_state which, 1975 bool val) 1976{ 1977 struct irq_desc *desc; 1978 struct irq_data *data; 1979 struct irq_chip *chip; 1980 unsigned long flags; 1981 int err = -EINVAL; 1982 1983 desc = irq_get_desc_buslock(irq, &flags, 0); 1984 if (!desc) 1985 return err; 1986 1987 data = irq_desc_get_irq_data(desc); 1988 1989 do { 1990 chip = irq_data_get_irq_chip(data); 1991 if (chip->irq_set_irqchip_state) 1992 break; 1993#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY 1994 data = data->parent_data; 1995#else 1996 data = NULL; 1997#endif 1998 } while (data); 1999 2000 if (data) 2001 err = chip->irq_set_irqchip_state(data, which, val); 2002 2003 irq_put_desc_busunlock(desc, flags); 2004 return err; 2005} 2006EXPORT_SYMBOL_GPL(irq_set_irqchip_state); 2007