1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30#include <linux/init.h>
31#include <linux/interrupt.h>
32#include <linux/kernel.h>
33
34#include <asm/irq_cpu.h>
35#include <asm/mipsregs.h>
36#include <asm/mipsmtregs.h>
37#include <asm/system.h>
38
39static inline void unmask_mips_irq(unsigned int irq)
40{
41 set_c0_status(0x100 << (irq - MIPS_CPU_IRQ_BASE));
42 irq_enable_hazard();
43}
44
45static inline void mask_mips_irq(unsigned int irq)
46{
47 clear_c0_status(0x100 << (irq - MIPS_CPU_IRQ_BASE));
48 irq_disable_hazard();
49}
50
51static struct irq_chip mips_cpu_irq_controller = {
52 .name = "MIPS",
53 .ack = mask_mips_irq,
54 .mask = mask_mips_irq,
55 .mask_ack = mask_mips_irq,
56 .unmask = unmask_mips_irq,
57 .eoi = unmask_mips_irq,
58};
59
60
61
62
63
64#define unmask_mips_mt_irq unmask_mips_irq
65#define mask_mips_mt_irq mask_mips_irq
66
67static unsigned int mips_mt_cpu_irq_startup(unsigned int irq)
68{
69 unsigned int vpflags = dvpe();
70
71 clear_c0_cause(0x100 << (irq - MIPS_CPU_IRQ_BASE));
72 evpe(vpflags);
73 unmask_mips_mt_irq(irq);
74
75 return 0;
76}
77
78
79
80
81
82static void mips_mt_cpu_irq_ack(unsigned int irq)
83{
84 unsigned int vpflags = dvpe();
85 clear_c0_cause(0x100 << (irq - MIPS_CPU_IRQ_BASE));
86 evpe(vpflags);
87 mask_mips_mt_irq(irq);
88}
89
90static struct irq_chip mips_mt_cpu_irq_controller = {
91 .name = "MIPS",
92 .startup = mips_mt_cpu_irq_startup,
93 .ack = mips_mt_cpu_irq_ack,
94 .mask = mask_mips_mt_irq,
95 .mask_ack = mips_mt_cpu_irq_ack,
96 .unmask = unmask_mips_mt_irq,
97 .eoi = unmask_mips_mt_irq,
98};
99
100void __init mips_cpu_irq_init(void)
101{
102 int irq_base = MIPS_CPU_IRQ_BASE;
103 int i;
104
105
106 clear_c0_status(ST0_IM);
107 clear_c0_cause(CAUSEF_IP);
108
109
110
111
112
113 if (cpu_has_mipsmt)
114 for (i = irq_base; i < irq_base + 2; i++)
115 set_irq_chip_and_handler(i, &mips_mt_cpu_irq_controller,
116 handle_percpu_irq);
117
118 for (i = irq_base + 2; i < irq_base + 8; i++)
119 set_irq_chip_and_handler(i, &mips_cpu_irq_controller,
120 handle_percpu_irq);
121}
122