arch/powerpc/kernel/irq.c

   1 /*
   2  *  Derived from arch/i386/kernel/irq.c
   3  *    Copyright (C) 1992 Linus Torvalds
   4  *  Adapted from arch/i386 by Gary Thomas
   5  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
   6  *  Updated and modified by Cort Dougan <cort@fsmlabs.com>
   7  *    Copyright (C) 1996-2001 Cort Dougan
   8  *  Adapted for Power Macintosh by Paul Mackerras
   9  *    Copyright (C) 1996 Paul Mackerras (paulus@cs.anu.edu.au)
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License
  13  * as published by the Free Software Foundation; either version
  14  * 2 of the License, or (at your option) any later version.
  15  *
  16  * This file contains the code used by various IRQ handling routines:
  17  * asking for different IRQ's should be done through these routines
  18  * instead of just grabbing them. Thus setups with different IRQ numbers
  19  * shouldn't result in any weird surprises, and installing new handlers
  20  * should be easier.
  21  *
  22  * The MPC8xx has an interrupt mask in the SIU.  If a bit is set, the
  23  * interrupt is _enabled_.  As expected, IRQ0 is bit 0 in the 32-bit
  24  * mask register (of which only 16 are defined), hence the weird shifting
  25  * and complement of the cached_irq_mask.  I want to be able to stuff
  26  * this right into the SIU SMASK register.
  27  * Many of the prep/chrp functions are conditional compiled on CONFIG_PPC_8xx
  28  * to reduce code space and undefined function references.
  29  */
  30
  31 #undef DEBUG
  32
  33 #include <linux/export.h>
  34 #include <linux/threads.h>
  35 #include <linux/kernel_stat.h>
  36 #include <linux/signal.h>
  37 #include <linux/sched.h>
  38 #include <linux/ptrace.h>
  39 #include <linux/ioport.h>
  40 #include <linux/interrupt.h>
  41 #include <linux/timex.h>
  42 #include <linux/init.h>
  43 #include <linux/slab.h>
  44 #include <linux/delay.h>
  45 #include <linux/irq.h>
  46 #include <linux/seq_file.h>
  47 #include <linux/cpumask.h>
  48 #include <linux/profile.h>
  49 #include <linux/bitops.h>
  50 #include <linux/list.h>
  51 #include <linux/radix-tree.h>
  52 #include <linux/mutex.h>
  53 #include <linux/pci.h>
  54 #include <linux/debugfs.h>
  55 #include <linux/of.h>
  56 #include <linux/of_irq.h>
  57
  58 #include <linux/uaccess.h>
  59 #include <asm/io.h>
  60 #include <asm/pgtable.h>
  61 #include <asm/irq.h>
  62 #include <asm/cache.h>
  63 #include <asm/prom.h>
  64 #include <asm/ptrace.h>
  65 #include <asm/machdep.h>
  66 #include <asm/udbg.h>
  67 #include <asm/smp.h>
  68 #include <asm/livepatch.h>
  69 #include <asm/asm-prototypes.h>
  70
  71 #ifdef CONFIG_PPC64
  72 #include <asm/paca.h>
  73 #include <asm/firmware.h>
  74 #include <asm/lv1call.h>
  75 #endif
  76 #define CREATE_TRACE_POINTS
  77 #include <asm/trace.h>
  78 #include <asm/cpu_has_feature.h>
  79
  80 DEFINE_PER_CPU_SHARED_ALIGNED(irq_cpustat_t, irq_stat);
  81 EXPORT_PER_CPU_SYMBOL(irq_stat);
  82
  83 int __irq_offset_value;
  84
  85 #ifdef CONFIG_PPC32
  86 EXPORT_SYMBOL(__irq_offset_value);
  87 atomic_t ppc_n_lost_interrupts;
  88
  89 #ifdef CONFIG_TAU_INT
  90 extern int tau_initialized;
  91 extern int tau_interrupts(int);
  92 #endif
  93 #endif /* CONFIG_PPC32 */
  94
  95 #ifdef CONFIG_PPC64
  96
  97 int distribute_irqs = 1;
  98
  99 static inline notrace unsigned long get_irq_happened(void)
 100 {
 101         unsigned long happened;
 102
 103         __asm__ __volatile__("lbz %0,%1(13)"
 104         : "=r" (happened) : "i" (offsetof(struct paca_struct, irq_happened)));
 105
 106         return happened;
 107 }
 108
 109 static inline notrace void set_soft_enabled(unsigned long enable)
 110 {
 111         __asm__ __volatile__("stb %0,%1(13)"
 112         : : "r" (enable), "i" (offsetof(struct paca_struct, soft_enabled)));
 113 }
 114
 115 static inline notrace int decrementer_check_overflow(void)
 116 {
 117         u64 now = get_tb_or_rtc();
 118         u64 *next_tb = this_cpu_ptr(&decrementers_next_tb);
 119
 120         return now >= *next_tb;
 121 }
 122
 123 /* This is called whenever we are re-enabling interrupts
 124  * and returns either 0 (nothing to do) or 500/900/280/a00/e80 if
 125  * there's an EE, DEC or DBELL to generate.
 126  *
 127  * This is called in two contexts: From arch_local_irq_restore()
 128  * before soft-enabling interrupts, and from the exception exit
 129  * path when returning from an interrupt from a soft-disabled to
 130  * a soft enabled context. In both case we have interrupts hard
 131  * disabled.
 132  *
 133  * We take care of only clearing the bits we handled in the
 134  * PACA irq_happened field since we can only re-emit one at a
 135  * time and we don't want to "lose" one.
 136  */
 137 notrace unsigned int __check_irq_replay(void)
 138 {
 139         /*
 140          * We use local_paca rather than get_paca() to avoid all
 141          * the debug_smp_processor_id() business in this low level
 142          * function
 143          */
 144         unsigned char happened = local_paca->irq_happened;
 145
 146         if (happened & PACA_IRQ_HARD_DIS) {
 147                 /* Clear bit 0 which we wouldn't clear otherwise */
 148                 local_paca->irq_happened &= ~PACA_IRQ_HARD_DIS;
 149
 150                 /*
 151                  * We may have missed a decrementer interrupt if hard disabled.
 152                  * Check the decrementer register in case we had a rollover
 153                  * while hard disabled.
 154                  */
 155                 if (!(happened & PACA_IRQ_DEC)) {
 156                         if (decrementer_check_overflow()) {
 157                                 local_paca->irq_happened |= PACA_IRQ_DEC;
 158                                 happened |= PACA_IRQ_DEC;
 159                         }
 160                 }
 161         }
 162
 163         /*
 164          * Force the delivery of pending soft-disabled interrupts on PS3.
 165          * Any HV call will have this side effect.
 166          */
 167         if (firmware_has_feature(FW_FEATURE_PS3_LV1)) {
 168                 u64 tmp, tmp2;
 169                 lv1_get_version_info(&tmp, &tmp2);
 170         }
 171
 172         /*
 173          * Check if an hypervisor Maintenance interrupt happened.
 174          * This is a higher priority interrupt than the others, so
 175          * replay it first.
 176          */
 177         if (happened & PACA_IRQ_HMI) {
 178                 local_paca->irq_happened &= ~PACA_IRQ_HMI;
 179                 return 0xe60;
 180         }
 181
 182         if (happened & PACA_IRQ_DEC) {
 183                 local_paca->irq_happened &= ~PACA_IRQ_DEC;
 184                 return 0x900;
 185         }
 186
 187         if (happened & PACA_IRQ_EE) {
 188                 local_paca->irq_happened &= ~PACA_IRQ_EE;
 189                 return 0x500;
 190         }
 191
 192 #ifdef CONFIG_PPC_BOOK3E
 193         /*
 194          * Check if an EPR external interrupt happened this bit is typically
 195          * set if we need to handle another "edge" interrupt from within the
 196          * MPIC "EPR" handler.
 197          */
 198         if (happened & PACA_IRQ_EE_EDGE) {
 199                 local_paca->irq_happened &= ~PACA_IRQ_EE_EDGE;
 200                 return 0x500;
 201         }
 202
 203         if (happened & PACA_IRQ_DBELL) {
 204                 local_paca->irq_happened &= ~PACA_IRQ_DBELL;
 205                 return 0x280;
 206         }
 207 #else
 208         if (happened & PACA_IRQ_DBELL) {
 209                 local_paca->irq_happened &= ~PACA_IRQ_DBELL;
 210                 return 0xa00;
 211         }
 212 #endif /* CONFIG_PPC_BOOK3E */
 213
 214         /* There should be nothing left ! */
 215         BUG_ON(local_paca->irq_happened != 0);
 216
 217         return 0;
 218 }
 219
 220 notrace void arch_local_irq_restore(unsigned long en)
 221 {
 222         unsigned char irq_happened;
 223         unsigned int replay;
 224
 225         /* Write the new soft-enabled value */
 226         set_soft_enabled(en);
 227         if (!en)
 228                 return;
 229         /*
 230          * From this point onward, we can take interrupts, preempt,
 231          * etc... unless we got hard-disabled. We check if an event
 232          * happened. If none happened, we know we can just return.
 233          *
 234          * We may have preempted before the check below, in which case
 235          * we are checking the "new" CPU instead of the old one. This
 236          * is only a problem if an event happened on the "old" CPU.
 237          *
 238          * External interrupt events will have caused interrupts to
 239          * be hard-disabled, so there is no problem, we
 240          * cannot have preempted.
 241          */
 242         irq_happened = get_irq_happened();
 243         if (!irq_happened)
 244                 return;
 245
 246         /*
 247          * We need to hard disable to get a trusted value from
 248          * __check_irq_replay(). We also need to soft-disable
 249          * again to avoid warnings in there due to the use of
 250          * per-cpu variables.
 251          *
 252          * We know that if the value in irq_happened is exactly 0x01
 253          * then we are already hard disabled (there are other less
 254          * common cases that we'll ignore for now), so we skip the
 255          * (expensive) mtmsrd.
 256          */
 257         if (unlikely(irq_happened != PACA_IRQ_HARD_DIS))
 258                 __hard_irq_disable();
 259 #ifdef CONFIG_TRACE_IRQFLAGS
 260         else {
 261                 /*
 262                  * We should already be hard disabled here. We had bugs
 263                  * where that wasn't the case so let's dbl check it and
 264                  * warn if we are wrong. Only do that when IRQ tracing
 265                  * is enabled as mfmsr() can be costly.
 266                  */
 267                 if (WARN_ON(mfmsr() & MSR_EE))
 268                         __hard_irq_disable();
 269         }
 270 #endif /* CONFIG_TRACE_IRQFLAGS */
 271
 272         set_soft_enabled(0);
 273
 274         /*
 275          * Check if anything needs to be re-emitted. We haven't
 276          * soft-enabled yet to avoid warnings in decrementer_check_overflow
 277          * accessing per-cpu variables
 278          */
 279         replay = __check_irq_replay();
 280
 281         /* We can soft-enable now */
 282         set_soft_enabled(1);
 283
 284         /*
 285          * And replay if we have to. This will return with interrupts
 286          * hard-enabled.
 287          */
 288         if (replay) {
 289                 __replay_interrupt(replay);
 290                 return;
 291         }
 292
 293         /* Finally, let's ensure we are hard enabled */
 294         __hard_irq_enable();
 295 }
 296 EXPORT_SYMBOL(arch_local_irq_restore);
 297
 298 /*
 299  * This is specifically called by assembly code to re-enable interrupts
 300  * if they are currently disabled. This is typically called before
 301  * schedule() or do_signal() when returning to userspace. We do it
 302  * in C to avoid the burden of dealing with lockdep etc...
 303  *
 304  * NOTE: This is called with interrupts hard disabled but not marked
 305  * as such in paca->irq_happened, so we need to resync this.
 306  */
 307 void notrace restore_interrupts(void)
 308 {
 309         if (irqs_disabled()) {
 310                 local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
 311                 local_irq_enable();
 312         } else
 313                 __hard_irq_enable();
 314 }
 315
 316 /*
 317  * This is a helper to use when about to go into idle low-power
 318  * when the latter has the side effect of re-enabling interrupts
 319  * (such as calling H_CEDE under pHyp).
 320  *
 321  * You call this function with interrupts soft-disabled (this is
 322  * already the case when ppc_md.power_save is called). The function
 323  * will return whether to enter power save or just return.
 324  *
 325  * In the former case, it will have notified lockdep of interrupts
 326  * being re-enabled and generally sanitized the lazy irq state,
 327  * and in the latter case it will leave with interrupts hard
 328  * disabled and marked as such, so the local_irq_enable() call
 329  * in arch_cpu_idle() will properly re-enable everything.
 330  */
 331 bool prep_irq_for_idle(void)
 332 {
 333         /*
 334          * First we need to hard disable to ensure no interrupt
 335          * occurs before we effectively enter the low power state
 336          */
 337         __hard_irq_disable();
 338         local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
 339
 340         /*
 341          * If anything happened while we were soft-disabled,
 342          * we return now and do not enter the low power state.
 343          */
 344         if (lazy_irq_pending())
 345                 return false;
 346
 347         /* Tell lockdep we are about to re-enable */
 348         trace_hardirqs_on();
 349
 350         /*
 351          * Mark interrupts as soft-enabled and clear the
 352          * PACA_IRQ_HARD_DIS from the pending mask since we
 353          * are about to hard enable as well as a side effect
 354          * of entering the low power state.
 355          */
 356         local_paca->irq_happened &= ~PACA_IRQ_HARD_DIS;
 357         local_paca->soft_enabled = 1;
 358
 359         /* Tell the caller to enter the low power state */
 360         return true;
 361 }
 362
 363 #ifdef CONFIG_PPC_BOOK3S
 364 /*
 365  * This is for idle sequences that return with IRQs off, but the
 366  * idle state itself wakes on interrupt. Tell the irq tracer that
 367  * IRQs are enabled for the duration of idle so it does not get long
 368  * off times. Must be paired with fini_irq_for_idle_irqsoff.
 369  */
 370 bool prep_irq_for_idle_irqsoff(void)
 371 {
 372         WARN_ON(!irqs_disabled());
 373
 374         /*
 375          * First we need to hard disable to ensure no interrupt
 376          * occurs before we effectively enter the low power state
 377          */
 378         __hard_irq_disable();
 379         local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
 380
 381         /*
 382          * If anything happened while we were soft-disabled,
 383          * we return now and do not enter the low power state.
 384          */
 385         if (lazy_irq_pending())
 386                 return false;
 387
 388         /* Tell lockdep we are about to re-enable */
 389         trace_hardirqs_on();
 390
 391         return true;
 392 }
 393
 394 /*
 395  * Take the SRR1 wakeup reason, index into this table to find the
 396  * appropriate irq_happened bit.
 397  */
 398 static const u8 srr1_to_lazyirq[0x10] = {
 399         0, 0, 0,
 400         PACA_IRQ_DBELL,
 401         0,
 402         PACA_IRQ_DBELL,
 403         PACA_IRQ_DEC,
 404         0,
 405         PACA_IRQ_EE,
 406         PACA_IRQ_EE,
 407         PACA_IRQ_HMI,
 408         0, 0, 0, 0, 0 };
 409
 410 void irq_set_pending_from_srr1(unsigned long srr1)
 411 {
 412         unsigned int idx = (srr1 & SRR1_WAKEMASK_P8) >> 18;
 413
 414         /*
 415          * The 0 index (SRR1[42:45]=b0000) must always evaluate to 0,
 416          * so this can be called unconditionally with srr1 wake reason.
 417          */
 418         local_paca->irq_happened |= srr1_to_lazyirq[idx];
 419 }
 420 #endif /* CONFIG_PPC_BOOK3S */
 421
 422 /*
 423  * Force a replay of the external interrupt handler on this CPU.
 424  */
 425 void force_external_irq_replay(void)
 426 {
 427         /*
 428          * This must only be called with interrupts soft-disabled,
 429          * the replay will happen when re-enabling.
 430          */
 431         WARN_ON(!arch_irqs_disabled());
 432
 433         /* Indicate in the PACA that we have an interrupt to replay */
 434         local_paca->irq_happened |= PACA_IRQ_EE;
 435 }
 436
 437 #endif /* CONFIG_PPC64 */
 438
 439 int arch_show_interrupts(struct seq_file *p, int prec)
 440 {
 441         int j;
 442
 443 #if defined(CONFIG_PPC32) && defined(CONFIG_TAU_INT)
 444         if (tau_initialized) {
 445                 seq_printf(p, "%*s: ", prec, "TAU");
 446                 for_each_online_cpu(j)
 447                         seq_printf(p, "%10u ", tau_interrupts(j));
 448                 seq_puts(p, "  PowerPC             Thermal Assist (cpu temp)\n");
 449         }
 450 #endif /* CONFIG_PPC32 && CONFIG_TAU_INT */
 451
 452         seq_printf(p, "%*s: ", prec, "LOC");
 453         for_each_online_cpu(j)
 454                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs_event);
 455         seq_printf(p, "  Local timer interrupts for timer event device\n");
 456
 457         seq_printf(p, "%*s: ", prec, "LOC");
 458         for_each_online_cpu(j)
 459                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs_others);
 460         seq_printf(p, "  Local timer interrupts for others\n");
 461
 462         seq_printf(p, "%*s: ", prec, "SPU");
 463         for_each_online_cpu(j)
 464                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).spurious_irqs);
 465         seq_printf(p, "  Spurious interrupts\n");
 466
 467         seq_printf(p, "%*s: ", prec, "PMI");
 468         for_each_online_cpu(j)
 469                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).pmu_irqs);
 470         seq_printf(p, "  Performance monitoring interrupts\n");
 471
 472         seq_printf(p, "%*s: ", prec, "MCE");
 473         for_each_online_cpu(j)
 474                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).mce_exceptions);
 475         seq_printf(p, "  Machine check exceptions\n");
 476
 477         if (cpu_has_feature(CPU_FTR_HVMODE)) {
 478                 seq_printf(p, "%*s: ", prec, "HMI");
 479                 for_each_online_cpu(j)
 480                         seq_printf(p, "%10u ",
 481                                         per_cpu(irq_stat, j).hmi_exceptions);
 482                 seq_printf(p, "  Hypervisor Maintenance Interrupts\n");
 483         }
 484
 485         seq_printf(p, "%*s: ", prec, "NMI");
 486         for_each_online_cpu(j)
 487                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).sreset_irqs);
 488         seq_printf(p, "  System Reset interrupts\n");
 489
 490 #ifdef CONFIG_PPC_WATCHDOG
 491         seq_printf(p, "%*s: ", prec, "WDG");
 492         for_each_online_cpu(j)
 493                 seq_printf(p, "%10u ", per_cpu(irq_stat, j).soft_nmi_irqs);
 494         seq_printf(p, "  Watchdog soft-NMI interrupts\n");
 495 #endif
 496
 497 #ifdef CONFIG_PPC_DOORBELL
 498         if (cpu_has_feature(CPU_FTR_DBELL)) {
 499                 seq_printf(p, "%*s: ", prec, "DBL");
 500                 for_each_online_cpu(j)
 501                         seq_printf(p, "%10u ", per_cpu(irq_stat, j).doorbell_irqs);
 502                 seq_printf(p, "  Doorbell interrupts\n");
 503         }
 504 #endif
 505
 506         return 0;
 507 }
 508
 509 /*
 510  * /proc/stat helpers
 511  */
 512 u64 arch_irq_stat_cpu(unsigned int cpu)
 513 {
 514         u64 sum = per_cpu(irq_stat, cpu).timer_irqs_event;
 515
 516         sum += per_cpu(irq_stat, cpu).pmu_irqs;
 517         sum += per_cpu(irq_stat, cpu).mce_exceptions;
 518         sum += per_cpu(irq_stat, cpu).spurious_irqs;
 519         sum += per_cpu(irq_stat, cpu).timer_irqs_others;
 520         sum += per_cpu(irq_stat, cpu).hmi_exceptions;
 521         sum += per_cpu(irq_stat, cpu).sreset_irqs;
 522 #ifdef CONFIG_PPC_WATCHDOG
 523         sum += per_cpu(irq_stat, cpu).soft_nmi_irqs;
 524 #endif
 525 #ifdef CONFIG_PPC_DOORBELL
 526         sum += per_cpu(irq_stat, cpu).doorbell_irqs;
 527 #endif
 528
 529         return sum;
 530 }
 531
 532 static inline void check_stack_overflow(void)
 533 {
 534 #ifdef CONFIG_DEBUG_STACKOVERFLOW
 535         long sp;
 536
 537         sp = current_stack_pointer() & (THREAD_SIZE-1);
 538
 539         /* check for stack overflow: is there less than 2KB free? */
 540         if (unlikely(sp < (sizeof(struct thread_info) + 2048))) {
 541                 pr_err("do_IRQ: stack overflow: %ld\n",
 542                         sp - sizeof(struct thread_info));
 543                 dump_stack();
 544         }
 545 #endif
 546 }
 547
 548 void __do_irq(struct pt_regs *regs)
 549 {
 550         unsigned int irq;
 551
 552         irq_enter();
 553
 554         trace_irq_entry(regs);
 555
 556         check_stack_overflow();
 557
 558         /*
 559          * Query the platform PIC for the interrupt & ack it.
 560          *
 561          * This will typically lower the interrupt line to the CPU
 562          */
 563         irq = ppc_md.get_irq();
 564
 565         /* We can hard enable interrupts now to allow perf interrupts */
 566         may_hard_irq_enable();
 567
 568         /* And finally process it */
 569         if (unlikely(!irq))
 570                 __this_cpu_inc(irq_stat.spurious_irqs);
 571         else
 572                 generic_handle_irq(irq);
 573
 574         trace_irq_exit(regs);
 575
 576         irq_exit();
 577 }
 578
 579 void do_IRQ(struct pt_regs *regs)
 580 {
 581         struct pt_regs *old_regs = set_irq_regs(regs);
 582         struct thread_info *curtp, *irqtp, *sirqtp;
 583
 584         /* Switch to the irq stack to handle this */
 585         curtp = current_thread_info();
 586         irqtp = hardirq_ctx[raw_smp_processor_id()];
 587         sirqtp = softirq_ctx[raw_smp_processor_id()];
 588
 589         /* Already there ? */
 590         if (unlikely(curtp == irqtp || curtp == sirqtp)) {
 591                 __do_irq(regs);
 592                 set_irq_regs(old_regs);
 593                 return;
 594         }
 595
 596         /* Prepare the thread_info in the irq stack */
 597         irqtp->task = curtp->task;
 598         irqtp->flags = 0;
 599
 600         /* Copy the preempt_count so that the [soft]irq checks work. */
 601         irqtp->preempt_count = curtp->preempt_count;
 602
 603         /* Switch stack and call */
 604         call_do_irq(regs, irqtp);
 605
 606         /* Restore stack limit */
 607         irqtp->task = NULL;
 608
 609         /* Copy back updates to the thread_info */
 610         if (irqtp->flags)
 611                 set_bits(irqtp->flags, &curtp->flags);
 612
 613         set_irq_regs(old_regs);
 614 }
 615
 616 void __init init_IRQ(void)
 617 {
 618         if (ppc_md.init_IRQ)
 619                 ppc_md.init_IRQ();
 620
 621         exc_lvl_ctx_init();
 622
 623         irq_ctx_init();
 624 }
 625
 626 #if defined(CONFIG_BOOKE) || defined(CONFIG_40x)
 627 struct thread_info   *critirq_ctx[NR_CPUS] __read_mostly;
 628 struct thread_info    *dbgirq_ctx[NR_CPUS] __read_mostly;
 629 struct thread_info *mcheckirq_ctx[NR_CPUS] __read_mostly;
 630
 631 void exc_lvl_ctx_init(void)
 632 {
 633         struct thread_info *tp;
 634         int i, cpu_nr;
 635
 636         for_each_possible_cpu(i) {
 637 #ifdef CONFIG_PPC64
 638                 cpu_nr = i;
 639 #else
 640 #ifdef CONFIG_SMP
 641                 cpu_nr = get_hard_smp_processor_id(i);
 642 #else
 643                 cpu_nr = 0;
 644 #endif
 645 #endif
 646
 647                 memset((void *)critirq_ctx[cpu_nr], 0, THREAD_SIZE);
 648                 tp = critirq_ctx[cpu_nr];
 649                 tp->cpu = cpu_nr;
 650                 tp->preempt_count = 0;
 651
 652 #ifdef CONFIG_BOOKE
 653                 memset((void *)dbgirq_ctx[cpu_nr], 0, THREAD_SIZE);
 654                 tp = dbgirq_ctx[cpu_nr];
 655                 tp->cpu = cpu_nr;
 656                 tp->preempt_count = 0;
 657
 658                 memset((void *)mcheckirq_ctx[cpu_nr], 0, THREAD_SIZE);
 659                 tp = mcheckirq_ctx[cpu_nr];
 660                 tp->cpu = cpu_nr;
 661                 tp->preempt_count = HARDIRQ_OFFSET;
 662 #endif
 663         }
 664 }
 665 #endif
 666
 667 struct thread_info *softirq_ctx[NR_CPUS] __read_mostly;
 668 struct thread_info *hardirq_ctx[NR_CPUS] __read_mostly;
 669
 670 void irq_ctx_init(void)
 671 {
 672         struct thread_info *tp;
 673         int i;
 674
 675         for_each_possible_cpu(i) {
 676                 memset((void *)softirq_ctx[i], 0, THREAD_SIZE);
 677                 tp = softirq_ctx[i];
 678                 tp->cpu = i;
 679                 klp_init_thread_info(tp);
 680
 681                 memset((void *)hardirq_ctx[i], 0, THREAD_SIZE);
 682                 tp = hardirq_ctx[i];
 683                 tp->cpu = i;
 684                 klp_init_thread_info(tp);
 685         }
 686 }
 687
 688 void do_softirq_own_stack(void)
 689 {
 690         struct thread_info *curtp, *irqtp;
 691
 692         curtp = current_thread_info();
 693         irqtp = softirq_ctx[smp_processor_id()];
 694         irqtp->task = curtp->task;
 695         irqtp->flags = 0;
 696         call_do_softirq(irqtp);
 697         irqtp->task = NULL;
 698
 699         /* Set any flag that may have been set on the
 700          * alternate stack
 701          */
 702         if (irqtp->flags)
 703                 set_bits(irqtp->flags, &curtp->flags);
 704 }
 705
 706 irq_hw_number_t virq_to_hw(unsigned int virq)
 707 {
 708         struct irq_data *irq_data = irq_get_irq_data(virq);
 709         return WARN_ON(!irq_data) ? 0 : irq_data->hwirq;
 710 }
 711 EXPORT_SYMBOL_GPL(virq_to_hw);
 712
 713 #ifdef CONFIG_SMP
 714 int irq_choose_cpu(const struct cpumask *mask)
 715 {
 716         int cpuid;
 717
 718         if (cpumask_equal(mask, cpu_online_mask)) {
 719                 static int irq_rover;
 720                 static DEFINE_RAW_SPINLOCK(irq_rover_lock);
 721                 unsigned long flags;
 722
 723                 /* Round-robin distribution... */
 724 do_round_robin:
 725                 raw_spin_lock_irqsave(&irq_rover_lock, flags);
 726
 727                 irq_rover = cpumask_next(irq_rover, cpu_online_mask);
 728                 if (irq_rover >= nr_cpu_ids)
 729                         irq_rover = cpumask_first(cpu_online_mask);
 730
 731                 cpuid = irq_rover;
 732
 733                 raw_spin_unlock_irqrestore(&irq_rover_lock, flags);
 734         } else {
 735                 cpuid = cpumask_first_and(mask, cpu_online_mask);
 736                 if (cpuid >= nr_cpu_ids)
 737                         goto do_round_robin;
 738         }
 739
 740         return get_hard_smp_processor_id(cpuid);
 741 }
 742 #else
 743 int irq_choose_cpu(const struct cpumask *mask)
 744 {
 745         return hard_smp_processor_id();
 746 }
 747 #endif
 748
 749 int arch_early_irq_init(void)
 750 {
 751         return 0;
 752 }
 753
 754 #ifdef CONFIG_PPC64
 755 static int __init setup_noirqdistrib(char *str)
 756 {
 757         distribute_irqs = 0;
 758         return 1;
 759 }
 760
 761 __setup("noirqdistrib", setup_noirqdistrib);
 762 #endif /* CONFIG_PPC64 */