irq.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822
  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. u32 tau_interrupts(unsigned long cpu);
  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. /*
  423. * Interrupts must always be hard disabled before irq_happened is
  424. * modified (to prevent lost update in case of interrupt between
  425. * load and store).
  426. */
  427. __hard_irq_disable();
  428. local_paca->irq_happened |= PACA_IRQ_HARD_DIS;
  429. /* Indicate in the PACA that we have an interrupt to replay */
  430. local_paca->irq_happened |= PACA_IRQ_EE;
  431. }
  432. #endif /* CONFIG_PPC64 */
  433. int arch_show_interrupts(struct seq_file *p, int prec)
  434. {
  435. int j;
  436. #if defined(CONFIG_PPC32) && defined(CONFIG_TAU_INT)
  437. if (tau_initialized) {
  438. seq_printf(p, "%*s: ", prec, "TAU");
  439. for_each_online_cpu(j)
  440. seq_printf(p, "%10u ", tau_interrupts(j));
  441. seq_puts(p, " PowerPC Thermal Assist (cpu temp)\n");
  442. }
  443. #endif /* CONFIG_PPC32 && CONFIG_TAU_INT */
  444. seq_printf(p, "%*s: ", prec, "LOC");
  445. for_each_online_cpu(j)
  446. seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs_event);
  447. seq_printf(p, " Local timer interrupts for timer event device\n");
  448. seq_printf(p, "%*s: ", prec, "BCT");
  449. for_each_online_cpu(j)
  450. seq_printf(p, "%10u ", per_cpu(irq_stat, j).broadcast_irqs_event);
  451. seq_printf(p, " Broadcast timer interrupts for timer event device\n");
  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_others);
  455. seq_printf(p, " Local timer interrupts for others\n");
  456. seq_printf(p, "%*s: ", prec, "SPU");
  457. for_each_online_cpu(j)
  458. seq_printf(p, "%10u ", per_cpu(irq_stat, j).spurious_irqs);
  459. seq_printf(p, " Spurious interrupts\n");
  460. seq_printf(p, "%*s: ", prec, "PMI");
  461. for_each_online_cpu(j)
  462. seq_printf(p, "%10u ", per_cpu(irq_stat, j).pmu_irqs);
  463. seq_printf(p, " Performance monitoring interrupts\n");
  464. seq_printf(p, "%*s: ", prec, "MCE");
  465. for_each_online_cpu(j)
  466. seq_printf(p, "%10u ", per_cpu(irq_stat, j).mce_exceptions);
  467. seq_printf(p, " Machine check exceptions\n");
  468. if (cpu_has_feature(CPU_FTR_HVMODE)) {
  469. seq_printf(p, "%*s: ", prec, "HMI");
  470. for_each_online_cpu(j)
  471. seq_printf(p, "%10u ",
  472. per_cpu(irq_stat, j).hmi_exceptions);
  473. seq_printf(p, " Hypervisor Maintenance Interrupts\n");
  474. }
  475. seq_printf(p, "%*s: ", prec, "NMI");
  476. for_each_online_cpu(j)
  477. seq_printf(p, "%10u ", per_cpu(irq_stat, j).sreset_irqs);
  478. seq_printf(p, " System Reset interrupts\n");
  479. #ifdef CONFIG_PPC_WATCHDOG
  480. seq_printf(p, "%*s: ", prec, "WDG");
  481. for_each_online_cpu(j)
  482. seq_printf(p, "%10u ", per_cpu(irq_stat, j).soft_nmi_irqs);
  483. seq_printf(p, " Watchdog soft-NMI interrupts\n");
  484. #endif
  485. #ifdef CONFIG_PPC_DOORBELL
  486. if (cpu_has_feature(CPU_FTR_DBELL)) {
  487. seq_printf(p, "%*s: ", prec, "DBL");
  488. for_each_online_cpu(j)
  489. seq_printf(p, "%10u ", per_cpu(irq_stat, j).doorbell_irqs);
  490. seq_printf(p, " Doorbell interrupts\n");
  491. }
  492. #endif
  493. return 0;
  494. }
  495. /*
  496. * /proc/stat helpers
  497. */
  498. u64 arch_irq_stat_cpu(unsigned int cpu)
  499. {
  500. u64 sum = per_cpu(irq_stat, cpu).timer_irqs_event;
  501. sum += per_cpu(irq_stat, cpu).broadcast_irqs_event;
  502. sum += per_cpu(irq_stat, cpu).pmu_irqs;
  503. sum += per_cpu(irq_stat, cpu).mce_exceptions;
  504. sum += per_cpu(irq_stat, cpu).spurious_irqs;
  505. sum += per_cpu(irq_stat, cpu).timer_irqs_others;
  506. sum += per_cpu(irq_stat, cpu).hmi_exceptions;
  507. sum += per_cpu(irq_stat, cpu).sreset_irqs;
  508. #ifdef CONFIG_PPC_WATCHDOG
  509. sum += per_cpu(irq_stat, cpu).soft_nmi_irqs;
  510. #endif
  511. #ifdef CONFIG_PPC_DOORBELL
  512. sum += per_cpu(irq_stat, cpu).doorbell_irqs;
  513. #endif
  514. return sum;
  515. }
  516. static inline void check_stack_overflow(void)
  517. {
  518. #ifdef CONFIG_DEBUG_STACKOVERFLOW
  519. long sp;
  520. sp = current_stack_pointer() & (THREAD_SIZE-1);
  521. /* check for stack overflow: is there less than 2KB free? */
  522. if (unlikely(sp < (sizeof(struct thread_info) + 2048))) {
  523. pr_err("do_IRQ: stack overflow: %ld\n",
  524. sp - sizeof(struct thread_info));
  525. dump_stack();
  526. }
  527. #endif
  528. }
  529. void __do_irq(struct pt_regs *regs)
  530. {
  531. unsigned int irq;
  532. irq_enter();
  533. trace_irq_entry(regs);
  534. check_stack_overflow();
  535. /*
  536. * Query the platform PIC for the interrupt & ack it.
  537. *
  538. * This will typically lower the interrupt line to the CPU
  539. */
  540. irq = ppc_md.get_irq();
  541. /* We can hard enable interrupts now to allow perf interrupts */
  542. may_hard_irq_enable();
  543. /* And finally process it */
  544. if (unlikely(!irq))
  545. __this_cpu_inc(irq_stat.spurious_irqs);
  546. else
  547. generic_handle_irq(irq);
  548. trace_irq_exit(regs);
  549. irq_exit();
  550. }
  551. void do_IRQ(struct pt_regs *regs)
  552. {
  553. struct pt_regs *old_regs = set_irq_regs(regs);
  554. struct thread_info *curtp, *irqtp, *sirqtp;
  555. /* Switch to the irq stack to handle this */
  556. curtp = current_thread_info();
  557. irqtp = hardirq_ctx[raw_smp_processor_id()];
  558. sirqtp = softirq_ctx[raw_smp_processor_id()];
  559. /* Already there ? */
  560. if (unlikely(curtp == irqtp || curtp == sirqtp)) {
  561. __do_irq(regs);
  562. set_irq_regs(old_regs);
  563. return;
  564. }
  565. /* Prepare the thread_info in the irq stack */
  566. irqtp->task = curtp->task;
  567. irqtp->flags = 0;
  568. /* Copy the preempt_count so that the [soft]irq checks work. */
  569. irqtp->preempt_count = curtp->preempt_count;
  570. /* Switch stack and call */
  571. call_do_irq(regs, irqtp);
  572. /* Restore stack limit */
  573. irqtp->task = NULL;
  574. /* Copy back updates to the thread_info */
  575. if (irqtp->flags)
  576. set_bits(irqtp->flags, &curtp->flags);
  577. set_irq_regs(old_regs);
  578. }
  579. void __init init_IRQ(void)
  580. {
  581. if (ppc_md.init_IRQ)
  582. ppc_md.init_IRQ();
  583. exc_lvl_ctx_init();
  584. irq_ctx_init();
  585. }
  586. #if defined(CONFIG_BOOKE) || defined(CONFIG_40x)
  587. struct thread_info *critirq_ctx[NR_CPUS] __read_mostly;
  588. struct thread_info *dbgirq_ctx[NR_CPUS] __read_mostly;
  589. struct thread_info *mcheckirq_ctx[NR_CPUS] __read_mostly;
  590. void exc_lvl_ctx_init(void)
  591. {
  592. struct thread_info *tp;
  593. int i, cpu_nr;
  594. for_each_possible_cpu(i) {
  595. #ifdef CONFIG_PPC64
  596. cpu_nr = i;
  597. #else
  598. #ifdef CONFIG_SMP
  599. cpu_nr = get_hard_smp_processor_id(i);
  600. #else
  601. cpu_nr = 0;
  602. #endif
  603. #endif
  604. memset((void *)critirq_ctx[cpu_nr], 0, THREAD_SIZE);
  605. tp = critirq_ctx[cpu_nr];
  606. tp->cpu = cpu_nr;
  607. tp->preempt_count = 0;
  608. #ifdef CONFIG_BOOKE
  609. memset((void *)dbgirq_ctx[cpu_nr], 0, THREAD_SIZE);
  610. tp = dbgirq_ctx[cpu_nr];
  611. tp->cpu = cpu_nr;
  612. tp->preempt_count = 0;
  613. memset((void *)mcheckirq_ctx[cpu_nr], 0, THREAD_SIZE);
  614. tp = mcheckirq_ctx[cpu_nr];
  615. tp->cpu = cpu_nr;
  616. tp->preempt_count = HARDIRQ_OFFSET;
  617. #endif
  618. }
  619. }
  620. #endif
  621. struct thread_info *softirq_ctx[NR_CPUS] __read_mostly;
  622. struct thread_info *hardirq_ctx[NR_CPUS] __read_mostly;
  623. void irq_ctx_init(void)
  624. {
  625. struct thread_info *tp;
  626. int i;
  627. for_each_possible_cpu(i) {
  628. memset((void *)softirq_ctx[i], 0, THREAD_SIZE);
  629. tp = softirq_ctx[i];
  630. tp->cpu = i;
  631. klp_init_thread_info(tp);
  632. memset((void *)hardirq_ctx[i], 0, THREAD_SIZE);
  633. tp = hardirq_ctx[i];
  634. tp->cpu = i;
  635. klp_init_thread_info(tp);
  636. }
  637. }
  638. void do_softirq_own_stack(void)
  639. {
  640. struct thread_info *curtp, *irqtp;
  641. curtp = current_thread_info();
  642. irqtp = softirq_ctx[smp_processor_id()];
  643. irqtp->task = curtp->task;
  644. irqtp->flags = 0;
  645. call_do_softirq(irqtp);
  646. irqtp->task = NULL;
  647. /* Set any flag that may have been set on the
  648. * alternate stack
  649. */
  650. if (irqtp->flags)
  651. set_bits(irqtp->flags, &curtp->flags);
  652. }
  653. irq_hw_number_t virq_to_hw(unsigned int virq)
  654. {
  655. struct irq_data *irq_data = irq_get_irq_data(virq);
  656. return WARN_ON(!irq_data) ? 0 : irq_data->hwirq;
  657. }
  658. EXPORT_SYMBOL_GPL(virq_to_hw);
  659. #ifdef CONFIG_SMP
  660. int irq_choose_cpu(const struct cpumask *mask)
  661. {
  662. int cpuid;
  663. if (cpumask_equal(mask, cpu_online_mask)) {
  664. static int irq_rover;
  665. static DEFINE_RAW_SPINLOCK(irq_rover_lock);
  666. unsigned long flags;
  667. /* Round-robin distribution... */
  668. do_round_robin:
  669. raw_spin_lock_irqsave(&irq_rover_lock, flags);
  670. irq_rover = cpumask_next(irq_rover, cpu_online_mask);
  671. if (irq_rover >= nr_cpu_ids)
  672. irq_rover = cpumask_first(cpu_online_mask);
  673. cpuid = irq_rover;
  674. raw_spin_unlock_irqrestore(&irq_rover_lock, flags);
  675. } else {
  676. cpuid = cpumask_first_and(mask, cpu_online_mask);
  677. if (cpuid >= nr_cpu_ids)
  678. goto do_round_robin;
  679. }
  680. return get_hard_smp_processor_id(cpuid);
  681. }
  682. #else
  683. int irq_choose_cpu(const struct cpumask *mask)
  684. {
  685. return hard_smp_processor_id();
  686. }
  687. #endif
  688. int arch_early_irq_init(void)
  689. {
  690. return 0;
  691. }
  692. #ifdef CONFIG_PPC64
  693. static int __init setup_noirqdistrib(char *str)
  694. {
  695. distribute_irqs = 0;
  696. return 1;
  697. }
  698. __setup("noirqdistrib", setup_noirqdistrib);
  699. #endif /* CONFIG_PPC64 */