irq.c 20 KB

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