1
2
3
4
5
6
7
8
9
10
11
12#include <linux/irq.h>
13#include <linux/io.h>
14#include <asm/irq.h>
15#include <mach/sysasic.h>
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45#define ESR_BASE 0x005f6900
46#define EMR_BASE 0x005f6910
47
48
49
50
51
52#define LEVEL(event) (((event) - HW_EVENT_IRQ_BASE) / 32)
53
54
55#define EVENT_BIT(event) (((event) - HW_EVENT_IRQ_BASE) & 31)
56
57
58
59
60
61
62
63static inline void disable_systemasic_irq(struct irq_data *data)
64{
65 unsigned int irq = data->irq;
66 __u32 emr = EMR_BASE + (LEVEL(irq) << 4) + (LEVEL(irq) << 2);
67 __u32 mask;
68
69 mask = inl(emr);
70 mask &= ~(1 << EVENT_BIT(irq));
71 outl(mask, emr);
72}
73
74
75static inline void enable_systemasic_irq(struct irq_data *data)
76{
77 unsigned int irq = data->irq;
78 __u32 emr = EMR_BASE + (LEVEL(irq) << 4) + (LEVEL(irq) << 2);
79 __u32 mask;
80
81 mask = inl(emr);
82 mask |= (1 << EVENT_BIT(irq));
83 outl(mask, emr);
84}
85
86
87static void mask_ack_systemasic_irq(struct irq_data *data)
88{
89 unsigned int irq = data->irq;
90 __u32 esr = ESR_BASE + (LEVEL(irq) << 2);
91 disable_systemasic_irq(data);
92 outl((1 << EVENT_BIT(irq)), esr);
93}
94
95struct irq_chip systemasic_int = {
96 .name = "System ASIC",
97 .irq_mask = disable_systemasic_irq,
98 .irq_mask_ack = mask_ack_systemasic_irq,
99 .irq_unmask = enable_systemasic_irq,
100};
101
102
103
104
105int systemasic_irq_demux(int irq)
106{
107 __u32 emr, esr, status, level;
108 __u32 j, bit;
109
110 switch (irq) {
111 case 13:
112 level = 0;
113 break;
114 case 11:
115 level = 1;
116 break;
117 case 9:
118 level = 2;
119 break;
120 default:
121 return irq;
122 }
123 emr = EMR_BASE + (level << 4) + (level << 2);
124 esr = ESR_BASE + (level << 2);
125
126
127 status = inl(esr);
128 status &= inl(emr);
129
130
131 for (bit = 1, j = 0; j < 32; bit <<= 1, j++) {
132 if (status & bit) {
133 irq = HW_EVENT_IRQ_BASE + j + (level << 5);
134 return irq;
135 }
136 }
137
138
139 return irq;
140}
141
142void systemasic_irq_init(void)
143{
144 int i, nid = cpu_to_node(boot_cpu_data);
145
146
147 for (i = HW_EVENT_IRQ_BASE; i < HW_EVENT_IRQ_MAX; i++) {
148 unsigned int irq;
149
150 irq = create_irq_nr(i, nid);
151 if (unlikely(irq == 0)) {
152 pr_err("%s: failed hooking irq %d for systemasic\n",
153 __func__, i);
154 return;
155 }
156
157 if (unlikely(irq != i)) {
158 pr_err("%s: got irq %d but wanted %d, bailing.\n",
159 __func__, irq, i);
160 destroy_irq(irq);
161 return;
162 }
163
164 set_irq_chip_and_handler(i, &systemasic_int,
165 handle_level_irq);
166 }
167}
168