root / hw / sh_intc.c @ b50a6563
History | View | Annotate | Download (9 kB)
1 | 80f515e6 | balrog | /*
|
---|---|---|---|
2 | 80f515e6 | balrog | * SuperH interrupt controller module
|
3 | 80f515e6 | balrog | *
|
4 | 80f515e6 | balrog | * Copyright (c) 2007 Magnus Damm
|
5 | 80f515e6 | balrog | * Based on sh_timer.c and arm_timer.c by Paul Brook
|
6 | 80f515e6 | balrog | * Copyright (c) 2005-2006 CodeSourcery.
|
7 | 80f515e6 | balrog | *
|
8 | 80f515e6 | balrog | * This code is licenced under the GPL.
|
9 | 80f515e6 | balrog | */
|
10 | 80f515e6 | balrog | |
11 | 80f515e6 | balrog | #include <assert.h> |
12 | 80f515e6 | balrog | #include "sh_intc.h" |
13 | 80f515e6 | balrog | #include "vl.h" |
14 | 80f515e6 | balrog | |
15 | 80f515e6 | balrog | //#define DEBUG_INTC
|
16 | 80f515e6 | balrog | |
17 | 80f515e6 | balrog | #define INTC_A7(x) ((x) & 0x1fffffff) |
18 | 80f515e6 | balrog | #define INTC_ARRAY(x) (sizeof(x) / sizeof(x[0])) |
19 | 80f515e6 | balrog | |
20 | 80f515e6 | balrog | #define INTC_MODE_NONE 0 |
21 | 80f515e6 | balrog | #define INTC_MODE_DUAL_SET 1 |
22 | 80f515e6 | balrog | #define INTC_MODE_DUAL_CLR 2 |
23 | 80f515e6 | balrog | #define INTC_MODE_ENABLE_REG 3 |
24 | 80f515e6 | balrog | #define INTC_MODE_MASK_REG 4 |
25 | 80f515e6 | balrog | #define INTC_MODE_IS_PRIO 8 |
26 | 80f515e6 | balrog | |
27 | 80f515e6 | balrog | static unsigned int sh_intc_mode(unsigned long address, |
28 | 80f515e6 | balrog | unsigned long set_reg, unsigned long clr_reg) |
29 | 80f515e6 | balrog | { |
30 | 80f515e6 | balrog | if ((address != INTC_A7(set_reg)) &&
|
31 | 80f515e6 | balrog | (address != INTC_A7(clr_reg))) |
32 | 80f515e6 | balrog | return INTC_MODE_NONE;
|
33 | 80f515e6 | balrog | |
34 | 80f515e6 | balrog | if (set_reg && clr_reg) {
|
35 | 80f515e6 | balrog | if (address == INTC_A7(set_reg))
|
36 | 80f515e6 | balrog | return INTC_MODE_DUAL_SET;
|
37 | 80f515e6 | balrog | else
|
38 | 80f515e6 | balrog | return INTC_MODE_DUAL_CLR;
|
39 | 80f515e6 | balrog | } |
40 | 80f515e6 | balrog | |
41 | 80f515e6 | balrog | if (set_reg)
|
42 | 80f515e6 | balrog | return INTC_MODE_ENABLE_REG;
|
43 | 80f515e6 | balrog | else
|
44 | 80f515e6 | balrog | return INTC_MODE_MASK_REG;
|
45 | 80f515e6 | balrog | } |
46 | 80f515e6 | balrog | |
47 | 80f515e6 | balrog | static void sh_intc_locate(struct intc_desc *desc, |
48 | 80f515e6 | balrog | unsigned long address, |
49 | 80f515e6 | balrog | unsigned long **datap, |
50 | 80f515e6 | balrog | intc_enum **enums, |
51 | 80f515e6 | balrog | unsigned int *first, |
52 | 80f515e6 | balrog | unsigned int *width, |
53 | 80f515e6 | balrog | unsigned int *modep) |
54 | 80f515e6 | balrog | { |
55 | 80f515e6 | balrog | unsigned int i, mode; |
56 | 80f515e6 | balrog | |
57 | 80f515e6 | balrog | /* this is slow but works for now */
|
58 | 80f515e6 | balrog | |
59 | 80f515e6 | balrog | if (desc->mask_regs) {
|
60 | 80f515e6 | balrog | for (i = 0; i < desc->nr_mask_regs; i++) { |
61 | 80f515e6 | balrog | struct intc_mask_reg *mr = desc->mask_regs + i;
|
62 | 80f515e6 | balrog | |
63 | 80f515e6 | balrog | mode = sh_intc_mode(address, mr->set_reg, mr->clr_reg); |
64 | 80f515e6 | balrog | if (mode == INTC_MODE_NONE)
|
65 | 80f515e6 | balrog | continue;
|
66 | 80f515e6 | balrog | |
67 | 80f515e6 | balrog | *modep = mode; |
68 | 80f515e6 | balrog | *datap = &mr->value; |
69 | 80f515e6 | balrog | *enums = mr->enum_ids; |
70 | 80f515e6 | balrog | *first = mr->reg_width - 1;
|
71 | 80f515e6 | balrog | *width = 1;
|
72 | 80f515e6 | balrog | return;
|
73 | 80f515e6 | balrog | } |
74 | 80f515e6 | balrog | } |
75 | 80f515e6 | balrog | |
76 | 80f515e6 | balrog | if (desc->prio_regs) {
|
77 | 80f515e6 | balrog | for (i = 0; i < desc->nr_prio_regs; i++) { |
78 | 80f515e6 | balrog | struct intc_prio_reg *pr = desc->prio_regs + i;
|
79 | 80f515e6 | balrog | |
80 | 80f515e6 | balrog | mode = sh_intc_mode(address, pr->set_reg, pr->clr_reg); |
81 | 80f515e6 | balrog | if (mode == INTC_MODE_NONE)
|
82 | 80f515e6 | balrog | continue;
|
83 | 80f515e6 | balrog | |
84 | 80f515e6 | balrog | *modep = mode | INTC_MODE_IS_PRIO; |
85 | 80f515e6 | balrog | *datap = &pr->value; |
86 | 80f515e6 | balrog | *enums = pr->enum_ids; |
87 | 80f515e6 | balrog | *first = (pr->reg_width / pr->field_width) - 1;
|
88 | 80f515e6 | balrog | *width = pr->field_width; |
89 | 80f515e6 | balrog | return;
|
90 | 80f515e6 | balrog | } |
91 | 80f515e6 | balrog | } |
92 | 80f515e6 | balrog | |
93 | 80f515e6 | balrog | assert(0);
|
94 | 80f515e6 | balrog | } |
95 | 80f515e6 | balrog | |
96 | 80f515e6 | balrog | static void sh_intc_toggle(struct intc_desc *desc, intc_enum id, |
97 | 80f515e6 | balrog | int enable, int is_group) |
98 | 80f515e6 | balrog | { |
99 | 80f515e6 | balrog | struct intc_source *source = desc->sources + id;
|
100 | 80f515e6 | balrog | int old = source->enable_count;
|
101 | 80f515e6 | balrog | |
102 | 80f515e6 | balrog | if (!id)
|
103 | 80f515e6 | balrog | return;
|
104 | 80f515e6 | balrog | |
105 | 80f515e6 | balrog | if (!source->next_enum_id && (!source->enable_max || !source->vect)) {
|
106 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
107 | 80f515e6 | balrog | printf("sh_intc: reserved interrupt source %d modified\n", id);
|
108 | 80f515e6 | balrog | #endif
|
109 | 80f515e6 | balrog | return;
|
110 | 80f515e6 | balrog | } |
111 | 80f515e6 | balrog | |
112 | 80f515e6 | balrog | if (source->vect) {
|
113 | 80f515e6 | balrog | if (enable)
|
114 | 80f515e6 | balrog | source->enable_count++; |
115 | 80f515e6 | balrog | else
|
116 | 80f515e6 | balrog | source->enable_count--; |
117 | 80f515e6 | balrog | |
118 | 80f515e6 | balrog | if (source->enable_count == source->enable_max) {
|
119 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
120 | 80f515e6 | balrog | printf("sh_intc: enabling interrupt source %d -> 0x%04x\n",
|
121 | 80f515e6 | balrog | id, source->vect); |
122 | 80f515e6 | balrog | #endif
|
123 | 80f515e6 | balrog | } |
124 | 80f515e6 | balrog | |
125 | 80f515e6 | balrog | if (old == source->enable_max) {
|
126 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
127 | 80f515e6 | balrog | printf("sh_intc: disabling interrupt source %d -> 0x%04x\n",
|
128 | 80f515e6 | balrog | id, source->vect); |
129 | 80f515e6 | balrog | #endif
|
130 | 80f515e6 | balrog | } |
131 | 80f515e6 | balrog | } |
132 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
133 | 80f515e6 | balrog | else {
|
134 | 80f515e6 | balrog | printf("setting interrupt group %d to %d\n", id, !!enable);
|
135 | 80f515e6 | balrog | } |
136 | 80f515e6 | balrog | #endif
|
137 | 80f515e6 | balrog | |
138 | 80f515e6 | balrog | if ((is_group || !source->vect) && source->next_enum_id) {
|
139 | 80f515e6 | balrog | sh_intc_toggle(desc, source->next_enum_id, enable, 1);
|
140 | 80f515e6 | balrog | } |
141 | 80f515e6 | balrog | |
142 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
143 | 80f515e6 | balrog | if (!source->vect) {
|
144 | 80f515e6 | balrog | printf("setting interrupt group %d to %d - done\n", id, !!enable);
|
145 | 80f515e6 | balrog | } |
146 | 80f515e6 | balrog | #endif
|
147 | 80f515e6 | balrog | } |
148 | 80f515e6 | balrog | |
149 | 80f515e6 | balrog | static uint32_t sh_intc_read(void *opaque, target_phys_addr_t offset) |
150 | 80f515e6 | balrog | { |
151 | 80f515e6 | balrog | struct intc_desc *desc = opaque;
|
152 | 80f515e6 | balrog | intc_enum *enum_ids = NULL;
|
153 | 80f515e6 | balrog | unsigned int first = 0; |
154 | 80f515e6 | balrog | unsigned int width = 0; |
155 | 80f515e6 | balrog | unsigned int mode = 0; |
156 | 80f515e6 | balrog | unsigned long *valuep; |
157 | 80f515e6 | balrog | |
158 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
159 | 80f515e6 | balrog | printf("sh_intc_read 0x%lx\n", (unsigned long) offset); |
160 | 80f515e6 | balrog | #endif
|
161 | 80f515e6 | balrog | |
162 | 80f515e6 | balrog | sh_intc_locate(desc, (unsigned long)offset, &valuep, |
163 | 80f515e6 | balrog | &enum_ids, &first, &width, &mode); |
164 | 80f515e6 | balrog | return *valuep;
|
165 | 80f515e6 | balrog | } |
166 | 80f515e6 | balrog | |
167 | 80f515e6 | balrog | static void sh_intc_write(void *opaque, target_phys_addr_t offset, |
168 | 80f515e6 | balrog | uint32_t value) |
169 | 80f515e6 | balrog | { |
170 | 80f515e6 | balrog | struct intc_desc *desc = opaque;
|
171 | 80f515e6 | balrog | intc_enum *enum_ids = NULL;
|
172 | 80f515e6 | balrog | unsigned int first = 0; |
173 | 80f515e6 | balrog | unsigned int width = 0; |
174 | 80f515e6 | balrog | unsigned int mode = 0; |
175 | 80f515e6 | balrog | unsigned int k; |
176 | 80f515e6 | balrog | unsigned long *valuep; |
177 | 80f515e6 | balrog | unsigned long mask; |
178 | 80f515e6 | balrog | |
179 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
180 | 80f515e6 | balrog | printf("sh_intc_write 0x%lx 0x%08x\n", (unsigned long) offset, value); |
181 | 80f515e6 | balrog | #endif
|
182 | 80f515e6 | balrog | |
183 | 80f515e6 | balrog | sh_intc_locate(desc, (unsigned long)offset, &valuep, |
184 | 80f515e6 | balrog | &enum_ids, &first, &width, &mode); |
185 | 80f515e6 | balrog | |
186 | 80f515e6 | balrog | switch (mode) {
|
187 | 80f515e6 | balrog | case INTC_MODE_ENABLE_REG | INTC_MODE_IS_PRIO: break; |
188 | 80f515e6 | balrog | case INTC_MODE_DUAL_SET: value |= *valuep; break; |
189 | 80f515e6 | balrog | case INTC_MODE_DUAL_CLR: value = *valuep & ~value; break; |
190 | 80f515e6 | balrog | default: assert(0); |
191 | 80f515e6 | balrog | } |
192 | 80f515e6 | balrog | |
193 | 80f515e6 | balrog | for (k = 0; k <= first; k++) { |
194 | 80f515e6 | balrog | mask = ((1 << width) - 1) << ((first - k) * width); |
195 | 80f515e6 | balrog | |
196 | 80f515e6 | balrog | if ((*valuep & mask) == (value & mask))
|
197 | 80f515e6 | balrog | continue;
|
198 | 80f515e6 | balrog | #if 0
|
199 | 80f515e6 | balrog | printf("k = %d, first = %d, enum = %d, mask = 0x%08x\n",
|
200 | 80f515e6 | balrog | k, first, enum_ids[k], (unsigned int)mask);
|
201 | 80f515e6 | balrog | #endif
|
202 | 80f515e6 | balrog | sh_intc_toggle(desc, enum_ids[k], value & mask, 0);
|
203 | 80f515e6 | balrog | } |
204 | 80f515e6 | balrog | |
205 | 80f515e6 | balrog | *valuep = value; |
206 | 80f515e6 | balrog | |
207 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
208 | 80f515e6 | balrog | printf("sh_intc_write 0x%lx -> 0x%08x\n", (unsigned long) offset, value); |
209 | 80f515e6 | balrog | #endif
|
210 | 80f515e6 | balrog | } |
211 | 80f515e6 | balrog | |
212 | 80f515e6 | balrog | static CPUReadMemoryFunc *sh_intc_readfn[] = {
|
213 | 80f515e6 | balrog | sh_intc_read, |
214 | 80f515e6 | balrog | sh_intc_read, |
215 | 80f515e6 | balrog | sh_intc_read |
216 | 80f515e6 | balrog | }; |
217 | 80f515e6 | balrog | |
218 | 80f515e6 | balrog | static CPUWriteMemoryFunc *sh_intc_writefn[] = {
|
219 | 80f515e6 | balrog | sh_intc_write, |
220 | 80f515e6 | balrog | sh_intc_write, |
221 | 80f515e6 | balrog | sh_intc_write |
222 | 80f515e6 | balrog | }; |
223 | 80f515e6 | balrog | |
224 | 80f515e6 | balrog | struct intc_source *sh_intc_source(struct intc_desc *desc, intc_enum id) |
225 | 80f515e6 | balrog | { |
226 | 80f515e6 | balrog | if (id)
|
227 | 80f515e6 | balrog | return desc->sources + id;
|
228 | 80f515e6 | balrog | |
229 | 80f515e6 | balrog | return NULL; |
230 | 80f515e6 | balrog | } |
231 | 80f515e6 | balrog | |
232 | 80f515e6 | balrog | static void sh_intc_register(struct intc_desc *desc, |
233 | 80f515e6 | balrog | unsigned long address) |
234 | 80f515e6 | balrog | { |
235 | 80f515e6 | balrog | if (address)
|
236 | 80f515e6 | balrog | cpu_register_physical_memory(INTC_A7(address), 4, desc->iomemtype);
|
237 | 80f515e6 | balrog | } |
238 | 80f515e6 | balrog | |
239 | 80f515e6 | balrog | static void sh_intc_register_source(struct intc_desc *desc, |
240 | 80f515e6 | balrog | intc_enum source, |
241 | 80f515e6 | balrog | struct intc_group *groups,
|
242 | 80f515e6 | balrog | int nr_groups)
|
243 | 80f515e6 | balrog | { |
244 | 80f515e6 | balrog | unsigned int i, k; |
245 | 80f515e6 | balrog | struct intc_source *s;
|
246 | 80f515e6 | balrog | |
247 | 80f515e6 | balrog | if (desc->mask_regs) {
|
248 | 80f515e6 | balrog | for (i = 0; i < desc->nr_mask_regs; i++) { |
249 | 80f515e6 | balrog | struct intc_mask_reg *mr = desc->mask_regs + i;
|
250 | 80f515e6 | balrog | |
251 | 80f515e6 | balrog | for (k = 0; k < INTC_ARRAY(mr->enum_ids); k++) { |
252 | 80f515e6 | balrog | if (mr->enum_ids[k] != source)
|
253 | 80f515e6 | balrog | continue;
|
254 | 80f515e6 | balrog | |
255 | 80f515e6 | balrog | s = sh_intc_source(desc, mr->enum_ids[k]); |
256 | 80f515e6 | balrog | if (s)
|
257 | 80f515e6 | balrog | s->enable_max++; |
258 | 80f515e6 | balrog | } |
259 | 80f515e6 | balrog | } |
260 | 80f515e6 | balrog | } |
261 | 80f515e6 | balrog | |
262 | 80f515e6 | balrog | if (desc->prio_regs) {
|
263 | 80f515e6 | balrog | for (i = 0; i < desc->nr_prio_regs; i++) { |
264 | 80f515e6 | balrog | struct intc_prio_reg *pr = desc->prio_regs + i;
|
265 | 80f515e6 | balrog | |
266 | 80f515e6 | balrog | for (k = 0; k < INTC_ARRAY(pr->enum_ids); k++) { |
267 | 80f515e6 | balrog | if (pr->enum_ids[k] != source)
|
268 | 80f515e6 | balrog | continue;
|
269 | 80f515e6 | balrog | |
270 | 80f515e6 | balrog | s = sh_intc_source(desc, pr->enum_ids[k]); |
271 | 80f515e6 | balrog | if (s)
|
272 | 80f515e6 | balrog | s->enable_max++; |
273 | 80f515e6 | balrog | } |
274 | 80f515e6 | balrog | } |
275 | 80f515e6 | balrog | } |
276 | 80f515e6 | balrog | |
277 | 80f515e6 | balrog | if (groups) {
|
278 | 80f515e6 | balrog | for (i = 0; i < nr_groups; i++) { |
279 | 80f515e6 | balrog | struct intc_group *gr = groups + i;
|
280 | 80f515e6 | balrog | |
281 | 80f515e6 | balrog | for (k = 0; k < INTC_ARRAY(gr->enum_ids); k++) { |
282 | 80f515e6 | balrog | if (gr->enum_ids[k] != source)
|
283 | 80f515e6 | balrog | continue;
|
284 | 80f515e6 | balrog | |
285 | 80f515e6 | balrog | s = sh_intc_source(desc, gr->enum_ids[k]); |
286 | 80f515e6 | balrog | if (s)
|
287 | 80f515e6 | balrog | s->enable_max++; |
288 | 80f515e6 | balrog | } |
289 | 80f515e6 | balrog | } |
290 | 80f515e6 | balrog | } |
291 | 80f515e6 | balrog | |
292 | 80f515e6 | balrog | } |
293 | 80f515e6 | balrog | |
294 | 80f515e6 | balrog | void sh_intc_register_sources(struct intc_desc *desc, |
295 | 80f515e6 | balrog | struct intc_vect *vectors,
|
296 | 80f515e6 | balrog | int nr_vectors,
|
297 | 80f515e6 | balrog | struct intc_group *groups,
|
298 | 80f515e6 | balrog | int nr_groups)
|
299 | 80f515e6 | balrog | { |
300 | 80f515e6 | balrog | unsigned int i, k; |
301 | 80f515e6 | balrog | struct intc_source *s;
|
302 | 80f515e6 | balrog | |
303 | 80f515e6 | balrog | for (i = 0; i < nr_vectors; i++) { |
304 | 80f515e6 | balrog | struct intc_vect *vect = vectors + i;
|
305 | 80f515e6 | balrog | |
306 | 80f515e6 | balrog | sh_intc_register_source(desc, vect->enum_id, groups, nr_groups); |
307 | 80f515e6 | balrog | s = sh_intc_source(desc, vect->enum_id); |
308 | 80f515e6 | balrog | if (s)
|
309 | 80f515e6 | balrog | s->vect = vect->vect; |
310 | 80f515e6 | balrog | |
311 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
312 | 80f515e6 | balrog | printf("sh_intc: registered source %d -> 0x%04x (%d/%d)\n",
|
313 | 80f515e6 | balrog | vect->enum_id, s->vect, s->enable_count, s->enable_max); |
314 | 80f515e6 | balrog | #endif
|
315 | 80f515e6 | balrog | } |
316 | 80f515e6 | balrog | |
317 | 80f515e6 | balrog | if (groups) {
|
318 | 80f515e6 | balrog | for (i = 0; i < nr_groups; i++) { |
319 | 80f515e6 | balrog | struct intc_group *gr = groups + i;
|
320 | 80f515e6 | balrog | |
321 | 80f515e6 | balrog | s = sh_intc_source(desc, gr->enum_id); |
322 | 80f515e6 | balrog | s->next_enum_id = gr->enum_ids[0];
|
323 | 80f515e6 | balrog | |
324 | 80f515e6 | balrog | for (k = 1; k < INTC_ARRAY(gr->enum_ids); k++) { |
325 | 80f515e6 | balrog | if (!gr->enum_ids[k])
|
326 | 80f515e6 | balrog | continue;
|
327 | 80f515e6 | balrog | |
328 | 80f515e6 | balrog | s = sh_intc_source(desc, gr->enum_ids[k - 1]);
|
329 | 80f515e6 | balrog | s->next_enum_id = gr->enum_ids[k]; |
330 | 80f515e6 | balrog | } |
331 | 80f515e6 | balrog | |
332 | 80f515e6 | balrog | #ifdef DEBUG_INTC
|
333 | 80f515e6 | balrog | printf("sh_intc: registered group %d (%d/%d)\n",
|
334 | 80f515e6 | balrog | gr->enum_id, s->enable_count, s->enable_max); |
335 | 80f515e6 | balrog | #endif
|
336 | 80f515e6 | balrog | } |
337 | 80f515e6 | balrog | } |
338 | 80f515e6 | balrog | } |
339 | 80f515e6 | balrog | |
340 | 80f515e6 | balrog | int sh_intc_init(struct intc_desc *desc, |
341 | 80f515e6 | balrog | int nr_sources,
|
342 | 80f515e6 | balrog | struct intc_mask_reg *mask_regs,
|
343 | 80f515e6 | balrog | int nr_mask_regs,
|
344 | 80f515e6 | balrog | struct intc_prio_reg *prio_regs,
|
345 | 80f515e6 | balrog | int nr_prio_regs)
|
346 | 80f515e6 | balrog | { |
347 | 80f515e6 | balrog | unsigned int i; |
348 | 80f515e6 | balrog | |
349 | 80f515e6 | balrog | desc->nr_sources = nr_sources; |
350 | 80f515e6 | balrog | desc->mask_regs = mask_regs; |
351 | 80f515e6 | balrog | desc->nr_mask_regs = nr_mask_regs; |
352 | 80f515e6 | balrog | desc->prio_regs = prio_regs; |
353 | 80f515e6 | balrog | desc->nr_prio_regs = nr_prio_regs; |
354 | 80f515e6 | balrog | |
355 | 80f515e6 | balrog | i = sizeof(struct intc_source) * nr_sources; |
356 | 80f515e6 | balrog | desc->sources = malloc(i); |
357 | 80f515e6 | balrog | if (!desc->sources)
|
358 | 80f515e6 | balrog | return -1; |
359 | 80f515e6 | balrog | |
360 | 80f515e6 | balrog | memset(desc->sources, 0, i);
|
361 | 80f515e6 | balrog | |
362 | 80f515e6 | balrog | desc->iomemtype = cpu_register_io_memory(0, sh_intc_readfn,
|
363 | 80f515e6 | balrog | sh_intc_writefn, desc); |
364 | 80f515e6 | balrog | if (desc->mask_regs) {
|
365 | 80f515e6 | balrog | for (i = 0; i < desc->nr_mask_regs; i++) { |
366 | 80f515e6 | balrog | struct intc_mask_reg *mr = desc->mask_regs + i;
|
367 | 80f515e6 | balrog | |
368 | 80f515e6 | balrog | sh_intc_register(desc, mr->set_reg); |
369 | 80f515e6 | balrog | sh_intc_register(desc, mr->clr_reg); |
370 | 80f515e6 | balrog | } |
371 | 80f515e6 | balrog | } |
372 | 80f515e6 | balrog | |
373 | 80f515e6 | balrog | if (desc->prio_regs) {
|
374 | 80f515e6 | balrog | for (i = 0; i < desc->nr_prio_regs; i++) { |
375 | 80f515e6 | balrog | struct intc_prio_reg *pr = desc->prio_regs + i;
|
376 | 80f515e6 | balrog | |
377 | 80f515e6 | balrog | sh_intc_register(desc, pr->set_reg); |
378 | 80f515e6 | balrog | sh_intc_register(desc, pr->clr_reg); |
379 | 80f515e6 | balrog | } |
380 | 80f515e6 | balrog | } |
381 | 80f515e6 | balrog | |
382 | 80f515e6 | balrog | return 0; |
383 | 80f515e6 | balrog | } |