irq.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053
  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_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/bootmem.h>
  52. #include <linux/pci.h>
  53. #include <linux/debugfs.h>
  54. #include <linux/of.h>
  55. #include <linux/of_irq.h>
  56. #include <asm/uaccess.h>
  57. #include <asm/system.h>
  58. #include <asm/io.h>
  59. #include <asm/pgtable.h>
  60. #include <asm/irq.h>
  61. #include <asm/cache.h>
  62. #include <asm/prom.h>
  63. #include <asm/ptrace.h>
  64. #include <asm/machdep.h>
  65. #include <asm/udbg.h>
  66. #include <asm/smp.h>
  67. #ifdef CONFIG_PPC64
  68. #include <asm/paca.h>
  69. #include <asm/firmware.h>
  70. #include <asm/lv1call.h>
  71. #endif
  72. #define CREATE_TRACE_POINTS
  73. #include <asm/trace.h>
  74. DEFINE_PER_CPU_SHARED_ALIGNED(irq_cpustat_t, irq_stat);
  75. EXPORT_PER_CPU_SYMBOL(irq_stat);
  76. int __irq_offset_value;
  77. #ifdef CONFIG_PPC32
  78. EXPORT_SYMBOL(__irq_offset_value);
  79. atomic_t ppc_n_lost_interrupts;
  80. #ifdef CONFIG_TAU_INT
  81. extern int tau_initialized;
  82. extern int tau_interrupts(int);
  83. #endif
  84. #endif /* CONFIG_PPC32 */
  85. #ifdef CONFIG_PPC64
  86. #ifndef CONFIG_SPARSE_IRQ
  87. EXPORT_SYMBOL(irq_desc);
  88. #endif
  89. int distribute_irqs = 1;
  90. static inline notrace unsigned long get_hard_enabled(void)
  91. {
  92. unsigned long enabled;
  93. __asm__ __volatile__("lbz %0,%1(13)"
  94. : "=r" (enabled) : "i" (offsetof(struct paca_struct, hard_enabled)));
  95. return enabled;
  96. }
  97. static inline notrace void set_soft_enabled(unsigned long enable)
  98. {
  99. __asm__ __volatile__("stb %0,%1(13)"
  100. : : "r" (enable), "i" (offsetof(struct paca_struct, soft_enabled)));
  101. }
  102. static inline notrace void decrementer_check_overflow(void)
  103. {
  104. u64 now = get_tb_or_rtc();
  105. u64 *next_tb = &__get_cpu_var(decrementers_next_tb);
  106. if (now >= *next_tb)
  107. set_dec(1);
  108. }
  109. notrace void arch_local_irq_restore(unsigned long en)
  110. {
  111. /*
  112. * get_paca()->soft_enabled = en;
  113. * Is it ever valid to use local_irq_restore(0) when soft_enabled is 1?
  114. * That was allowed before, and in such a case we do need to take care
  115. * that gcc will set soft_enabled directly via r13, not choose to use
  116. * an intermediate register, lest we're preempted to a different cpu.
  117. */
  118. set_soft_enabled(en);
  119. if (!en)
  120. return;
  121. #ifdef CONFIG_PPC_STD_MMU_64
  122. if (firmware_has_feature(FW_FEATURE_ISERIES)) {
  123. /*
  124. * Do we need to disable preemption here? Not really: in the
  125. * unlikely event that we're preempted to a different cpu in
  126. * between getting r13, loading its lppaca_ptr, and loading
  127. * its any_int, we might call iseries_handle_interrupts without
  128. * an interrupt pending on the new cpu, but that's no disaster,
  129. * is it? And the business of preempting us off the old cpu
  130. * would itself involve a local_irq_restore which handles the
  131. * interrupt to that cpu.
  132. *
  133. * But use "local_paca->lppaca_ptr" instead of "get_lppaca()"
  134. * to avoid any preemption checking added into get_paca().
  135. */
  136. if (local_paca->lppaca_ptr->int_dword.any_int)
  137. iseries_handle_interrupts();
  138. }
  139. #endif /* CONFIG_PPC_STD_MMU_64 */
  140. /*
  141. * if (get_paca()->hard_enabled) return;
  142. * But again we need to take care that gcc gets hard_enabled directly
  143. * via r13, not choose to use an intermediate register, lest we're
  144. * preempted to a different cpu in between the two instructions.
  145. */
  146. if (get_hard_enabled())
  147. return;
  148. /*
  149. * Need to hard-enable interrupts here. Since currently disabled,
  150. * no need to take further asm precautions against preemption; but
  151. * use local_paca instead of get_paca() to avoid preemption checking.
  152. */
  153. local_paca->hard_enabled = en;
  154. /*
  155. * Trigger the decrementer if we have a pending event. Some processors
  156. * only trigger on edge transitions of the sign bit. We might also
  157. * have disabled interrupts long enough that the decrementer wrapped
  158. * to positive.
  159. */
  160. decrementer_check_overflow();
  161. /*
  162. * Force the delivery of pending soft-disabled interrupts on PS3.
  163. * Any HV call will have this side effect.
  164. */
  165. if (firmware_has_feature(FW_FEATURE_PS3_LV1)) {
  166. u64 tmp, tmp2;
  167. lv1_get_version_info(&tmp, &tmp2);
  168. }
  169. __hard_irq_enable();
  170. }
  171. EXPORT_SYMBOL(arch_local_irq_restore);
  172. #endif /* CONFIG_PPC64 */
  173. int arch_show_interrupts(struct seq_file *p, int prec)
  174. {
  175. int j;
  176. #if defined(CONFIG_PPC32) && defined(CONFIG_TAU_INT)
  177. if (tau_initialized) {
  178. seq_printf(p, "%*s: ", prec, "TAU");
  179. for_each_online_cpu(j)
  180. seq_printf(p, "%10u ", tau_interrupts(j));
  181. seq_puts(p, " PowerPC Thermal Assist (cpu temp)\n");
  182. }
  183. #endif /* CONFIG_PPC32 && CONFIG_TAU_INT */
  184. seq_printf(p, "%*s: ", prec, "LOC");
  185. for_each_online_cpu(j)
  186. seq_printf(p, "%10u ", per_cpu(irq_stat, j).timer_irqs);
  187. seq_printf(p, " Local timer interrupts\n");
  188. seq_printf(p, "%*s: ", prec, "SPU");
  189. for_each_online_cpu(j)
  190. seq_printf(p, "%10u ", per_cpu(irq_stat, j).spurious_irqs);
  191. seq_printf(p, " Spurious interrupts\n");
  192. seq_printf(p, "%*s: ", prec, "CNT");
  193. for_each_online_cpu(j)
  194. seq_printf(p, "%10u ", per_cpu(irq_stat, j).pmu_irqs);
  195. seq_printf(p, " Performance monitoring interrupts\n");
  196. seq_printf(p, "%*s: ", prec, "MCE");
  197. for_each_online_cpu(j)
  198. seq_printf(p, "%10u ", per_cpu(irq_stat, j).mce_exceptions);
  199. seq_printf(p, " Machine check exceptions\n");
  200. return 0;
  201. }
  202. /*
  203. * /proc/stat helpers
  204. */
  205. u64 arch_irq_stat_cpu(unsigned int cpu)
  206. {
  207. u64 sum = per_cpu(irq_stat, cpu).timer_irqs;
  208. sum += per_cpu(irq_stat, cpu).pmu_irqs;
  209. sum += per_cpu(irq_stat, cpu).mce_exceptions;
  210. sum += per_cpu(irq_stat, cpu).spurious_irqs;
  211. return sum;
  212. }
  213. #ifdef CONFIG_HOTPLUG_CPU
  214. void migrate_irqs(void)
  215. {
  216. struct irq_desc *desc;
  217. unsigned int irq;
  218. static int warned;
  219. cpumask_var_t mask;
  220. const struct cpumask *map = cpu_online_mask;
  221. alloc_cpumask_var(&mask, GFP_KERNEL);
  222. for_each_irq(irq) {
  223. struct irq_data *data;
  224. struct irq_chip *chip;
  225. desc = irq_to_desc(irq);
  226. if (!desc)
  227. continue;
  228. data = irq_desc_get_irq_data(desc);
  229. if (irqd_is_per_cpu(data))
  230. continue;
  231. chip = irq_data_get_irq_chip(data);
  232. cpumask_and(mask, data->affinity, map);
  233. if (cpumask_any(mask) >= nr_cpu_ids) {
  234. printk("Breaking affinity for irq %i\n", irq);
  235. cpumask_copy(mask, map);
  236. }
  237. if (chip->irq_set_affinity)
  238. chip->irq_set_affinity(data, mask, true);
  239. else if (desc->action && !(warned++))
  240. printk("Cannot set affinity for irq %i\n", irq);
  241. }
  242. free_cpumask_var(mask);
  243. local_irq_enable();
  244. mdelay(1);
  245. local_irq_disable();
  246. }
  247. #endif
  248. static inline void handle_one_irq(unsigned int irq)
  249. {
  250. struct thread_info *curtp, *irqtp;
  251. unsigned long saved_sp_limit;
  252. struct irq_desc *desc;
  253. desc = irq_to_desc(irq);
  254. if (!desc)
  255. return;
  256. /* Switch to the irq stack to handle this */
  257. curtp = current_thread_info();
  258. irqtp = hardirq_ctx[smp_processor_id()];
  259. if (curtp == irqtp) {
  260. /* We're already on the irq stack, just handle it */
  261. desc->handle_irq(irq, desc);
  262. return;
  263. }
  264. saved_sp_limit = current->thread.ksp_limit;
  265. irqtp->task = curtp->task;
  266. irqtp->flags = 0;
  267. /* Copy the softirq bits in preempt_count so that the
  268. * softirq checks work in the hardirq context. */
  269. irqtp->preempt_count = (irqtp->preempt_count & ~SOFTIRQ_MASK) |
  270. (curtp->preempt_count & SOFTIRQ_MASK);
  271. current->thread.ksp_limit = (unsigned long)irqtp +
  272. _ALIGN_UP(sizeof(struct thread_info), 16);
  273. call_handle_irq(irq, desc, irqtp, desc->handle_irq);
  274. current->thread.ksp_limit = saved_sp_limit;
  275. irqtp->task = NULL;
  276. /* Set any flag that may have been set on the
  277. * alternate stack
  278. */
  279. if (irqtp->flags)
  280. set_bits(irqtp->flags, &curtp->flags);
  281. }
  282. static inline void check_stack_overflow(void)
  283. {
  284. #ifdef CONFIG_DEBUG_STACKOVERFLOW
  285. long sp;
  286. sp = __get_SP() & (THREAD_SIZE-1);
  287. /* check for stack overflow: is there less than 2KB free? */
  288. if (unlikely(sp < (sizeof(struct thread_info) + 2048))) {
  289. printk("do_IRQ: stack overflow: %ld\n",
  290. sp - sizeof(struct thread_info));
  291. dump_stack();
  292. }
  293. #endif
  294. }
  295. void do_IRQ(struct pt_regs *regs)
  296. {
  297. struct pt_regs *old_regs = set_irq_regs(regs);
  298. unsigned int irq;
  299. trace_irq_entry(regs);
  300. irq_enter();
  301. check_stack_overflow();
  302. irq = ppc_md.get_irq();
  303. if (irq != NO_IRQ && irq != NO_IRQ_IGNORE)
  304. handle_one_irq(irq);
  305. else if (irq != NO_IRQ_IGNORE)
  306. __get_cpu_var(irq_stat).spurious_irqs++;
  307. irq_exit();
  308. set_irq_regs(old_regs);
  309. #ifdef CONFIG_PPC_ISERIES
  310. if (firmware_has_feature(FW_FEATURE_ISERIES) &&
  311. get_lppaca()->int_dword.fields.decr_int) {
  312. get_lppaca()->int_dword.fields.decr_int = 0;
  313. /* Signal a fake decrementer interrupt */
  314. timer_interrupt(regs);
  315. }
  316. #endif
  317. trace_irq_exit(regs);
  318. }
  319. void __init init_IRQ(void)
  320. {
  321. if (ppc_md.init_IRQ)
  322. ppc_md.init_IRQ();
  323. exc_lvl_ctx_init();
  324. irq_ctx_init();
  325. }
  326. #if defined(CONFIG_BOOKE) || defined(CONFIG_40x)
  327. struct thread_info *critirq_ctx[NR_CPUS] __read_mostly;
  328. struct thread_info *dbgirq_ctx[NR_CPUS] __read_mostly;
  329. struct thread_info *mcheckirq_ctx[NR_CPUS] __read_mostly;
  330. void exc_lvl_ctx_init(void)
  331. {
  332. struct thread_info *tp;
  333. int i, cpu_nr;
  334. for_each_possible_cpu(i) {
  335. #ifdef CONFIG_PPC64
  336. cpu_nr = i;
  337. #else
  338. cpu_nr = get_hard_smp_processor_id(i);
  339. #endif
  340. memset((void *)critirq_ctx[cpu_nr], 0, THREAD_SIZE);
  341. tp = critirq_ctx[cpu_nr];
  342. tp->cpu = cpu_nr;
  343. tp->preempt_count = 0;
  344. #ifdef CONFIG_BOOKE
  345. memset((void *)dbgirq_ctx[cpu_nr], 0, THREAD_SIZE);
  346. tp = dbgirq_ctx[cpu_nr];
  347. tp->cpu = cpu_nr;
  348. tp->preempt_count = 0;
  349. memset((void *)mcheckirq_ctx[cpu_nr], 0, THREAD_SIZE);
  350. tp = mcheckirq_ctx[cpu_nr];
  351. tp->cpu = cpu_nr;
  352. tp->preempt_count = HARDIRQ_OFFSET;
  353. #endif
  354. }
  355. }
  356. #endif
  357. struct thread_info *softirq_ctx[NR_CPUS] __read_mostly;
  358. struct thread_info *hardirq_ctx[NR_CPUS] __read_mostly;
  359. void irq_ctx_init(void)
  360. {
  361. struct thread_info *tp;
  362. int i;
  363. for_each_possible_cpu(i) {
  364. memset((void *)softirq_ctx[i], 0, THREAD_SIZE);
  365. tp = softirq_ctx[i];
  366. tp->cpu = i;
  367. tp->preempt_count = 0;
  368. memset((void *)hardirq_ctx[i], 0, THREAD_SIZE);
  369. tp = hardirq_ctx[i];
  370. tp->cpu = i;
  371. tp->preempt_count = HARDIRQ_OFFSET;
  372. }
  373. }
  374. static inline void do_softirq_onstack(void)
  375. {
  376. struct thread_info *curtp, *irqtp;
  377. unsigned long saved_sp_limit = current->thread.ksp_limit;
  378. curtp = current_thread_info();
  379. irqtp = softirq_ctx[smp_processor_id()];
  380. irqtp->task = curtp->task;
  381. irqtp->flags = 0;
  382. current->thread.ksp_limit = (unsigned long)irqtp +
  383. _ALIGN_UP(sizeof(struct thread_info), 16);
  384. call_do_softirq(irqtp);
  385. current->thread.ksp_limit = saved_sp_limit;
  386. irqtp->task = NULL;
  387. /* Set any flag that may have been set on the
  388. * alternate stack
  389. */
  390. if (irqtp->flags)
  391. set_bits(irqtp->flags, &curtp->flags);
  392. }
  393. void do_softirq(void)
  394. {
  395. unsigned long flags;
  396. if (in_interrupt())
  397. return;
  398. local_irq_save(flags);
  399. if (local_softirq_pending())
  400. do_softirq_onstack();
  401. local_irq_restore(flags);
  402. }
  403. /*
  404. * IRQ controller and virtual interrupts
  405. */
  406. static LIST_HEAD(irq_domain_list);
  407. static DEFINE_MUTEX(irq_domain_mutex);
  408. static DEFINE_MUTEX(revmap_trees_mutex);
  409. static unsigned int irq_virq_count = NR_IRQS;
  410. static struct irq_domain *irq_default_host;
  411. irq_hw_number_t irqd_to_hwirq(struct irq_data *d)
  412. {
  413. return d->hwirq;
  414. }
  415. EXPORT_SYMBOL_GPL(irqd_to_hwirq);
  416. irq_hw_number_t virq_to_hw(unsigned int virq)
  417. {
  418. struct irq_data *irq_data = irq_get_irq_data(virq);
  419. return WARN_ON(!irq_data) ? 0 : irq_data->hwirq;
  420. }
  421. EXPORT_SYMBOL_GPL(virq_to_hw);
  422. static int default_irq_host_match(struct irq_domain *h, struct device_node *np)
  423. {
  424. return h->of_node != NULL && h->of_node == np;
  425. }
  426. struct irq_domain *irq_alloc_host(struct device_node *of_node,
  427. unsigned int revmap_type,
  428. unsigned int revmap_arg,
  429. struct irq_domain_ops *ops,
  430. irq_hw_number_t inval_irq)
  431. {
  432. struct irq_domain *host, *h;
  433. unsigned int size = sizeof(struct irq_domain);
  434. unsigned int i;
  435. unsigned int *rmap;
  436. /* Allocate structure and revmap table if using linear mapping */
  437. if (revmap_type == IRQ_DOMAIN_MAP_LINEAR)
  438. size += revmap_arg * sizeof(unsigned int);
  439. host = kzalloc(size, GFP_KERNEL);
  440. if (host == NULL)
  441. return NULL;
  442. /* Fill structure */
  443. host->revmap_type = revmap_type;
  444. host->inval_irq = inval_irq;
  445. host->ops = ops;
  446. host->of_node = of_node_get(of_node);
  447. if (host->ops->match == NULL)
  448. host->ops->match = default_irq_host_match;
  449. mutex_lock(&irq_domain_mutex);
  450. /* Make sure only one legacy controller can be created */
  451. if (revmap_type == IRQ_DOMAIN_MAP_LEGACY) {
  452. list_for_each_entry(h, &irq_domain_list, link) {
  453. if (WARN_ON(h->revmap_type == IRQ_DOMAIN_MAP_LEGACY)) {
  454. mutex_unlock(&irq_domain_mutex);
  455. of_node_put(host->of_node);
  456. kfree(host);
  457. return NULL;
  458. }
  459. }
  460. }
  461. list_add(&host->link, &irq_domain_list);
  462. mutex_unlock(&irq_domain_mutex);
  463. /* Additional setups per revmap type */
  464. switch(revmap_type) {
  465. case IRQ_DOMAIN_MAP_LEGACY:
  466. /* 0 is always the invalid number for legacy */
  467. host->inval_irq = 0;
  468. /* setup us as the host for all legacy interrupts */
  469. for (i = 1; i < NUM_ISA_INTERRUPTS; i++) {
  470. struct irq_data *irq_data = irq_get_irq_data(i);
  471. irq_data->hwirq = i;
  472. irq_data->domain = host;
  473. /* Legacy flags are left to default at this point,
  474. * one can then use irq_create_mapping() to
  475. * explicitly change them
  476. */
  477. ops->map(host, i, i);
  478. /* Clear norequest flags */
  479. irq_clear_status_flags(i, IRQ_NOREQUEST);
  480. }
  481. break;
  482. case IRQ_DOMAIN_MAP_LINEAR:
  483. rmap = (unsigned int *)(host + 1);
  484. for (i = 0; i < revmap_arg; i++)
  485. rmap[i] = NO_IRQ;
  486. host->revmap_data.linear.size = revmap_arg;
  487. host->revmap_data.linear.revmap = rmap;
  488. break;
  489. case IRQ_DOMAIN_MAP_TREE:
  490. INIT_RADIX_TREE(&host->revmap_data.tree, GFP_KERNEL);
  491. break;
  492. default:
  493. break;
  494. }
  495. pr_debug("irq: Allocated host of type %d @0x%p\n", revmap_type, host);
  496. return host;
  497. }
  498. struct irq_domain *irq_find_host(struct device_node *node)
  499. {
  500. struct irq_domain *h, *found = NULL;
  501. /* We might want to match the legacy controller last since
  502. * it might potentially be set to match all interrupts in
  503. * the absence of a device node. This isn't a problem so far
  504. * yet though...
  505. */
  506. mutex_lock(&irq_domain_mutex);
  507. list_for_each_entry(h, &irq_domain_list, link)
  508. if (h->ops->match(h, node)) {
  509. found = h;
  510. break;
  511. }
  512. mutex_unlock(&irq_domain_mutex);
  513. return found;
  514. }
  515. EXPORT_SYMBOL_GPL(irq_find_host);
  516. void irq_set_default_host(struct irq_domain *host)
  517. {
  518. pr_debug("irq: Default host set to @0x%p\n", host);
  519. irq_default_host = host;
  520. }
  521. void irq_set_virq_count(unsigned int count)
  522. {
  523. pr_debug("irq: Trying to set virq count to %d\n", count);
  524. BUG_ON(count < NUM_ISA_INTERRUPTS);
  525. if (count < NR_IRQS)
  526. irq_virq_count = count;
  527. }
  528. static int irq_setup_virq(struct irq_domain *host, unsigned int virq,
  529. irq_hw_number_t hwirq)
  530. {
  531. struct irq_data *irq_data = irq_get_irq_data(virq);
  532. irq_data->hwirq = hwirq;
  533. irq_data->domain = host;
  534. if (host->ops->map(host, virq, hwirq)) {
  535. pr_debug("irq: -> mapping failed, freeing\n");
  536. irq_data->domain = NULL;
  537. irq_data->hwirq = 0;
  538. return -1;
  539. }
  540. irq_clear_status_flags(virq, IRQ_NOREQUEST);
  541. return 0;
  542. }
  543. unsigned int irq_create_direct_mapping(struct irq_domain *host)
  544. {
  545. unsigned int virq;
  546. if (host == NULL)
  547. host = irq_default_host;
  548. BUG_ON(host == NULL);
  549. WARN_ON(host->revmap_type != IRQ_DOMAIN_MAP_NOMAP);
  550. virq = irq_alloc_desc_from(1, 0);
  551. if (virq == NO_IRQ) {
  552. pr_debug("irq: create_direct virq allocation failed\n");
  553. return NO_IRQ;
  554. }
  555. if (virq >= irq_virq_count) {
  556. pr_err("ERROR: no free irqs available below %i maximum\n",
  557. irq_virq_count);
  558. irq_free_desc(virq);
  559. return 0;
  560. }
  561. pr_debug("irq: create_direct obtained virq %d\n", virq);
  562. if (irq_setup_virq(host, virq, virq)) {
  563. irq_free_desc(virq);
  564. return NO_IRQ;
  565. }
  566. return virq;
  567. }
  568. unsigned int irq_create_mapping(struct irq_domain *host,
  569. irq_hw_number_t hwirq)
  570. {
  571. unsigned int virq, hint;
  572. pr_debug("irq: irq_create_mapping(0x%p, 0x%lx)\n", host, hwirq);
  573. /* Look for default host if nececssary */
  574. if (host == NULL)
  575. host = irq_default_host;
  576. if (host == NULL) {
  577. printk(KERN_WARNING "irq_create_mapping called for"
  578. " NULL host, hwirq=%lx\n", hwirq);
  579. WARN_ON(1);
  580. return NO_IRQ;
  581. }
  582. pr_debug("irq: -> using host @%p\n", host);
  583. /* Check if mapping already exists */
  584. virq = irq_find_mapping(host, hwirq);
  585. if (virq != NO_IRQ) {
  586. pr_debug("irq: -> existing mapping on virq %d\n", virq);
  587. return virq;
  588. }
  589. /* Get a virtual interrupt number */
  590. if (host->revmap_type == IRQ_DOMAIN_MAP_LEGACY) {
  591. /* Handle legacy */
  592. virq = (unsigned int)hwirq;
  593. if (virq == 0 || virq >= NUM_ISA_INTERRUPTS)
  594. return NO_IRQ;
  595. return virq;
  596. } else {
  597. /* Allocate a virtual interrupt number */
  598. hint = hwirq % irq_virq_count;
  599. if (hint == 0)
  600. hint = 1;
  601. virq = irq_alloc_desc_from(hint, 0);
  602. if (!virq)
  603. virq = irq_alloc_desc_from(1, 0);
  604. if (virq == NO_IRQ) {
  605. pr_debug("irq: -> virq allocation failed\n");
  606. return NO_IRQ;
  607. }
  608. }
  609. if (irq_setup_virq(host, virq, hwirq)) {
  610. if (host->revmap_type != IRQ_DOMAIN_MAP_LEGACY)
  611. irq_free_desc(virq);
  612. return NO_IRQ;
  613. }
  614. pr_debug("irq: irq %lu on host %s mapped to virtual irq %u\n",
  615. hwirq, host->of_node ? host->of_node->full_name : "null", virq);
  616. return virq;
  617. }
  618. EXPORT_SYMBOL_GPL(irq_create_mapping);
  619. unsigned int irq_create_of_mapping(struct device_node *controller,
  620. const u32 *intspec, unsigned int intsize)
  621. {
  622. struct irq_domain *host;
  623. irq_hw_number_t hwirq;
  624. unsigned int type = IRQ_TYPE_NONE;
  625. unsigned int virq;
  626. if (controller == NULL)
  627. host = irq_default_host;
  628. else
  629. host = irq_find_host(controller);
  630. if (host == NULL) {
  631. printk(KERN_WARNING "irq: no irq host found for %s !\n",
  632. controller->full_name);
  633. return NO_IRQ;
  634. }
  635. /* If host has no translation, then we assume interrupt line */
  636. if (host->ops->xlate == NULL)
  637. hwirq = intspec[0];
  638. else {
  639. if (host->ops->xlate(host, controller, intspec, intsize,
  640. &hwirq, &type))
  641. return NO_IRQ;
  642. }
  643. /* Create mapping */
  644. virq = irq_create_mapping(host, hwirq);
  645. if (virq == NO_IRQ)
  646. return virq;
  647. /* Set type if specified and different than the current one */
  648. if (type != IRQ_TYPE_NONE &&
  649. type != (irqd_get_trigger_type(irq_get_irq_data(virq))))
  650. irq_set_irq_type(virq, type);
  651. return virq;
  652. }
  653. EXPORT_SYMBOL_GPL(irq_create_of_mapping);
  654. void irq_dispose_mapping(unsigned int virq)
  655. {
  656. struct irq_data *irq_data = irq_get_irq_data(virq);
  657. struct irq_domain *host;
  658. irq_hw_number_t hwirq;
  659. if (virq == NO_IRQ || !irq_data)
  660. return;
  661. host = irq_data->domain;
  662. if (WARN_ON(host == NULL))
  663. return;
  664. /* Never unmap legacy interrupts */
  665. if (host->revmap_type == IRQ_DOMAIN_MAP_LEGACY)
  666. return;
  667. irq_set_status_flags(virq, IRQ_NOREQUEST);
  668. /* remove chip and handler */
  669. irq_set_chip_and_handler(virq, NULL, NULL);
  670. /* Make sure it's completed */
  671. synchronize_irq(virq);
  672. /* Tell the PIC about it */
  673. if (host->ops->unmap)
  674. host->ops->unmap(host, virq);
  675. smp_mb();
  676. /* Clear reverse map */
  677. hwirq = irq_data->hwirq;
  678. switch(host->revmap_type) {
  679. case IRQ_DOMAIN_MAP_LINEAR:
  680. if (hwirq < host->revmap_data.linear.size)
  681. host->revmap_data.linear.revmap[hwirq] = NO_IRQ;
  682. break;
  683. case IRQ_DOMAIN_MAP_TREE:
  684. mutex_lock(&revmap_trees_mutex);
  685. radix_tree_delete(&host->revmap_data.tree, hwirq);
  686. mutex_unlock(&revmap_trees_mutex);
  687. break;
  688. }
  689. /* Destroy map */
  690. irq_data->hwirq = host->inval_irq;
  691. irq_free_desc(virq);
  692. }
  693. EXPORT_SYMBOL_GPL(irq_dispose_mapping);
  694. unsigned int irq_find_mapping(struct irq_domain *host,
  695. irq_hw_number_t hwirq)
  696. {
  697. unsigned int i;
  698. unsigned int hint = hwirq % irq_virq_count;
  699. /* Look for default host if nececssary */
  700. if (host == NULL)
  701. host = irq_default_host;
  702. if (host == NULL)
  703. return NO_IRQ;
  704. /* legacy -> bail early */
  705. if (host->revmap_type == IRQ_DOMAIN_MAP_LEGACY)
  706. return hwirq;
  707. /* Slow path does a linear search of the map */
  708. if (hint == 0)
  709. hint = 1;
  710. i = hint;
  711. do {
  712. struct irq_data *data = irq_get_irq_data(i);
  713. if (data && (data->domain == host) && (data->hwirq == hwirq))
  714. return i;
  715. i++;
  716. if (i >= irq_virq_count)
  717. i = 1;
  718. } while(i != hint);
  719. return NO_IRQ;
  720. }
  721. EXPORT_SYMBOL_GPL(irq_find_mapping);
  722. #ifdef CONFIG_SMP
  723. int irq_choose_cpu(const struct cpumask *mask)
  724. {
  725. int cpuid;
  726. if (cpumask_equal(mask, cpu_all_mask)) {
  727. static int irq_rover;
  728. static DEFINE_RAW_SPINLOCK(irq_rover_lock);
  729. unsigned long flags;
  730. /* Round-robin distribution... */
  731. do_round_robin:
  732. raw_spin_lock_irqsave(&irq_rover_lock, flags);
  733. irq_rover = cpumask_next(irq_rover, cpu_online_mask);
  734. if (irq_rover >= nr_cpu_ids)
  735. irq_rover = cpumask_first(cpu_online_mask);
  736. cpuid = irq_rover;
  737. raw_spin_unlock_irqrestore(&irq_rover_lock, flags);
  738. } else {
  739. cpuid = cpumask_first_and(mask, cpu_online_mask);
  740. if (cpuid >= nr_cpu_ids)
  741. goto do_round_robin;
  742. }
  743. return get_hard_smp_processor_id(cpuid);
  744. }
  745. #else
  746. int irq_choose_cpu(const struct cpumask *mask)
  747. {
  748. return hard_smp_processor_id();
  749. }
  750. #endif
  751. unsigned int irq_radix_revmap_lookup(struct irq_domain *host,
  752. irq_hw_number_t hwirq)
  753. {
  754. struct irq_data *irq_data;
  755. if (WARN_ON_ONCE(host->revmap_type != IRQ_DOMAIN_MAP_TREE))
  756. return irq_find_mapping(host, hwirq);
  757. /*
  758. * Freeing an irq can delete nodes along the path to
  759. * do the lookup via call_rcu.
  760. */
  761. rcu_read_lock();
  762. irq_data = radix_tree_lookup(&host->revmap_data.tree, hwirq);
  763. rcu_read_unlock();
  764. /*
  765. * If found in radix tree, then fine.
  766. * Else fallback to linear lookup - this should not happen in practice
  767. * as it means that we failed to insert the node in the radix tree.
  768. */
  769. return irq_data ? irq_data->irq : irq_find_mapping(host, hwirq);
  770. }
  771. void irq_radix_revmap_insert(struct irq_domain *host, unsigned int virq,
  772. irq_hw_number_t hwirq)
  773. {
  774. struct irq_data *irq_data = irq_get_irq_data(virq);
  775. if (WARN_ON(host->revmap_type != IRQ_DOMAIN_MAP_TREE))
  776. return;
  777. if (virq != NO_IRQ) {
  778. mutex_lock(&revmap_trees_mutex);
  779. radix_tree_insert(&host->revmap_data.tree, hwirq, irq_data);
  780. mutex_unlock(&revmap_trees_mutex);
  781. }
  782. }
  783. unsigned int irq_linear_revmap(struct irq_domain *host,
  784. irq_hw_number_t hwirq)
  785. {
  786. unsigned int *revmap;
  787. if (WARN_ON_ONCE(host->revmap_type != IRQ_DOMAIN_MAP_LINEAR))
  788. return irq_find_mapping(host, hwirq);
  789. /* Check revmap bounds */
  790. if (unlikely(hwirq >= host->revmap_data.linear.size))
  791. return irq_find_mapping(host, hwirq);
  792. /* Check if revmap was allocated */
  793. revmap = host->revmap_data.linear.revmap;
  794. if (unlikely(revmap == NULL))
  795. return irq_find_mapping(host, hwirq);
  796. /* Fill up revmap with slow path if no mapping found */
  797. if (unlikely(revmap[hwirq] == NO_IRQ))
  798. revmap[hwirq] = irq_find_mapping(host, hwirq);
  799. return revmap[hwirq];
  800. }
  801. int arch_early_irq_init(void)
  802. {
  803. return 0;
  804. }
  805. #ifdef CONFIG_VIRQ_DEBUG
  806. static int virq_debug_show(struct seq_file *m, void *private)
  807. {
  808. unsigned long flags;
  809. struct irq_desc *desc;
  810. const char *p;
  811. static const char none[] = "none";
  812. void *data;
  813. int i;
  814. seq_printf(m, "%-5s %-7s %-15s %-18s %s\n", "virq", "hwirq",
  815. "chip name", "chip data", "host name");
  816. for (i = 1; i < nr_irqs; i++) {
  817. desc = irq_to_desc(i);
  818. if (!desc)
  819. continue;
  820. raw_spin_lock_irqsave(&desc->lock, flags);
  821. if (desc->action && desc->action->handler) {
  822. struct irq_chip *chip;
  823. seq_printf(m, "%5d ", i);
  824. seq_printf(m, "0x%05lx ", desc->irq_data.hwirq);
  825. chip = irq_desc_get_chip(desc);
  826. if (chip && chip->name)
  827. p = chip->name;
  828. else
  829. p = none;
  830. seq_printf(m, "%-15s ", p);
  831. data = irq_desc_get_chip_data(desc);
  832. seq_printf(m, "0x%16p ", data);
  833. if (desc->irq_data.domain->of_node)
  834. p = desc->irq_data.domain->of_node->full_name;
  835. else
  836. p = none;
  837. seq_printf(m, "%s\n", p);
  838. }
  839. raw_spin_unlock_irqrestore(&desc->lock, flags);
  840. }
  841. return 0;
  842. }
  843. static int virq_debug_open(struct inode *inode, struct file *file)
  844. {
  845. return single_open(file, virq_debug_show, inode->i_private);
  846. }
  847. static const struct file_operations virq_debug_fops = {
  848. .open = virq_debug_open,
  849. .read = seq_read,
  850. .llseek = seq_lseek,
  851. .release = single_release,
  852. };
  853. static int __init irq_debugfs_init(void)
  854. {
  855. if (debugfs_create_file("virq_mapping", S_IRUGO, powerpc_debugfs_root,
  856. NULL, &virq_debug_fops) == NULL)
  857. return -ENOMEM;
  858. return 0;
  859. }
  860. __initcall(irq_debugfs_init);
  861. #endif /* CONFIG_VIRQ_DEBUG */
  862. #ifdef CONFIG_PPC64
  863. static int __init setup_noirqdistrib(char *str)
  864. {
  865. distribute_irqs = 0;
  866. return 1;
  867. }
  868. __setup("noirqdistrib", setup_noirqdistrib);
  869. #endif /* CONFIG_PPC64 */