kernel/irq/manage.c

   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 #include <linux/irq.h>
  11 #include <linux/module.h>
  12 #include <linux/random.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/slab.h>
  15
  16 #include "internals.h"
  17
  18 #if defined(CONFIG_SMP) && defined(CONFIG_GENERIC_HARDIRQS)
  19 cpumask_var_t irq_default_affinity;
  20
  21 /**
  22  *      synchronize_irq - wait for pending IRQ handlers (on other CPUs)
  23  *      @irq: interrupt number to wait for
  24  *
  25  *      This function waits for any pending IRQ handlers for this interrupt
  26  *      to complete before returning. If you use this function while
  27  *      holding a resource the IRQ handler may need you will deadlock.
  28  *
  29  *      This function may be called - with care - from IRQ context.
  30  */
  31 void synchronize_irq(unsigned int irq)
  32 {
  33         struct irq_desc *desc = irq_to_desc(irq);
  34         unsigned int status;
  35
  36         if (!desc)
  37                 return;
  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 (desc->status & IRQ_INPROGRESS)
  47                         cpu_relax();
  48
  49                 /* Ok, that indicated we're done: double-check carefully. */
  50                 spin_lock_irqsave(&desc->lock, flags);
  51                 status = desc->status;
  52                 spin_unlock_irqrestore(&desc->lock, flags);
  53
  54                 /* Oops, that failed? */
  55         } while (status & IRQ_INPROGRESS);
  56 }
  57 EXPORT_SYMBOL(synchronize_irq);
  58
  59 /**
  60  *      irq_can_set_affinity - Check if the affinity of a given irq can be set
  61  *      @irq:           Interrupt to check
  62  *
  63  */
  64 int irq_can_set_affinity(unsigned int irq)
  65 {
  66         struct irq_desc *desc = irq_to_desc(irq);
  67
  68         if (CHECK_IRQ_PER_CPU(desc->status) || !desc->chip ||
  69             !desc->chip->set_affinity)
  70                 return 0;
  71
  72         return 1;
  73 }
  74
  75 /**
  76  *      irq_set_affinity - Set the irq affinity of a given irq
  77  *      @irq:           Interrupt to set affinity
  78  *      @cpumask:       cpumask
  79  *
  80  */
  81 int irq_set_affinity(unsigned int irq, const struct cpumask *cpumask)
  82 {
  83         struct irq_desc *desc = irq_to_desc(irq);
  84         unsigned long flags;
  85
  86         if (!desc->chip->set_affinity)
  87                 return -EINVAL;
  88
  89         spin_lock_irqsave(&desc->lock, flags);
  90
  91 #ifdef CONFIG_GENERIC_PENDING_IRQ
  92         if (desc->status & IRQ_MOVE_PCNTXT || desc->status & IRQ_DISABLED) {
  93                 cpumask_copy(&desc->affinity, cpumask);
  94                 desc->chip->set_affinity(irq, cpumask);
  95         } else {
  96                 desc->status |= IRQ_MOVE_PENDING;
  97                 cpumask_copy(&desc->pending_mask, cpumask);
  98         }
  99 #else
 100         cpumask_copy(&desc->affinity, cpumask);
 101         desc->chip->set_affinity(irq, cpumask);
 102 #endif
 103         desc->status |= IRQ_AFFINITY_SET;
 104         spin_unlock_irqrestore(&desc->lock, flags);
 105         return 0;
 106 }
 107
 108 #ifndef CONFIG_AUTO_IRQ_AFFINITY
 109 /*
 110  * Generic version of the affinity autoselector.
 111  */
 112 int do_irq_select_affinity(unsigned int irq, struct irq_desc *desc)
 113 {
 114         if (!irq_can_set_affinity(irq))
 115                 return 0;
 116
 117         /*
 118          * Preserve an userspace affinity setup, but make sure that
 119          * one of the targets is online.
 120          */
 121         if (desc->status & (IRQ_AFFINITY_SET | IRQ_NO_BALANCING)) {
 122                 if (cpumask_any_and(&desc->affinity, cpu_online_mask)
 123                     < nr_cpu_ids)
 124                         goto set_affinity;
 125                 else
 126                         desc->status &= ~IRQ_AFFINITY_SET;
 127         }
 128
 129         cpumask_and(&desc->affinity, cpu_online_mask, irq_default_affinity);
 130 set_affinity:
 131         desc->chip->set_affinity(irq, &desc->affinity);
 132
 133         return 0;
 134 }
 135 #else
 136 static inline int do_irq_select_affinity(unsigned int irq, struct irq_desc *d)
 137 {
 138         return irq_select_affinity(irq);
 139 }
 140 #endif
 141
 142 /*
 143  * Called when affinity is set via /proc/irq
 144  */
 145 int irq_select_affinity_usr(unsigned int irq)
 146 {
 147         struct irq_desc *desc = irq_to_desc(irq);
 148         unsigned long flags;
 149         int ret;
 150
 151         spin_lock_irqsave(&desc->lock, flags);
 152         ret = do_irq_select_affinity(irq, desc);
 153         spin_unlock_irqrestore(&desc->lock, flags);
 154
 155         return ret;
 156 }
 157
 158 #else
 159 static inline int do_irq_select_affinity(int irq, struct irq_desc *desc)
 160 {
 161         return 0;
 162 }
 163 #endif
 164
 165 /**
 166  *      disable_irq_nosync - disable an irq without waiting
 167  *      @irq: Interrupt to disable
 168  *
 169  *      Disable the selected interrupt line.  Disables and Enables are
 170  *      nested.
 171  *      Unlike disable_irq(), this function does not ensure existing
 172  *      instances of the IRQ handler have completed before returning.
 173  *
 174  *      This function may be called from IRQ context.
 175  */
 176 void disable_irq_nosync(unsigned int irq)
 177 {
 178         struct irq_desc *desc = irq_to_desc(irq);
 179         unsigned long flags;
 180
 181         if (!desc)
 182                 return;
 183
 184         spin_lock_irqsave(&desc->lock, flags);
 185         if (!desc->depth++) {
 186                 desc->status |= IRQ_DISABLED;
 187                 desc->chip->disable(irq);
 188         }
 189         spin_unlock_irqrestore(&desc->lock, flags);
 190 }
 191 EXPORT_SYMBOL(disable_irq_nosync);
 192
 193 /**
 194  *      disable_irq - disable an irq and wait for completion
 195  *      @irq: Interrupt to disable
 196  *
 197  *      Disable the selected interrupt line.  Enables and Disables are
 198  *      nested.
 199  *      This function waits for any pending IRQ handlers for this interrupt
 200  *      to complete before returning. If you use this function while
 201  *      holding a resource the IRQ handler may need you will deadlock.
 202  *
 203  *      This function may be called - with care - from IRQ context.
 204  */
 205 void disable_irq(unsigned int irq)
 206 {
 207         struct irq_desc *desc = irq_to_desc(irq);
 208
 209         if (!desc)
 210                 return;
 211
 212         disable_irq_nosync(irq);
 213         if (desc->action)
 214                 synchronize_irq(irq);
 215 }
 216 EXPORT_SYMBOL(disable_irq);
 217
 218 static void __enable_irq(struct irq_desc *desc, unsigned int irq)
 219 {
 220         switch (desc->depth) {
 221         case 0:
 222                 WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
 223                 break;
 224         case 1: {
 225                 unsigned int status = desc->status & ~IRQ_DISABLED;
 226
 227                 /* Prevent probing on this irq: */
 228                 desc->status = status | IRQ_NOPROBE;
 229                 check_irq_resend(desc, irq);
 230                 /* fall-through */
 231         }
 232         default:
 233                 desc->depth--;
 234         }
 235 }
 236
 237 /**
 238  *      enable_irq - enable handling of an irq
 239  *      @irq: Interrupt to enable
 240  *
 241  *      Undoes the effect of one call to disable_irq().  If this
 242  *      matches the last disable, processing of interrupts on this
 243  *      IRQ line is re-enabled.
 244  *
 245  *      This function may be called from IRQ context.
 246  */
 247 void enable_irq(unsigned int irq)
 248 {
 249         struct irq_desc *desc = irq_to_desc(irq);
 250         unsigned long flags;
 251
 252         if (!desc)
 253                 return;
 254
 255         spin_lock_irqsave(&desc->lock, flags);
 256         __enable_irq(desc, irq);
 257         spin_unlock_irqrestore(&desc->lock, flags);
 258 }
 259 EXPORT_SYMBOL(enable_irq);
 260
 261 static int set_irq_wake_real(unsigned int irq, unsigned int on)
 262 {
 263         struct irq_desc *desc = irq_to_desc(irq);
 264         int ret = -ENXIO;
 265
 266         if (desc->chip->set_wake)
 267                 ret = desc->chip->set_wake(irq, on);
 268
 269         return ret;
 270 }
 271
 272 /**
 273  *      set_irq_wake - control irq power management wakeup
 274  *      @irq:   interrupt to control
 275  *      @on:    enable/disable power management wakeup
 276  *
 277  *      Enable/disable power management wakeup mode, which is
 278  *      disabled by default.  Enables and disables must match,
 279  *      just as they match for non-wakeup mode support.
 280  *
 281  *      Wakeup mode lets this IRQ wake the system from sleep
 282  *      states like "suspend to RAM".
 283  */
 284 int set_irq_wake(unsigned int irq, unsigned int on)
 285 {
 286         struct irq_desc *desc = irq_to_desc(irq);
 287         unsigned long flags;
 288         int ret = 0;
 289
 290         /* wakeup-capable irqs can be shared between drivers that
 291          * don't need to have the same sleep mode behaviors.
 292          */
 293         spin_lock_irqsave(&desc->lock, flags);
 294         if (on) {
 295                 if (desc->wake_depth++ == 0) {
 296                         ret = set_irq_wake_real(irq, on);
 297                         if (ret)
 298                                 desc->wake_depth = 0;
 299                         else
 300                                 desc->status |= IRQ_WAKEUP;
 301                 }
 302         } else {
 303                 if (desc->wake_depth == 0) {
 304                         WARN(1, "Unbalanced IRQ %d wake disable\n", irq);
 305                 } else if (--desc->wake_depth == 0) {
 306                         ret = set_irq_wake_real(irq, on);
 307                         if (ret)
 308                                 desc->wake_depth = 1;
 309                         else
 310                                 desc->status &= ~IRQ_WAKEUP;
 311                 }
 312         }
 313
 314         spin_unlock_irqrestore(&desc->lock, flags);
 315         return ret;
 316 }
 317 EXPORT_SYMBOL(set_irq_wake);
 318
 319 /*
 320  * Internal function that tells the architecture code whether a
 321  * particular irq has been exclusively allocated or is available
 322  * for driver use.
 323  */
 324 int can_request_irq(unsigned int irq, unsigned long irqflags)
 325 {
 326         struct irq_desc *desc = irq_to_desc(irq);
 327         struct irqaction *action;
 328
 329         if (!desc)
 330                 return 0;
 331
 332         if (desc->status & IRQ_NOREQUEST)
 333                 return 0;
 334
 335         action = desc->action;
 336         if (action)
 337                 if (irqflags & action->flags & IRQF_SHARED)
 338                         action = NULL;
 339
 340         return !action;
 341 }
 342
 343 void compat_irq_chip_set_default_handler(struct irq_desc *desc)
 344 {
 345         /*
 346          * If the architecture still has not overriden
 347          * the flow handler then zap the default. This
 348          * should catch incorrect flow-type setting.
 349          */
 350         if (desc->handle_irq == &handle_bad_irq)
 351                 desc->handle_irq = NULL;
 352 }
 353
 354 int __irq_set_trigger(struct irq_desc *desc, unsigned int irq,
 355                 unsigned long flags)
 356 {
 357         int ret;
 358         struct irq_chip *chip = desc->chip;
 359
 360         if (!chip || !chip->set_type) {
 361                 /*
 362                  * IRQF_TRIGGER_* but the PIC does not support multiple
 363                  * flow-types?
 364                  */
 365                 pr_debug("No set_type function for IRQ %d (%s)\n", irq,
 366                                 chip ? (chip->name ? : "unknown") : "unknown");
 367                 return 0;
 368         }
 369
 370         /* caller masked out all except trigger mode flags */
 371         ret = chip->set_type(irq, flags);
 372
 373         if (ret)
 374                 pr_err("setting trigger mode %d for irq %u failed (%pF)\n",
 375                                 (int)flags, irq, chip->set_type);
 376         else {
 377                 if (flags & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH))
 378                         flags |= IRQ_LEVEL;
 379                 /* note that IRQF_TRIGGER_MASK == IRQ_TYPE_SENSE_MASK */
 380                 desc->status &= ~(IRQ_LEVEL | IRQ_TYPE_SENSE_MASK);
 381                 desc->status |= flags;
 382         }
 383
 384         return ret;
 385 }
 386
 387 /*
 388  * Internal function to register an irqaction - typically used to
 389  * allocate special interrupts that are part of the architecture.
 390  */
 391 static int
 392 __setup_irq(unsigned int irq, struct irq_desc * desc, struct irqaction *new)
 393 {
 394         struct irqaction *old, **p;
 395         const char *old_name = NULL;
 396         unsigned long flags;
 397         int shared = 0;
 398         int ret;
 399
 400         if (!desc)
 401                 return -EINVAL;
 402
 403         if (desc->chip == &no_irq_chip)
 404                 return -ENOSYS;
 405         /*
 406          * Some drivers like serial.c use request_irq() heavily,
 407          * so we have to be careful not to interfere with a
 408          * running system.
 409          */
 410         if (new->flags & IRQF_SAMPLE_RANDOM) {
 411                 /*
 412                  * This function might sleep, we want to call it first,
 413                  * outside of the atomic block.
 414                  * Yes, this might clear the entropy pool if the wrong
 415                  * driver is attempted to be loaded, without actually
 416                  * installing a new handler, but is this really a problem,
 417                  * only the sysadmin is able to do this.
 418                  */
 419                 rand_initialize_irq(irq);
 420         }
 421
 422         /*
 423          * The following block of code has to be executed atomically
 424          */
 425         spin_lock_irqsave(&desc->lock, flags);
 426         p = &desc->action;
 427         old = *p;
 428         if (old) {
 429                 /*
 430                  * Can't share interrupts unless both agree to and are
 431                  * the same type (level, edge, polarity). So both flag
 432                  * fields must have IRQF_SHARED set and the bits which
 433                  * set the trigger type must match.
 434                  */
 435                 if (!((old->flags & new->flags) & IRQF_SHARED) ||
 436                     ((old->flags ^ new->flags) & IRQF_TRIGGER_MASK)) {
 437                         old_name = old->name;
 438                         goto mismatch;
 439                 }
 440
 441 #if defined(CONFIG_IRQ_PER_CPU)
 442                 /* All handlers must agree on per-cpuness */
 443                 if ((old->flags & IRQF_PERCPU) !=
 444                     (new->flags & IRQF_PERCPU))
 445                         goto mismatch;
 446 #endif
 447
 448                 /* add new interrupt at end of irq queue */
 449                 do {
 450                         p = &old->next;
 451                         old = *p;
 452                 } while (old);
 453                 shared = 1;
 454         }
 455
 456         if (!shared) {
 457                 irq_chip_set_defaults(desc->chip);
 458
 459                 /* Setup the type (level, edge polarity) if configured: */
 460                 if (new->flags & IRQF_TRIGGER_MASK) {
 461                         ret = __irq_set_trigger(desc, irq,
 462                                         new->flags & IRQF_TRIGGER_MASK);
 463
 464                         if (ret) {
 465                                 spin_unlock_irqrestore(&desc->lock, flags);
 466                                 return ret;
 467                         }
 468                 } else
 469                         compat_irq_chip_set_default_handler(desc);
 470 #if defined(CONFIG_IRQ_PER_CPU)
 471                 if (new->flags & IRQF_PERCPU)
 472                         desc->status |= IRQ_PER_CPU;
 473 #endif
 474
 475                 desc->status &= ~(IRQ_AUTODETECT | IRQ_WAITING |
 476                                   IRQ_INPROGRESS | IRQ_SPURIOUS_DISABLED);
 477
 478                 if (!(desc->status & IRQ_NOAUTOEN)) {
 479                         desc->depth = 0;
 480                         desc->status &= ~IRQ_DISABLED;
 481                         desc->chip->startup(irq);
 482                 } else
 483                         /* Undo nested disables: */
 484                         desc->depth = 1;
 485
 486                 /* Exclude IRQ from balancing if requested */
 487                 if (new->flags & IRQF_NOBALANCING)
 488                         desc->status |= IRQ_NO_BALANCING;
 489
 490                 /* Set default affinity mask once everything is setup */
 491                 do_irq_select_affinity(irq, desc);
 492
 493         } else if ((new->flags & IRQF_TRIGGER_MASK)
 494                         && (new->flags & IRQF_TRIGGER_MASK)
 495                                 != (desc->status & IRQ_TYPE_SENSE_MASK)) {
 496                 /* hope the handler works with the actual trigger mode... */
 497                 pr_warning("IRQ %d uses trigger mode %d; requested %d\n",
 498                                 irq, (int)(desc->status & IRQ_TYPE_SENSE_MASK),
 499                                 (int)(new->flags & IRQF_TRIGGER_MASK));
 500         }
 501
 502         *p = new;
 503
 504         /* Reset broken irq detection when installing new handler */
 505         desc->irq_count = 0;
 506         desc->irqs_unhandled = 0;
 507
 508         /*
 509          * Check whether we disabled the irq via the spurious handler
 510          * before. Reenable it and give it another chance.
 511          */
 512         if (shared && (desc->status & IRQ_SPURIOUS_DISABLED)) {
 513                 desc->status &= ~IRQ_SPURIOUS_DISABLED;
 514                 __enable_irq(desc, irq);
 515         }
 516
 517         spin_unlock_irqrestore(&desc->lock, flags);
 518
 519         new->irq = irq;
 520         register_irq_proc(irq, desc);
 521         new->dir = NULL;
 522         register_handler_proc(irq, new);
 523
 524         return 0;
 525
 526 mismatch:
 527 #ifdef CONFIG_DEBUG_SHIRQ
 528         if (!(new->flags & IRQF_PROBE_SHARED)) {
 529                 printk(KERN_ERR "IRQ handler type mismatch for IRQ %d\n", irq);
 530                 if (old_name)
 531                         printk(KERN_ERR "current handler: %s\n", old_name);
 532                 dump_stack();
 533         }
 534 #endif
 535         spin_unlock_irqrestore(&desc->lock, flags);
 536         return -EBUSY;
 537 }
 538
 539 /**
 540  *      setup_irq - setup an interrupt
 541  *      @irq: Interrupt line to setup
 542  *      @act: irqaction for the interrupt
 543  *
 544  * Used to statically setup interrupts in the early boot process.
 545  */
 546 int setup_irq(unsigned int irq, struct irqaction *act)
 547 {
 548         struct irq_desc *desc = irq_to_desc(irq);
 549
 550         return __setup_irq(irq, desc, act);
 551 }
 552
 553 /**
 554  *      free_irq - free an interrupt
 555  *      @irq: Interrupt line to free
 556  *      @dev_id: Device identity to free
 557  *
 558  *      Remove an interrupt handler. The handler is removed and if the
 559  *      interrupt line is no longer in use by any driver it is disabled.
 560  *      On a shared IRQ the caller must ensure the interrupt is disabled
 561  *      on the card it drives before calling this function. The function
 562  *      does not return until any executing interrupts for this IRQ
 563  *      have completed.
 564  *
 565  *      This function must not be called from interrupt context.
 566  */
 567 void free_irq(unsigned int irq, void *dev_id)
 568 {
 569         struct irq_desc *desc = irq_to_desc(irq);
 570         struct irqaction **p;
 571         unsigned long flags;
 572
 573         WARN_ON(in_interrupt());
 574
 575         if (!desc)
 576                 return;
 577
 578         spin_lock_irqsave(&desc->lock, flags);
 579         p = &desc->action;
 580         for (;;) {
 581                 struct irqaction *action = *p;
 582
 583                 if (action) {
 584                         struct irqaction **pp = p;
 585
 586                         p = &action->next;
 587                         if (action->dev_id != dev_id)
 588                                 continue;
 589
 590                         /* Found it - now remove it from the list of entries */
 591                         *pp = action->next;
 592
 593                         /* Currently used only by UML, might disappear one day.*/
 594 #ifdef CONFIG_IRQ_RELEASE_METHOD
 595                         if (desc->chip->release)
 596                                 desc->chip->release(irq, dev_id);
 597 #endif
 598
 599                         if (!desc->action) {
 600                                 desc->status |= IRQ_DISABLED;
 601                                 if (desc->chip->shutdown)
 602                                         desc->chip->shutdown(irq);
 603                                 else
 604                                         desc->chip->disable(irq);
 605                         }
 606                         spin_unlock_irqrestore(&desc->lock, flags);
 607                         unregister_handler_proc(irq, action);
 608
 609                         /* Make sure it's not being used on another CPU */
 610                         synchronize_irq(irq);
 611 #ifdef CONFIG_DEBUG_SHIRQ
 612                         /*
 613                          * It's a shared IRQ -- the driver ought to be
 614                          * prepared for it to happen even now it's
 615                          * being freed, so let's make sure....  We do
 616                          * this after actually deregistering it, to
 617                          * make sure that a 'real' IRQ doesn't run in
 618                          * parallel with our fake
 619                          */
 620                         if (action->flags & IRQF_SHARED) {
 621                                 local_irq_save(flags);
 622                                 action->handler(irq, dev_id);
 623                                 local_irq_restore(flags);
 624                         }
 625 #endif
 626                         kfree(action);
 627                         return;
 628                 }
 629                 printk(KERN_ERR "Trying to free already-free IRQ %d\n", irq);
 630 #ifdef CONFIG_DEBUG_SHIRQ
 631                 dump_stack();
 632 #endif
 633                 spin_unlock_irqrestore(&desc->lock, flags);
 634                 return;
 635         }
 636 }
 637 EXPORT_SYMBOL(free_irq);
 638
 639 /**
 640  *      request_irq - allocate an interrupt line
 641  *      @irq: Interrupt line to allocate
 642  *      @handler: Function to be called when the IRQ occurs
 643  *      @irqflags: Interrupt type flags
 644  *      @devname: An ascii name for the claiming device
 645  *      @dev_id: A cookie passed back to the handler function
 646  *
 647  *      This call allocates interrupt resources and enables the
 648  *      interrupt line and IRQ handling. From the point this
 649  *      call is made your handler function may be invoked. Since
 650  *      your handler function must clear any interrupt the board
 651  *      raises, you must take care both to initialise your hardware
 652  *      and to set up the interrupt handler in the right order.
 653  *
 654  *      Dev_id must be globally unique. Normally the address of the
 655  *      device data structure is used as the cookie. Since the handler
 656  *      receives this value it makes sense to use it.
 657  *
 658  *      If your interrupt is shared you must pass a non NULL dev_id
 659  *      as this is required when freeing the interrupt.
 660  *
 661  *      Flags:
 662  *
 663  *      IRQF_SHARED             Interrupt is shared
 664  *      IRQF_DISABLED   Disable local interrupts while processing
 665  *      IRQF_SAMPLE_RANDOM      The interrupt can be used for entropy
 666  *      IRQF_TRIGGER_*          Specify active edge(s) or level
 667  *
 668  */
 669 int request_irq(unsigned int irq, irq_handler_t handler,
 670                 unsigned long irqflags, const char *devname, void *dev_id)
 671 {
 672         struct irqaction *action;
 673         struct irq_desc *desc;
 674         int retval;
 675
 676         /*
 677          * handle_IRQ_event() always ignores IRQF_DISABLED except for
 678          * the _first_ irqaction (sigh).  That can cause oopsing, but
 679          * the behavior is classified as "will not fix" so we need to
 680          * start nudging drivers away from using that idiom.
 681          */
 682         if ((irqflags & (IRQF_SHARED|IRQF_DISABLED))
 683                         == (IRQF_SHARED|IRQF_DISABLED))
 684                 pr_warning("IRQ %d/%s: IRQF_DISABLED is not "
 685                                 "guaranteed on shared IRQs\n",
 686                                 irq, devname);
 687
 688 #ifdef CONFIG_LOCKDEP
 689         /*
 690          * Lockdep wants atomic interrupt handlers:
 691          */
 692         irqflags |= IRQF_DISABLED;
 693 #endif
 694         /*
 695          * Sanity-check: shared interrupts must pass in a real dev-ID,
 696          * otherwise we'll have trouble later trying to figure out
 697          * which interrupt is which (messes up the interrupt freeing
 698          * logic etc).
 699          */
 700         if ((irqflags & IRQF_SHARED) && !dev_id)
 701                 return -EINVAL;
 702
 703         desc = irq_to_desc(irq);
 704         if (!desc)
 705                 return -EINVAL;
 706
 707         if (desc->status & IRQ_NOREQUEST)
 708                 return -EINVAL;
 709         if (!handler)
 710                 return -EINVAL;
 711
 712         action = kmalloc(sizeof(struct irqaction), GFP_ATOMIC);
 713         if (!action)
 714                 return -ENOMEM;
 715
 716         action->handler = handler;
 717         action->flags = irqflags;
 718         cpus_clear(action->mask);
 719         action->name = devname;
 720         action->next = NULL;
 721         action->dev_id = dev_id;
 722
 723         retval = __setup_irq(irq, desc, action);
 724         if (retval)
 725                 kfree(action);
 726
 727 #ifdef CONFIG_DEBUG_SHIRQ
 728         if (irqflags & IRQF_SHARED) {
 729                 /*
 730                  * It's a shared IRQ -- the driver ought to be prepared for it
 731                  * to happen immediately, so let's make sure....
 732                  * We disable the irq to make sure that a 'real' IRQ doesn't
 733                  * run in parallel with our fake.
 734                  */
 735                 unsigned long flags;
 736
 737                 disable_irq(irq);
 738                 local_irq_save(flags);
 739
 740                 handler(irq, dev_id);
 741
 742                 local_irq_restore(flags);
 743                 enable_irq(irq);
 744         }
 745 #endif
 746         return retval;
 747 }
 748 EXPORT_SYMBOL(request_irq);