GNU Linux-libre 4.9.283-gnu1
[releases.git] / arch / mips / loongson64 / loongson-3 / irq.c
1 #include <loongson.h>
2 #include <irq.h>
3 #include <linux/interrupt.h>
4 #include <linux/module.h>
5
6 #include <asm/irq_cpu.h>
7 #include <asm/i8259.h>
8 #include <asm/mipsregs.h>
9
10 #include "smp.h"
11
12 unsigned int ht_irq[] = {0, 1, 3, 4, 5, 6, 7, 8, 12, 14, 15};
13
14 static void ht_irqdispatch(void)
15 {
16         unsigned int i, irq;
17
18         irq = LOONGSON_HT1_INT_VECTOR(0);
19         LOONGSON_HT1_INT_VECTOR(0) = irq; /* Acknowledge the IRQs */
20
21         for (i = 0; i < ARRAY_SIZE(ht_irq); i++) {
22                 if (irq & (0x1 << ht_irq[i]))
23                         do_IRQ(ht_irq[i]);
24         }
25 }
26
27 #define UNUSED_IPS (CAUSEF_IP5 | CAUSEF_IP4 | CAUSEF_IP1 | CAUSEF_IP0)
28
29 void mach_irq_dispatch(unsigned int pending)
30 {
31         if (pending & CAUSEF_IP7)
32                 do_IRQ(LOONGSON_TIMER_IRQ);
33 #if defined(CONFIG_SMP)
34         if (pending & CAUSEF_IP6)
35                 loongson3_ipi_interrupt(NULL);
36 #endif
37         if (pending & CAUSEF_IP3)
38                 ht_irqdispatch();
39         if (pending & CAUSEF_IP2)
40                 do_IRQ(LOONGSON_UART_IRQ);
41         if (pending & UNUSED_IPS) {
42                 pr_err("%s : spurious interrupt\n", __func__);
43                 spurious_interrupt();
44         }
45 }
46
47 static inline void mask_loongson_irq(struct irq_data *d) { }
48 static inline void unmask_loongson_irq(struct irq_data *d) { }
49
50  /* For MIPS IRQs which shared by all cores */
51 static struct irq_chip loongson_irq_chip = {
52         .name           = "Loongson",
53         .irq_ack        = mask_loongson_irq,
54         .irq_mask       = mask_loongson_irq,
55         .irq_mask_ack   = mask_loongson_irq,
56         .irq_unmask     = unmask_loongson_irq,
57         .irq_eoi        = unmask_loongson_irq,
58 };
59
60 void irq_router_init(void)
61 {
62         int i;
63
64         /* route LPC int to cpu core0 int 0 */
65         LOONGSON_INT_ROUTER_LPC =
66                 LOONGSON_INT_COREx_INTy(loongson_sysconf.boot_cpu_id, 0);
67         /* route HT1 int0 ~ int7 to cpu core0 INT1*/
68         for (i = 0; i < 8; i++)
69                 LOONGSON_INT_ROUTER_HT1(i) =
70                         LOONGSON_INT_COREx_INTy(loongson_sysconf.boot_cpu_id, 1);
71         /* enable HT1 interrupt */
72         LOONGSON_HT1_INTN_EN(0) = 0xffffffff;
73         /* enable router interrupt intenset */
74         LOONGSON_INT_ROUTER_INTENSET =
75                 LOONGSON_INT_ROUTER_INTEN | (0xffff << 16) | 0x1 << 10;
76 }
77
78 void __init mach_init_irq(void)
79 {
80         clear_c0_status(ST0_IM | ST0_BEV);
81
82         irq_router_init();
83         mips_cpu_irq_init();
84         init_i8259_irqs();
85         irq_set_chip_and_handler(LOONGSON_UART_IRQ,
86                         &loongson_irq_chip, handle_percpu_irq);
87         irq_set_chip_and_handler(LOONGSON_BRIDGE_IRQ,
88                         &loongson_irq_chip, handle_percpu_irq);
89
90         set_c0_status(STATUSF_IP2 | STATUSF_IP3 | STATUSF_IP6);
91 }
92
93 #ifdef CONFIG_HOTPLUG_CPU
94
95 void fixup_irqs(void)
96 {
97         irq_cpu_offline();
98         clear_c0_status(ST0_IM);
99 }
100
101 #endif