1
2
3
4
5
6
7
8
9
10
11
12#include <linux/init.h>
13#include <linux/interrupt.h>
14#include <linux/kernel.h>
15#include <linux/module.h>
16
17#include <asm/irq_cpu.h>
18#include <asm/mipsregs.h>
19#include <asm/system.h>
20
21static inline void unmask_rm9k_irq(unsigned int irq)
22{
23 set_c0_intcontrol(0x1000 << (irq - RM9K_CPU_IRQ_BASE));
24}
25
26static inline void mask_rm9k_irq(unsigned int irq)
27{
28 clear_c0_intcontrol(0x1000 << (irq - RM9K_CPU_IRQ_BASE));
29}
30
31static inline void rm9k_cpu_irq_enable(unsigned int irq)
32{
33 unsigned long flags;
34
35 local_irq_save(flags);
36 unmask_rm9k_irq(irq);
37 local_irq_restore(flags);
38}
39
40
41
42
43static void local_rm9k_perfcounter_irq_startup(void *args)
44{
45 unsigned int irq = (unsigned int) args;
46
47 rm9k_cpu_irq_enable(irq);
48}
49
50static unsigned int rm9k_perfcounter_irq_startup(unsigned int irq)
51{
52 on_each_cpu(local_rm9k_perfcounter_irq_startup, (void *) irq, 0, 1);
53
54 return 0;
55}
56
57static void local_rm9k_perfcounter_irq_shutdown(void *args)
58{
59 unsigned int irq = (unsigned int) args;
60 unsigned long flags;
61
62 local_irq_save(flags);
63 mask_rm9k_irq(irq);
64 local_irq_restore(flags);
65}
66
67static void rm9k_perfcounter_irq_shutdown(unsigned int irq)
68{
69 on_each_cpu(local_rm9k_perfcounter_irq_shutdown, (void *) irq, 0, 1);
70}
71
72static struct irq_chip rm9k_irq_controller = {
73 .name = "RM9000",
74 .ack = mask_rm9k_irq,
75 .mask = mask_rm9k_irq,
76 .mask_ack = mask_rm9k_irq,
77 .unmask = unmask_rm9k_irq,
78};
79
80static struct irq_chip rm9k_perfcounter_irq = {
81 .name = "RM9000",
82 .startup = rm9k_perfcounter_irq_startup,
83 .shutdown = rm9k_perfcounter_irq_shutdown,
84 .ack = mask_rm9k_irq,
85 .mask = mask_rm9k_irq,
86 .mask_ack = mask_rm9k_irq,
87 .unmask = unmask_rm9k_irq,
88};
89
90unsigned int rm9000_perfcount_irq;
91
92EXPORT_SYMBOL(rm9000_perfcount_irq);
93
94void __init rm9k_cpu_irq_init(void)
95{
96 int base = RM9K_CPU_IRQ_BASE;
97 int i;
98
99 clear_c0_intcontrol(0x0000f000);
100
101 for (i = base; i < base + 4; i++)
102 set_irq_chip_and_handler(i, &rm9k_irq_controller,
103 handle_level_irq);
104
105 rm9000_perfcount_irq = base + 1;
106 set_irq_chip_and_handler(rm9000_perfcount_irq, &rm9k_perfcounter_irq,
107 handle_percpu_irq);
108}
109