Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * linux/arch/ia64/kernel/irq_ia64.c
4 *
5 * Copyright (C) 1998-2001 Hewlett-Packard Co
6 * Stephane Eranian <eranian@hpl.hp.com>
7 * David Mosberger-Tang <davidm@hpl.hp.com>
8 *
9 * 6/10/99: Updated to bring in sync with x86 version to facilitate
10 * support for SMP and different interrupt controllers.
11 *
12 * 09/15/00 Goutham Rao <goutham.rao@intel.com> Implemented pci_irq_to_vector
13 * PCI to vector allocation routine.
14 * 04/14/2004 Ashok Raj <ashok.raj@intel.com>
15 * Added CPU Hotplug handling for IPF.
16 */
17
18#include <linux/module.h>
19
20#include <linux/jiffies.h>
21#include <linux/errno.h>
22#include <linux/init.h>
23#include <linux/interrupt.h>
24#include <linux/ioport.h>
25#include <linux/kernel_stat.h>
26#include <linux/ptrace.h>
27#include <linux/signal.h>
28#include <linux/smp.h>
29#include <linux/threads.h>
30#include <linux/bitops.h>
31#include <linux/irq.h>
32#include <linux/ratelimit.h>
33#include <linux/acpi.h>
34#include <linux/sched.h>
35
36#include <asm/delay.h>
37#include <asm/intrinsics.h>
38#include <asm/io.h>
39#include <asm/hw_irq.h>
40#include <asm/machvec.h>
41#include <asm/pgtable.h>
42#include <asm/tlbflush.h>
43
44#ifdef CONFIG_PERFMON
45# include <asm/perfmon.h>
46#endif
47
48#define IRQ_DEBUG 0
49
50#define IRQ_VECTOR_UNASSIGNED (0)
51
52#define IRQ_UNUSED (0)
53#define IRQ_USED (1)
54#define IRQ_RSVD (2)
55
56/* These can be overridden in platform_irq_init */
57int ia64_first_device_vector = IA64_DEF_FIRST_DEVICE_VECTOR;
58int ia64_last_device_vector = IA64_DEF_LAST_DEVICE_VECTOR;
59
60/* default base addr of IPI table */
61void __iomem *ipi_base_addr = ((void __iomem *)
62 (__IA64_UNCACHED_OFFSET | IA64_IPI_DEFAULT_BASE_ADDR));
63
64static cpumask_t vector_allocation_domain(int cpu);
65
66/*
67 * Legacy IRQ to IA-64 vector translation table.
68 */
69__u8 isa_irq_to_vector_map[16] = {
70 /* 8259 IRQ translation, first 16 entries */
71 0x2f, 0x20, 0x2e, 0x2d, 0x2c, 0x2b, 0x2a, 0x29,
72 0x28, 0x27, 0x26, 0x25, 0x24, 0x23, 0x22, 0x21
73};
74EXPORT_SYMBOL(isa_irq_to_vector_map);
75
76DEFINE_SPINLOCK(vector_lock);
77
78struct irq_cfg irq_cfg[NR_IRQS] __read_mostly = {
79 [0 ... NR_IRQS - 1] = {
80 .vector = IRQ_VECTOR_UNASSIGNED,
81 .domain = CPU_MASK_NONE
82 }
83};
84
85DEFINE_PER_CPU(int[IA64_NUM_VECTORS], vector_irq) = {
86 [0 ... IA64_NUM_VECTORS - 1] = -1
87};
88
89static cpumask_t vector_table[IA64_NUM_VECTORS] = {
90 [0 ... IA64_NUM_VECTORS - 1] = CPU_MASK_NONE
91};
92
93static int irq_status[NR_IRQS] = {
94 [0 ... NR_IRQS -1] = IRQ_UNUSED
95};
96
97static inline int find_unassigned_irq(void)
98{
99 int irq;
100
101 for (irq = IA64_FIRST_DEVICE_VECTOR; irq < NR_IRQS; irq++)
102 if (irq_status[irq] == IRQ_UNUSED)
103 return irq;
104 return -ENOSPC;
105}
106
107static inline int find_unassigned_vector(cpumask_t domain)
108{
109 cpumask_t mask;
110 int pos, vector;
111
112 cpumask_and(&mask, &domain, cpu_online_mask);
113 if (cpumask_empty(&mask))
114 return -EINVAL;
115
116 for (pos = 0; pos < IA64_NUM_DEVICE_VECTORS; pos++) {
117 vector = IA64_FIRST_DEVICE_VECTOR + pos;
118 cpumask_and(&mask, &domain, &vector_table[vector]);
119 if (!cpumask_empty(&mask))
120 continue;
121 return vector;
122 }
123 return -ENOSPC;
124}
125
126static int __bind_irq_vector(int irq, int vector, cpumask_t domain)
127{
128 cpumask_t mask;
129 int cpu;
130 struct irq_cfg *cfg = &irq_cfg[irq];
131
132 BUG_ON((unsigned)irq >= NR_IRQS);
133 BUG_ON((unsigned)vector >= IA64_NUM_VECTORS);
134
135 cpumask_and(&mask, &domain, cpu_online_mask);
136 if (cpumask_empty(&mask))
137 return -EINVAL;
138 if ((cfg->vector == vector) && cpumask_equal(&cfg->domain, &domain))
139 return 0;
140 if (cfg->vector != IRQ_VECTOR_UNASSIGNED)
141 return -EBUSY;
142 for_each_cpu(cpu, &mask)
143 per_cpu(vector_irq, cpu)[vector] = irq;
144 cfg->vector = vector;
145 cfg->domain = domain;
146 irq_status[irq] = IRQ_USED;
147 cpumask_or(&vector_table[vector], &vector_table[vector], &domain);
148 return 0;
149}
150
151int bind_irq_vector(int irq, int vector, cpumask_t domain)
152{
153 unsigned long flags;
154 int ret;
155
156 spin_lock_irqsave(&vector_lock, flags);
157 ret = __bind_irq_vector(irq, vector, domain);
158 spin_unlock_irqrestore(&vector_lock, flags);
159 return ret;
160}
161
162static void __clear_irq_vector(int irq)
163{
164 int vector, cpu;
165 cpumask_t domain;
166 struct irq_cfg *cfg = &irq_cfg[irq];
167
168 BUG_ON((unsigned)irq >= NR_IRQS);
169 BUG_ON(cfg->vector == IRQ_VECTOR_UNASSIGNED);
170 vector = cfg->vector;
171 domain = cfg->domain;
172 for_each_cpu_and(cpu, &cfg->domain, cpu_online_mask)
173 per_cpu(vector_irq, cpu)[vector] = -1;
174 cfg->vector = IRQ_VECTOR_UNASSIGNED;
175 cfg->domain = CPU_MASK_NONE;
176 irq_status[irq] = IRQ_UNUSED;
177 cpumask_andnot(&vector_table[vector], &vector_table[vector], &domain);
178}
179
180static void clear_irq_vector(int irq)
181{
182 unsigned long flags;
183
184 spin_lock_irqsave(&vector_lock, flags);
185 __clear_irq_vector(irq);
186 spin_unlock_irqrestore(&vector_lock, flags);
187}
188
189int
190ia64_native_assign_irq_vector (int irq)
191{
192 unsigned long flags;
193 int vector, cpu;
194 cpumask_t domain = CPU_MASK_NONE;
195
196 vector = -ENOSPC;
197
198 spin_lock_irqsave(&vector_lock, flags);
199 for_each_online_cpu(cpu) {
200 domain = vector_allocation_domain(cpu);
201 vector = find_unassigned_vector(domain);
202 if (vector >= 0)
203 break;
204 }
205 if (vector < 0)
206 goto out;
207 if (irq == AUTO_ASSIGN)
208 irq = vector;
209 BUG_ON(__bind_irq_vector(irq, vector, domain));
210 out:
211 spin_unlock_irqrestore(&vector_lock, flags);
212 return vector;
213}
214
215void
216ia64_native_free_irq_vector (int vector)
217{
218 if (vector < IA64_FIRST_DEVICE_VECTOR ||
219 vector > IA64_LAST_DEVICE_VECTOR)
220 return;
221 clear_irq_vector(vector);
222}
223
224int
225reserve_irq_vector (int vector)
226{
227 if (vector < IA64_FIRST_DEVICE_VECTOR ||
228 vector > IA64_LAST_DEVICE_VECTOR)
229 return -EINVAL;
230 return !!bind_irq_vector(vector, vector, CPU_MASK_ALL);
231}
232
233/*
234 * Initialize vector_irq on a new cpu. This function must be called
235 * with vector_lock held.
236 */
237void __setup_vector_irq(int cpu)
238{
239 int irq, vector;
240
241 /* Clear vector_irq */
242 for (vector = 0; vector < IA64_NUM_VECTORS; ++vector)
243 per_cpu(vector_irq, cpu)[vector] = -1;
244 /* Mark the inuse vectors */
245 for (irq = 0; irq < NR_IRQS; ++irq) {
246 if (!cpumask_test_cpu(cpu, &irq_cfg[irq].domain))
247 continue;
248 vector = irq_to_vector(irq);
249 per_cpu(vector_irq, cpu)[vector] = irq;
250 }
251}
252
253#if defined(CONFIG_SMP) && (defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_DIG))
254
255static enum vector_domain_type {
256 VECTOR_DOMAIN_NONE,
257 VECTOR_DOMAIN_PERCPU
258} vector_domain_type = VECTOR_DOMAIN_NONE;
259
260static cpumask_t vector_allocation_domain(int cpu)
261{
262 if (vector_domain_type == VECTOR_DOMAIN_PERCPU)
263 return *cpumask_of(cpu);
264 return CPU_MASK_ALL;
265}
266
267static int __irq_prepare_move(int irq, int cpu)
268{
269 struct irq_cfg *cfg = &irq_cfg[irq];
270 int vector;
271 cpumask_t domain;
272
273 if (cfg->move_in_progress || cfg->move_cleanup_count)
274 return -EBUSY;
275 if (cfg->vector == IRQ_VECTOR_UNASSIGNED || !cpu_online(cpu))
276 return -EINVAL;
277 if (cpumask_test_cpu(cpu, &cfg->domain))
278 return 0;
279 domain = vector_allocation_domain(cpu);
280 vector = find_unassigned_vector(domain);
281 if (vector < 0)
282 return -ENOSPC;
283 cfg->move_in_progress = 1;
284 cfg->old_domain = cfg->domain;
285 cfg->vector = IRQ_VECTOR_UNASSIGNED;
286 cfg->domain = CPU_MASK_NONE;
287 BUG_ON(__bind_irq_vector(irq, vector, domain));
288 return 0;
289}
290
291int irq_prepare_move(int irq, int cpu)
292{
293 unsigned long flags;
294 int ret;
295
296 spin_lock_irqsave(&vector_lock, flags);
297 ret = __irq_prepare_move(irq, cpu);
298 spin_unlock_irqrestore(&vector_lock, flags);
299 return ret;
300}
301
302void irq_complete_move(unsigned irq)
303{
304 struct irq_cfg *cfg = &irq_cfg[irq];
305 cpumask_t cleanup_mask;
306 int i;
307
308 if (likely(!cfg->move_in_progress))
309 return;
310
311 if (unlikely(cpumask_test_cpu(smp_processor_id(), &cfg->old_domain)))
312 return;
313
314 cpumask_and(&cleanup_mask, &cfg->old_domain, cpu_online_mask);
315 cfg->move_cleanup_count = cpumask_weight(&cleanup_mask);
316 for_each_cpu(i, &cleanup_mask)
317 platform_send_ipi(i, IA64_IRQ_MOVE_VECTOR, IA64_IPI_DM_INT, 0);
318 cfg->move_in_progress = 0;
319}
320
321static irqreturn_t smp_irq_move_cleanup_interrupt(int irq, void *dev_id)
322{
323 int me = smp_processor_id();
324 ia64_vector vector;
325 unsigned long flags;
326
327 for (vector = IA64_FIRST_DEVICE_VECTOR;
328 vector < IA64_LAST_DEVICE_VECTOR; vector++) {
329 int irq;
330 struct irq_desc *desc;
331 struct irq_cfg *cfg;
332 irq = __this_cpu_read(vector_irq[vector]);
333 if (irq < 0)
334 continue;
335
336 desc = irq_to_desc(irq);
337 cfg = irq_cfg + irq;
338 raw_spin_lock(&desc->lock);
339 if (!cfg->move_cleanup_count)
340 goto unlock;
341
342 if (!cpumask_test_cpu(me, &cfg->old_domain))
343 goto unlock;
344
345 spin_lock_irqsave(&vector_lock, flags);
346 __this_cpu_write(vector_irq[vector], -1);
347 cpumask_clear_cpu(me, &vector_table[vector]);
348 spin_unlock_irqrestore(&vector_lock, flags);
349 cfg->move_cleanup_count--;
350 unlock:
351 raw_spin_unlock(&desc->lock);
352 }
353 return IRQ_HANDLED;
354}
355
356static struct irqaction irq_move_irqaction = {
357 .handler = smp_irq_move_cleanup_interrupt,
358 .name = "irq_move"
359};
360
361static int __init parse_vector_domain(char *arg)
362{
363 if (!arg)
364 return -EINVAL;
365 if (!strcmp(arg, "percpu")) {
366 vector_domain_type = VECTOR_DOMAIN_PERCPU;
367 no_int_routing = 1;
368 }
369 return 0;
370}
371early_param("vector", parse_vector_domain);
372#else
373static cpumask_t vector_allocation_domain(int cpu)
374{
375 return CPU_MASK_ALL;
376}
377#endif
378
379
380void destroy_and_reserve_irq(unsigned int irq)
381{
382 unsigned long flags;
383
384 irq_init_desc(irq);
385 spin_lock_irqsave(&vector_lock, flags);
386 __clear_irq_vector(irq);
387 irq_status[irq] = IRQ_RSVD;
388 spin_unlock_irqrestore(&vector_lock, flags);
389}
390
391/*
392 * Dynamic irq allocate and deallocation for MSI
393 */
394int create_irq(void)
395{
396 unsigned long flags;
397 int irq, vector, cpu;
398 cpumask_t domain = CPU_MASK_NONE;
399
400 irq = vector = -ENOSPC;
401 spin_lock_irqsave(&vector_lock, flags);
402 for_each_online_cpu(cpu) {
403 domain = vector_allocation_domain(cpu);
404 vector = find_unassigned_vector(domain);
405 if (vector >= 0)
406 break;
407 }
408 if (vector < 0)
409 goto out;
410 irq = find_unassigned_irq();
411 if (irq < 0)
412 goto out;
413 BUG_ON(__bind_irq_vector(irq, vector, domain));
414 out:
415 spin_unlock_irqrestore(&vector_lock, flags);
416 if (irq >= 0)
417 irq_init_desc(irq);
418 return irq;
419}
420
421void destroy_irq(unsigned int irq)
422{
423 irq_init_desc(irq);
424 clear_irq_vector(irq);
425}
426
427#ifdef CONFIG_SMP
428# define IS_RESCHEDULE(vec) (vec == IA64_IPI_RESCHEDULE)
429# define IS_LOCAL_TLB_FLUSH(vec) (vec == IA64_IPI_LOCAL_TLB_FLUSH)
430#else
431# define IS_RESCHEDULE(vec) (0)
432# define IS_LOCAL_TLB_FLUSH(vec) (0)
433#endif
434/*
435 * That's where the IVT branches when we get an external
436 * interrupt. This branches to the correct hardware IRQ handler via
437 * function ptr.
438 */
439void
440ia64_handle_irq (ia64_vector vector, struct pt_regs *regs)
441{
442 struct pt_regs *old_regs = set_irq_regs(regs);
443 unsigned long saved_tpr;
444
445#if IRQ_DEBUG
446 {
447 unsigned long bsp, sp;
448
449 /*
450 * Note: if the interrupt happened while executing in
451 * the context switch routine (ia64_switch_to), we may
452 * get a spurious stack overflow here. This is
453 * because the register and the memory stack are not
454 * switched atomically.
455 */
456 bsp = ia64_getreg(_IA64_REG_AR_BSP);
457 sp = ia64_getreg(_IA64_REG_SP);
458
459 if ((sp - bsp) < 1024) {
460 static DEFINE_RATELIMIT_STATE(ratelimit, 5 * HZ, 5);
461
462 if (__ratelimit(&ratelimit)) {
463 printk("ia64_handle_irq: DANGER: less than "
464 "1KB of free stack space!!\n"
465 "(bsp=0x%lx, sp=%lx)\n", bsp, sp);
466 }
467 }
468 }
469#endif /* IRQ_DEBUG */
470
471 /*
472 * Always set TPR to limit maximum interrupt nesting depth to
473 * 16 (without this, it would be ~240, which could easily lead
474 * to kernel stack overflows).
475 */
476 irq_enter();
477 saved_tpr = ia64_getreg(_IA64_REG_CR_TPR);
478 ia64_srlz_d();
479 while (vector != IA64_SPURIOUS_INT_VECTOR) {
480 int irq = local_vector_to_irq(vector);
481
482 if (unlikely(IS_LOCAL_TLB_FLUSH(vector))) {
483 smp_local_flush_tlb();
484 kstat_incr_irq_this_cpu(irq);
485 } else if (unlikely(IS_RESCHEDULE(vector))) {
486 scheduler_ipi();
487 kstat_incr_irq_this_cpu(irq);
488 } else {
489 ia64_setreg(_IA64_REG_CR_TPR, vector);
490 ia64_srlz_d();
491
492 if (unlikely(irq < 0)) {
493 printk(KERN_ERR "%s: Unexpected interrupt "
494 "vector %d on CPU %d is not mapped "
495 "to any IRQ!\n", __func__, vector,
496 smp_processor_id());
497 } else
498 generic_handle_irq(irq);
499
500 /*
501 * Disable interrupts and send EOI:
502 */
503 local_irq_disable();
504 ia64_setreg(_IA64_REG_CR_TPR, saved_tpr);
505 }
506 ia64_eoi();
507 vector = ia64_get_ivr();
508 }
509 /*
510 * This must be done *after* the ia64_eoi(). For example, the keyboard softirq
511 * handler needs to be able to wait for further keyboard interrupts, which can't
512 * come through until ia64_eoi() has been done.
513 */
514 irq_exit();
515 set_irq_regs(old_regs);
516}
517
518#ifdef CONFIG_HOTPLUG_CPU
519/*
520 * This function emulates a interrupt processing when a cpu is about to be
521 * brought down.
522 */
523void ia64_process_pending_intr(void)
524{
525 ia64_vector vector;
526 unsigned long saved_tpr;
527 extern unsigned int vectors_in_migration[NR_IRQS];
528
529 vector = ia64_get_ivr();
530
531 irq_enter();
532 saved_tpr = ia64_getreg(_IA64_REG_CR_TPR);
533 ia64_srlz_d();
534
535 /*
536 * Perform normal interrupt style processing
537 */
538 while (vector != IA64_SPURIOUS_INT_VECTOR) {
539 int irq = local_vector_to_irq(vector);
540
541 if (unlikely(IS_LOCAL_TLB_FLUSH(vector))) {
542 smp_local_flush_tlb();
543 kstat_incr_irq_this_cpu(irq);
544 } else if (unlikely(IS_RESCHEDULE(vector))) {
545 kstat_incr_irq_this_cpu(irq);
546 } else {
547 struct pt_regs *old_regs = set_irq_regs(NULL);
548
549 ia64_setreg(_IA64_REG_CR_TPR, vector);
550 ia64_srlz_d();
551
552 /*
553 * Now try calling normal ia64_handle_irq as it would have got called
554 * from a real intr handler. Try passing null for pt_regs, hopefully
555 * it will work. I hope it works!.
556 * Probably could shared code.
557 */
558 if (unlikely(irq < 0)) {
559 printk(KERN_ERR "%s: Unexpected interrupt "
560 "vector %d on CPU %d not being mapped "
561 "to any IRQ!!\n", __func__, vector,
562 smp_processor_id());
563 } else {
564 vectors_in_migration[irq]=0;
565 generic_handle_irq(irq);
566 }
567 set_irq_regs(old_regs);
568
569 /*
570 * Disable interrupts and send EOI
571 */
572 local_irq_disable();
573 ia64_setreg(_IA64_REG_CR_TPR, saved_tpr);
574 }
575 ia64_eoi();
576 vector = ia64_get_ivr();
577 }
578 irq_exit();
579}
580#endif
581
582
583#ifdef CONFIG_SMP
584
585static irqreturn_t dummy_handler (int irq, void *dev_id)
586{
587 BUG();
588}
589
590static struct irqaction ipi_irqaction = {
591 .handler = handle_IPI,
592 .name = "IPI"
593};
594
595/*
596 * KVM uses this interrupt to force a cpu out of guest mode
597 */
598static struct irqaction resched_irqaction = {
599 .handler = dummy_handler,
600 .name = "resched"
601};
602
603static struct irqaction tlb_irqaction = {
604 .handler = dummy_handler,
605 .name = "tlb_flush"
606};
607
608#endif
609
610void
611ia64_native_register_percpu_irq (ia64_vector vec, struct irqaction *action)
612{
613 unsigned int irq;
614
615 irq = vec;
616 BUG_ON(bind_irq_vector(irq, vec, CPU_MASK_ALL));
617 irq_set_status_flags(irq, IRQ_PER_CPU);
618 irq_set_chip(irq, &irq_type_ia64_lsapic);
619 if (action)
620 setup_irq(irq, action);
621 irq_set_handler(irq, handle_percpu_irq);
622}
623
624void __init
625ia64_native_register_ipi(void)
626{
627#ifdef CONFIG_SMP
628 register_percpu_irq(IA64_IPI_VECTOR, &ipi_irqaction);
629 register_percpu_irq(IA64_IPI_RESCHEDULE, &resched_irqaction);
630 register_percpu_irq(IA64_IPI_LOCAL_TLB_FLUSH, &tlb_irqaction);
631#endif
632}
633
634void __init
635init_IRQ (void)
636{
637#ifdef CONFIG_ACPI
638 acpi_boot_init();
639#endif
640 ia64_register_ipi();
641 register_percpu_irq(IA64_SPURIOUS_INT_VECTOR, NULL);
642#ifdef CONFIG_SMP
643#if defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_DIG)
644 if (vector_domain_type != VECTOR_DOMAIN_NONE)
645 register_percpu_irq(IA64_IRQ_MOVE_VECTOR, &irq_move_irqaction);
646#endif
647#endif
648#ifdef CONFIG_PERFMON
649 pfm_init_percpu();
650#endif
651 platform_irq_init();
652}
653
654void
655ia64_send_ipi (int cpu, int vector, int delivery_mode, int redirect)
656{
657 void __iomem *ipi_addr;
658 unsigned long ipi_data;
659 unsigned long phys_cpu_id;
660
661 phys_cpu_id = cpu_physical_id(cpu);
662
663 /*
664 * cpu number is in 8bit ID and 8bit EID
665 */
666
667 ipi_data = (delivery_mode << 8) | (vector & 0xff);
668 ipi_addr = ipi_base_addr + ((phys_cpu_id << 4) | ((redirect & 1) << 3));
669
670 writeq(ipi_data, ipi_addr);
671}
1/*
2 * linux/arch/ia64/kernel/irq_ia64.c
3 *
4 * Copyright (C) 1998-2001 Hewlett-Packard Co
5 * Stephane Eranian <eranian@hpl.hp.com>
6 * David Mosberger-Tang <davidm@hpl.hp.com>
7 *
8 * 6/10/99: Updated to bring in sync with x86 version to facilitate
9 * support for SMP and different interrupt controllers.
10 *
11 * 09/15/00 Goutham Rao <goutham.rao@intel.com> Implemented pci_irq_to_vector
12 * PCI to vector allocation routine.
13 * 04/14/2004 Ashok Raj <ashok.raj@intel.com>
14 * Added CPU Hotplug handling for IPF.
15 */
16
17#include <linux/module.h>
18
19#include <linux/jiffies.h>
20#include <linux/errno.h>
21#include <linux/init.h>
22#include <linux/interrupt.h>
23#include <linux/ioport.h>
24#include <linux/kernel_stat.h>
25#include <linux/ptrace.h>
26#include <linux/signal.h>
27#include <linux/smp.h>
28#include <linux/threads.h>
29#include <linux/bitops.h>
30#include <linux/irq.h>
31#include <linux/ratelimit.h>
32#include <linux/acpi.h>
33#include <linux/sched.h>
34
35#include <asm/delay.h>
36#include <asm/intrinsics.h>
37#include <asm/io.h>
38#include <asm/hw_irq.h>
39#include <asm/machvec.h>
40#include <asm/pgtable.h>
41#include <asm/tlbflush.h>
42
43#ifdef CONFIG_PERFMON
44# include <asm/perfmon.h>
45#endif
46
47#define IRQ_DEBUG 0
48
49#define IRQ_VECTOR_UNASSIGNED (0)
50
51#define IRQ_UNUSED (0)
52#define IRQ_USED (1)
53#define IRQ_RSVD (2)
54
55/* These can be overridden in platform_irq_init */
56int ia64_first_device_vector = IA64_DEF_FIRST_DEVICE_VECTOR;
57int ia64_last_device_vector = IA64_DEF_LAST_DEVICE_VECTOR;
58
59/* default base addr of IPI table */
60void __iomem *ipi_base_addr = ((void __iomem *)
61 (__IA64_UNCACHED_OFFSET | IA64_IPI_DEFAULT_BASE_ADDR));
62
63static cpumask_t vector_allocation_domain(int cpu);
64
65/*
66 * Legacy IRQ to IA-64 vector translation table.
67 */
68__u8 isa_irq_to_vector_map[16] = {
69 /* 8259 IRQ translation, first 16 entries */
70 0x2f, 0x20, 0x2e, 0x2d, 0x2c, 0x2b, 0x2a, 0x29,
71 0x28, 0x27, 0x26, 0x25, 0x24, 0x23, 0x22, 0x21
72};
73EXPORT_SYMBOL(isa_irq_to_vector_map);
74
75DEFINE_SPINLOCK(vector_lock);
76
77struct irq_cfg irq_cfg[NR_IRQS] __read_mostly = {
78 [0 ... NR_IRQS - 1] = {
79 .vector = IRQ_VECTOR_UNASSIGNED,
80 .domain = CPU_MASK_NONE
81 }
82};
83
84DEFINE_PER_CPU(int[IA64_NUM_VECTORS], vector_irq) = {
85 [0 ... IA64_NUM_VECTORS - 1] = -1
86};
87
88static cpumask_t vector_table[IA64_NUM_VECTORS] = {
89 [0 ... IA64_NUM_VECTORS - 1] = CPU_MASK_NONE
90};
91
92static int irq_status[NR_IRQS] = {
93 [0 ... NR_IRQS -1] = IRQ_UNUSED
94};
95
96static inline int find_unassigned_irq(void)
97{
98 int irq;
99
100 for (irq = IA64_FIRST_DEVICE_VECTOR; irq < NR_IRQS; irq++)
101 if (irq_status[irq] == IRQ_UNUSED)
102 return irq;
103 return -ENOSPC;
104}
105
106static inline int find_unassigned_vector(cpumask_t domain)
107{
108 cpumask_t mask;
109 int pos, vector;
110
111 cpumask_and(&mask, &domain, cpu_online_mask);
112 if (cpumask_empty(&mask))
113 return -EINVAL;
114
115 for (pos = 0; pos < IA64_NUM_DEVICE_VECTORS; pos++) {
116 vector = IA64_FIRST_DEVICE_VECTOR + pos;
117 cpumask_and(&mask, &domain, &vector_table[vector]);
118 if (!cpumask_empty(&mask))
119 continue;
120 return vector;
121 }
122 return -ENOSPC;
123}
124
125static int __bind_irq_vector(int irq, int vector, cpumask_t domain)
126{
127 cpumask_t mask;
128 int cpu;
129 struct irq_cfg *cfg = &irq_cfg[irq];
130
131 BUG_ON((unsigned)irq >= NR_IRQS);
132 BUG_ON((unsigned)vector >= IA64_NUM_VECTORS);
133
134 cpumask_and(&mask, &domain, cpu_online_mask);
135 if (cpumask_empty(&mask))
136 return -EINVAL;
137 if ((cfg->vector == vector) && cpumask_equal(&cfg->domain, &domain))
138 return 0;
139 if (cfg->vector != IRQ_VECTOR_UNASSIGNED)
140 return -EBUSY;
141 for_each_cpu(cpu, &mask)
142 per_cpu(vector_irq, cpu)[vector] = irq;
143 cfg->vector = vector;
144 cfg->domain = domain;
145 irq_status[irq] = IRQ_USED;
146 cpumask_or(&vector_table[vector], &vector_table[vector], &domain);
147 return 0;
148}
149
150int bind_irq_vector(int irq, int vector, cpumask_t domain)
151{
152 unsigned long flags;
153 int ret;
154
155 spin_lock_irqsave(&vector_lock, flags);
156 ret = __bind_irq_vector(irq, vector, domain);
157 spin_unlock_irqrestore(&vector_lock, flags);
158 return ret;
159}
160
161static void __clear_irq_vector(int irq)
162{
163 int vector, cpu;
164 cpumask_t domain;
165 struct irq_cfg *cfg = &irq_cfg[irq];
166
167 BUG_ON((unsigned)irq >= NR_IRQS);
168 BUG_ON(cfg->vector == IRQ_VECTOR_UNASSIGNED);
169 vector = cfg->vector;
170 domain = cfg->domain;
171 for_each_cpu_and(cpu, &cfg->domain, cpu_online_mask)
172 per_cpu(vector_irq, cpu)[vector] = -1;
173 cfg->vector = IRQ_VECTOR_UNASSIGNED;
174 cfg->domain = CPU_MASK_NONE;
175 irq_status[irq] = IRQ_UNUSED;
176 cpumask_andnot(&vector_table[vector], &vector_table[vector], &domain);
177}
178
179static void clear_irq_vector(int irq)
180{
181 unsigned long flags;
182
183 spin_lock_irqsave(&vector_lock, flags);
184 __clear_irq_vector(irq);
185 spin_unlock_irqrestore(&vector_lock, flags);
186}
187
188int
189ia64_native_assign_irq_vector (int irq)
190{
191 unsigned long flags;
192 int vector, cpu;
193 cpumask_t domain = CPU_MASK_NONE;
194
195 vector = -ENOSPC;
196
197 spin_lock_irqsave(&vector_lock, flags);
198 for_each_online_cpu(cpu) {
199 domain = vector_allocation_domain(cpu);
200 vector = find_unassigned_vector(domain);
201 if (vector >= 0)
202 break;
203 }
204 if (vector < 0)
205 goto out;
206 if (irq == AUTO_ASSIGN)
207 irq = vector;
208 BUG_ON(__bind_irq_vector(irq, vector, domain));
209 out:
210 spin_unlock_irqrestore(&vector_lock, flags);
211 return vector;
212}
213
214void
215ia64_native_free_irq_vector (int vector)
216{
217 if (vector < IA64_FIRST_DEVICE_VECTOR ||
218 vector > IA64_LAST_DEVICE_VECTOR)
219 return;
220 clear_irq_vector(vector);
221}
222
223int
224reserve_irq_vector (int vector)
225{
226 if (vector < IA64_FIRST_DEVICE_VECTOR ||
227 vector > IA64_LAST_DEVICE_VECTOR)
228 return -EINVAL;
229 return !!bind_irq_vector(vector, vector, CPU_MASK_ALL);
230}
231
232/*
233 * Initialize vector_irq on a new cpu. This function must be called
234 * with vector_lock held.
235 */
236void __setup_vector_irq(int cpu)
237{
238 int irq, vector;
239
240 /* Clear vector_irq */
241 for (vector = 0; vector < IA64_NUM_VECTORS; ++vector)
242 per_cpu(vector_irq, cpu)[vector] = -1;
243 /* Mark the inuse vectors */
244 for (irq = 0; irq < NR_IRQS; ++irq) {
245 if (!cpumask_test_cpu(cpu, &irq_cfg[irq].domain))
246 continue;
247 vector = irq_to_vector(irq);
248 per_cpu(vector_irq, cpu)[vector] = irq;
249 }
250}
251
252#if defined(CONFIG_SMP) && (defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_DIG))
253
254static enum vector_domain_type {
255 VECTOR_DOMAIN_NONE,
256 VECTOR_DOMAIN_PERCPU
257} vector_domain_type = VECTOR_DOMAIN_NONE;
258
259static cpumask_t vector_allocation_domain(int cpu)
260{
261 if (vector_domain_type == VECTOR_DOMAIN_PERCPU)
262 return *cpumask_of(cpu);
263 return CPU_MASK_ALL;
264}
265
266static int __irq_prepare_move(int irq, int cpu)
267{
268 struct irq_cfg *cfg = &irq_cfg[irq];
269 int vector;
270 cpumask_t domain;
271
272 if (cfg->move_in_progress || cfg->move_cleanup_count)
273 return -EBUSY;
274 if (cfg->vector == IRQ_VECTOR_UNASSIGNED || !cpu_online(cpu))
275 return -EINVAL;
276 if (cpumask_test_cpu(cpu, &cfg->domain))
277 return 0;
278 domain = vector_allocation_domain(cpu);
279 vector = find_unassigned_vector(domain);
280 if (vector < 0)
281 return -ENOSPC;
282 cfg->move_in_progress = 1;
283 cfg->old_domain = cfg->domain;
284 cfg->vector = IRQ_VECTOR_UNASSIGNED;
285 cfg->domain = CPU_MASK_NONE;
286 BUG_ON(__bind_irq_vector(irq, vector, domain));
287 return 0;
288}
289
290int irq_prepare_move(int irq, int cpu)
291{
292 unsigned long flags;
293 int ret;
294
295 spin_lock_irqsave(&vector_lock, flags);
296 ret = __irq_prepare_move(irq, cpu);
297 spin_unlock_irqrestore(&vector_lock, flags);
298 return ret;
299}
300
301void irq_complete_move(unsigned irq)
302{
303 struct irq_cfg *cfg = &irq_cfg[irq];
304 cpumask_t cleanup_mask;
305 int i;
306
307 if (likely(!cfg->move_in_progress))
308 return;
309
310 if (unlikely(cpumask_test_cpu(smp_processor_id(), &cfg->old_domain)))
311 return;
312
313 cpumask_and(&cleanup_mask, &cfg->old_domain, cpu_online_mask);
314 cfg->move_cleanup_count = cpumask_weight(&cleanup_mask);
315 for_each_cpu(i, &cleanup_mask)
316 platform_send_ipi(i, IA64_IRQ_MOVE_VECTOR, IA64_IPI_DM_INT, 0);
317 cfg->move_in_progress = 0;
318}
319
320static irqreturn_t smp_irq_move_cleanup_interrupt(int irq, void *dev_id)
321{
322 int me = smp_processor_id();
323 ia64_vector vector;
324 unsigned long flags;
325
326 for (vector = IA64_FIRST_DEVICE_VECTOR;
327 vector < IA64_LAST_DEVICE_VECTOR; vector++) {
328 int irq;
329 struct irq_desc *desc;
330 struct irq_cfg *cfg;
331 irq = __this_cpu_read(vector_irq[vector]);
332 if (irq < 0)
333 continue;
334
335 desc = irq_to_desc(irq);
336 cfg = irq_cfg + irq;
337 raw_spin_lock(&desc->lock);
338 if (!cfg->move_cleanup_count)
339 goto unlock;
340
341 if (!cpumask_test_cpu(me, &cfg->old_domain))
342 goto unlock;
343
344 spin_lock_irqsave(&vector_lock, flags);
345 __this_cpu_write(vector_irq[vector], -1);
346 cpumask_clear_cpu(me, &vector_table[vector]);
347 spin_unlock_irqrestore(&vector_lock, flags);
348 cfg->move_cleanup_count--;
349 unlock:
350 raw_spin_unlock(&desc->lock);
351 }
352 return IRQ_HANDLED;
353}
354
355static struct irqaction irq_move_irqaction = {
356 .handler = smp_irq_move_cleanup_interrupt,
357 .name = "irq_move"
358};
359
360static int __init parse_vector_domain(char *arg)
361{
362 if (!arg)
363 return -EINVAL;
364 if (!strcmp(arg, "percpu")) {
365 vector_domain_type = VECTOR_DOMAIN_PERCPU;
366 no_int_routing = 1;
367 }
368 return 0;
369}
370early_param("vector", parse_vector_domain);
371#else
372static cpumask_t vector_allocation_domain(int cpu)
373{
374 return CPU_MASK_ALL;
375}
376#endif
377
378
379void destroy_and_reserve_irq(unsigned int irq)
380{
381 unsigned long flags;
382
383 irq_init_desc(irq);
384 spin_lock_irqsave(&vector_lock, flags);
385 __clear_irq_vector(irq);
386 irq_status[irq] = IRQ_RSVD;
387 spin_unlock_irqrestore(&vector_lock, flags);
388}
389
390/*
391 * Dynamic irq allocate and deallocation for MSI
392 */
393int create_irq(void)
394{
395 unsigned long flags;
396 int irq, vector, cpu;
397 cpumask_t domain = CPU_MASK_NONE;
398
399 irq = vector = -ENOSPC;
400 spin_lock_irqsave(&vector_lock, flags);
401 for_each_online_cpu(cpu) {
402 domain = vector_allocation_domain(cpu);
403 vector = find_unassigned_vector(domain);
404 if (vector >= 0)
405 break;
406 }
407 if (vector < 0)
408 goto out;
409 irq = find_unassigned_irq();
410 if (irq < 0)
411 goto out;
412 BUG_ON(__bind_irq_vector(irq, vector, domain));
413 out:
414 spin_unlock_irqrestore(&vector_lock, flags);
415 if (irq >= 0)
416 irq_init_desc(irq);
417 return irq;
418}
419
420void destroy_irq(unsigned int irq)
421{
422 irq_init_desc(irq);
423 clear_irq_vector(irq);
424}
425
426#ifdef CONFIG_SMP
427# define IS_RESCHEDULE(vec) (vec == IA64_IPI_RESCHEDULE)
428# define IS_LOCAL_TLB_FLUSH(vec) (vec == IA64_IPI_LOCAL_TLB_FLUSH)
429#else
430# define IS_RESCHEDULE(vec) (0)
431# define IS_LOCAL_TLB_FLUSH(vec) (0)
432#endif
433/*
434 * That's where the IVT branches when we get an external
435 * interrupt. This branches to the correct hardware IRQ handler via
436 * function ptr.
437 */
438void
439ia64_handle_irq (ia64_vector vector, struct pt_regs *regs)
440{
441 struct pt_regs *old_regs = set_irq_regs(regs);
442 unsigned long saved_tpr;
443
444#if IRQ_DEBUG
445 {
446 unsigned long bsp, sp;
447
448 /*
449 * Note: if the interrupt happened while executing in
450 * the context switch routine (ia64_switch_to), we may
451 * get a spurious stack overflow here. This is
452 * because the register and the memory stack are not
453 * switched atomically.
454 */
455 bsp = ia64_getreg(_IA64_REG_AR_BSP);
456 sp = ia64_getreg(_IA64_REG_SP);
457
458 if ((sp - bsp) < 1024) {
459 static DEFINE_RATELIMIT_STATE(ratelimit, 5 * HZ, 5);
460
461 if (__ratelimit(&ratelimit)) {
462 printk("ia64_handle_irq: DANGER: less than "
463 "1KB of free stack space!!\n"
464 "(bsp=0x%lx, sp=%lx)\n", bsp, sp);
465 }
466 }
467 }
468#endif /* IRQ_DEBUG */
469
470 /*
471 * Always set TPR to limit maximum interrupt nesting depth to
472 * 16 (without this, it would be ~240, which could easily lead
473 * to kernel stack overflows).
474 */
475 irq_enter();
476 saved_tpr = ia64_getreg(_IA64_REG_CR_TPR);
477 ia64_srlz_d();
478 while (vector != IA64_SPURIOUS_INT_VECTOR) {
479 int irq = local_vector_to_irq(vector);
480
481 if (unlikely(IS_LOCAL_TLB_FLUSH(vector))) {
482 smp_local_flush_tlb();
483 kstat_incr_irq_this_cpu(irq);
484 } else if (unlikely(IS_RESCHEDULE(vector))) {
485 scheduler_ipi();
486 kstat_incr_irq_this_cpu(irq);
487 } else {
488 ia64_setreg(_IA64_REG_CR_TPR, vector);
489 ia64_srlz_d();
490
491 if (unlikely(irq < 0)) {
492 printk(KERN_ERR "%s: Unexpected interrupt "
493 "vector %d on CPU %d is not mapped "
494 "to any IRQ!\n", __func__, vector,
495 smp_processor_id());
496 } else
497 generic_handle_irq(irq);
498
499 /*
500 * Disable interrupts and send EOI:
501 */
502 local_irq_disable();
503 ia64_setreg(_IA64_REG_CR_TPR, saved_tpr);
504 }
505 ia64_eoi();
506 vector = ia64_get_ivr();
507 }
508 /*
509 * This must be done *after* the ia64_eoi(). For example, the keyboard softirq
510 * handler needs to be able to wait for further keyboard interrupts, which can't
511 * come through until ia64_eoi() has been done.
512 */
513 irq_exit();
514 set_irq_regs(old_regs);
515}
516
517#ifdef CONFIG_HOTPLUG_CPU
518/*
519 * This function emulates a interrupt processing when a cpu is about to be
520 * brought down.
521 */
522void ia64_process_pending_intr(void)
523{
524 ia64_vector vector;
525 unsigned long saved_tpr;
526 extern unsigned int vectors_in_migration[NR_IRQS];
527
528 vector = ia64_get_ivr();
529
530 irq_enter();
531 saved_tpr = ia64_getreg(_IA64_REG_CR_TPR);
532 ia64_srlz_d();
533
534 /*
535 * Perform normal interrupt style processing
536 */
537 while (vector != IA64_SPURIOUS_INT_VECTOR) {
538 int irq = local_vector_to_irq(vector);
539
540 if (unlikely(IS_LOCAL_TLB_FLUSH(vector))) {
541 smp_local_flush_tlb();
542 kstat_incr_irq_this_cpu(irq);
543 } else if (unlikely(IS_RESCHEDULE(vector))) {
544 kstat_incr_irq_this_cpu(irq);
545 } else {
546 struct pt_regs *old_regs = set_irq_regs(NULL);
547
548 ia64_setreg(_IA64_REG_CR_TPR, vector);
549 ia64_srlz_d();
550
551 /*
552 * Now try calling normal ia64_handle_irq as it would have got called
553 * from a real intr handler. Try passing null for pt_regs, hopefully
554 * it will work. I hope it works!.
555 * Probably could shared code.
556 */
557 if (unlikely(irq < 0)) {
558 printk(KERN_ERR "%s: Unexpected interrupt "
559 "vector %d on CPU %d not being mapped "
560 "to any IRQ!!\n", __func__, vector,
561 smp_processor_id());
562 } else {
563 vectors_in_migration[irq]=0;
564 generic_handle_irq(irq);
565 }
566 set_irq_regs(old_regs);
567
568 /*
569 * Disable interrupts and send EOI
570 */
571 local_irq_disable();
572 ia64_setreg(_IA64_REG_CR_TPR, saved_tpr);
573 }
574 ia64_eoi();
575 vector = ia64_get_ivr();
576 }
577 irq_exit();
578}
579#endif
580
581
582#ifdef CONFIG_SMP
583
584static irqreturn_t dummy_handler (int irq, void *dev_id)
585{
586 BUG();
587}
588
589static struct irqaction ipi_irqaction = {
590 .handler = handle_IPI,
591 .name = "IPI"
592};
593
594/*
595 * KVM uses this interrupt to force a cpu out of guest mode
596 */
597static struct irqaction resched_irqaction = {
598 .handler = dummy_handler,
599 .name = "resched"
600};
601
602static struct irqaction tlb_irqaction = {
603 .handler = dummy_handler,
604 .name = "tlb_flush"
605};
606
607#endif
608
609void
610ia64_native_register_percpu_irq (ia64_vector vec, struct irqaction *action)
611{
612 unsigned int irq;
613
614 irq = vec;
615 BUG_ON(bind_irq_vector(irq, vec, CPU_MASK_ALL));
616 irq_set_status_flags(irq, IRQ_PER_CPU);
617 irq_set_chip(irq, &irq_type_ia64_lsapic);
618 if (action)
619 setup_irq(irq, action);
620 irq_set_handler(irq, handle_percpu_irq);
621}
622
623void __init
624ia64_native_register_ipi(void)
625{
626#ifdef CONFIG_SMP
627 register_percpu_irq(IA64_IPI_VECTOR, &ipi_irqaction);
628 register_percpu_irq(IA64_IPI_RESCHEDULE, &resched_irqaction);
629 register_percpu_irq(IA64_IPI_LOCAL_TLB_FLUSH, &tlb_irqaction);
630#endif
631}
632
633void __init
634init_IRQ (void)
635{
636#ifdef CONFIG_ACPI
637 acpi_boot_init();
638#endif
639 ia64_register_ipi();
640 register_percpu_irq(IA64_SPURIOUS_INT_VECTOR, NULL);
641#ifdef CONFIG_SMP
642#if defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_DIG)
643 if (vector_domain_type != VECTOR_DOMAIN_NONE)
644 register_percpu_irq(IA64_IRQ_MOVE_VECTOR, &irq_move_irqaction);
645#endif
646#endif
647#ifdef CONFIG_PERFMON
648 pfm_init_percpu();
649#endif
650 platform_irq_init();
651}
652
653void
654ia64_send_ipi (int cpu, int vector, int delivery_mode, int redirect)
655{
656 void __iomem *ipi_addr;
657 unsigned long ipi_data;
658 unsigned long phys_cpu_id;
659
660 phys_cpu_id = cpu_physical_id(cpu);
661
662 /*
663 * cpu number is in 8bit ID and 8bit EID
664 */
665
666 ipi_data = (delivery_mode << 8) | (vector & 0xff);
667 ipi_addr = ipi_base_addr + ((phys_cpu_id << 4) | ((redirect & 1) << 3));
668
669 writeq(ipi_data, ipi_addr);
670}