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