Commit | Line | Data |
---|---|---|
88278ca2 | 1 | /* |
1da177e4 LT |
2 | * arch/sparc/kernel/sun4d_irq.c: |
3 | * SS1000/SC2000 interrupt handling. | |
4 | * | |
5 | * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) | |
6 | * Heavily based on arch/sparc/kernel/irq.c. | |
7 | */ | |
8 | ||
1da177e4 LT |
9 | #include <linux/errno.h> |
10 | #include <linux/linkage.h> | |
11 | #include <linux/kernel_stat.h> | |
12 | #include <linux/signal.h> | |
13 | #include <linux/sched.h> | |
14 | #include <linux/ptrace.h> | |
15 | #include <linux/interrupt.h> | |
16 | #include <linux/slab.h> | |
17 | #include <linux/random.h> | |
18 | #include <linux/init.h> | |
19 | #include <linux/smp.h> | |
1da177e4 LT |
20 | #include <linux/spinlock.h> |
21 | #include <linux/seq_file.h> | |
454eeb2d DM |
22 | #include <linux/of.h> |
23 | #include <linux/of_device.h> | |
1da177e4 LT |
24 | |
25 | #include <asm/ptrace.h> | |
26 | #include <asm/processor.h> | |
27 | #include <asm/system.h> | |
28 | #include <asm/psr.h> | |
29 | #include <asm/smp.h> | |
30 | #include <asm/vaddrs.h> | |
31 | #include <asm/timer.h> | |
32 | #include <asm/openprom.h> | |
33 | #include <asm/oplib.h> | |
34 | #include <asm/traps.h> | |
35 | #include <asm/irq.h> | |
36 | #include <asm/io.h> | |
37 | #include <asm/pgalloc.h> | |
38 | #include <asm/pgtable.h> | |
1da177e4 LT |
39 | #include <asm/sbi.h> |
40 | #include <asm/cacheflush.h> | |
0d84438d | 41 | #include <asm/irq_regs.h> |
1da177e4 | 42 | |
81265fd9 | 43 | #include "kernel.h" |
32231a66 AV |
44 | #include "irq.h" |
45 | ||
1da177e4 LT |
46 | /* If you trust current SCSI layer to handle different SCSI IRQs, enable this. I don't trust it... -jj */ |
47 | /* #define DISTRIBUTE_IRQS */ | |
48 | ||
f5f10857 DM |
49 | struct sun4d_timer_regs { |
50 | u32 l10_timer_limit; | |
51 | u32 l10_cur_countx; | |
52 | u32 l10_limit_noclear; | |
53 | u32 ctrl; | |
54 | u32 l10_cur_count; | |
55 | }; | |
56 | ||
57 | static struct sun4d_timer_regs __iomem *sun4d_timers; | |
58 | ||
1da177e4 LT |
59 | #define TIMER_IRQ 10 |
60 | ||
61 | #define MAX_STATIC_ALLOC 4 | |
1da177e4 | 62 | extern int static_irq_count; |
c61c65cd | 63 | static unsigned char sbus_tid[32]; |
1da177e4 | 64 | |
a54123e2 | 65 | static struct irqaction *irq_action[NR_IRQS]; |
1da177e4 LT |
66 | extern spinlock_t irq_action_lock; |
67 | ||
c61c65cd | 68 | static struct sbus_action { |
1da177e4 LT |
69 | struct irqaction *action; |
70 | /* For SMP this needs to be extended */ | |
71 | } *sbus_actions; | |
72 | ||
73 | static int pil_to_sbus[] = { | |
74 | 0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0, | |
75 | }; | |
76 | ||
77 | static int sbus_to_pil[] = { | |
78 | 0, 2, 3, 5, 7, 9, 11, 13, | |
79 | }; | |
80 | ||
81 | static int nsbi; | |
f8376e93 DM |
82 | |
83 | /* Exported for sun4d_smp.c */ | |
1da177e4 | 84 | DEFINE_SPINLOCK(sun4d_imsk_lock); |
1da177e4 LT |
85 | |
86 | int show_sun4d_interrupts(struct seq_file *p, void *v) | |
87 | { | |
88 | int i = *(loff_t *) v, j = 0, k = 0, sbusl; | |
89 | struct irqaction * action; | |
90 | unsigned long flags; | |
91 | #ifdef CONFIG_SMP | |
92 | int x; | |
93 | #endif | |
94 | ||
95 | spin_lock_irqsave(&irq_action_lock, flags); | |
96 | if (i < NR_IRQS) { | |
97 | sbusl = pil_to_sbus[i]; | |
98 | if (!sbusl) { | |
99 | action = *(i + irq_action); | |
100 | if (!action) | |
101 | goto out_unlock; | |
102 | } else { | |
103 | for (j = 0; j < nsbi; j++) { | |
104 | for (k = 0; k < 4; k++) | |
105 | if ((action = sbus_actions [(j << 5) + (sbusl << 2) + k].action)) | |
106 | goto found_it; | |
107 | } | |
108 | goto out_unlock; | |
109 | } | |
110 | found_it: seq_printf(p, "%3d: ", i); | |
111 | #ifndef CONFIG_SMP | |
112 | seq_printf(p, "%10u ", kstat_irqs(i)); | |
113 | #else | |
394e3902 AM |
114 | for_each_online_cpu(x) |
115 | seq_printf(p, "%10u ", | |
116 | kstat_cpu(cpu_logical_map(x)).irqs[i]); | |
1da177e4 LT |
117 | #endif |
118 | seq_printf(p, "%c %s", | |
67413202 | 119 | (action->flags & IRQF_DISABLED) ? '+' : ' ', |
1da177e4 LT |
120 | action->name); |
121 | action = action->next; | |
122 | for (;;) { | |
123 | for (; action; action = action->next) { | |
124 | seq_printf(p, ",%s %s", | |
67413202 | 125 | (action->flags & IRQF_DISABLED) ? " +" : "", |
1da177e4 LT |
126 | action->name); |
127 | } | |
128 | if (!sbusl) break; | |
129 | k++; | |
130 | if (k < 4) | |
131 | action = sbus_actions [(j << 5) + (sbusl << 2) + k].action; | |
132 | else { | |
133 | j++; | |
134 | if (j == nsbi) break; | |
135 | k = 0; | |
136 | action = sbus_actions [(j << 5) + (sbusl << 2)].action; | |
137 | } | |
138 | } | |
139 | seq_putc(p, '\n'); | |
140 | } | |
141 | out_unlock: | |
142 | spin_unlock_irqrestore(&irq_action_lock, flags); | |
143 | return 0; | |
144 | } | |
145 | ||
146 | void sun4d_free_irq(unsigned int irq, void *dev_id) | |
147 | { | |
148 | struct irqaction *action, **actionp; | |
149 | struct irqaction *tmp = NULL; | |
150 | unsigned long flags; | |
151 | ||
152 | spin_lock_irqsave(&irq_action_lock, flags); | |
153 | if (irq < 15) | |
154 | actionp = irq + irq_action; | |
155 | else | |
156 | actionp = &(sbus_actions[irq - (1 << 5)].action); | |
157 | action = *actionp; | |
158 | if (!action) { | |
159 | printk("Trying to free free IRQ%d\n",irq); | |
160 | goto out_unlock; | |
161 | } | |
162 | if (dev_id) { | |
163 | for (; action; action = action->next) { | |
164 | if (action->dev_id == dev_id) | |
165 | break; | |
166 | tmp = action; | |
167 | } | |
168 | if (!action) { | |
169 | printk("Trying to free free shared IRQ%d\n",irq); | |
170 | goto out_unlock; | |
171 | } | |
67413202 | 172 | } else if (action->flags & IRQF_SHARED) { |
1da177e4 LT |
173 | printk("Trying to free shared IRQ%d with NULL device ID\n", irq); |
174 | goto out_unlock; | |
175 | } | |
176 | if (action->flags & SA_STATIC_ALLOC) | |
177 | { | |
178 | /* This interrupt is marked as specially allocated | |
179 | * so it is a bad idea to free it. | |
180 | */ | |
181 | printk("Attempt to free statically allocated IRQ%d (%s)\n", | |
182 | irq, action->name); | |
183 | goto out_unlock; | |
184 | } | |
185 | ||
186 | if (action && tmp) | |
187 | tmp->next = action->next; | |
188 | else | |
189 | *actionp = action->next; | |
190 | ||
191 | spin_unlock_irqrestore(&irq_action_lock, flags); | |
192 | ||
193 | synchronize_irq(irq); | |
194 | ||
195 | spin_lock_irqsave(&irq_action_lock, flags); | |
196 | ||
197 | kfree(action); | |
198 | ||
199 | if (!(*actionp)) | |
0f516813 | 200 | __disable_irq(irq); |
1da177e4 LT |
201 | |
202 | out_unlock: | |
203 | spin_unlock_irqrestore(&irq_action_lock, flags); | |
204 | } | |
205 | ||
206 | extern void unexpected_irq(int, void *, struct pt_regs *); | |
207 | ||
208 | void sun4d_handler_irq(int irq, struct pt_regs * regs) | |
209 | { | |
0d84438d | 210 | struct pt_regs *old_regs; |
1da177e4 LT |
211 | struct irqaction * action; |
212 | int cpu = smp_processor_id(); | |
213 | /* SBUS IRQ level (1 - 7) */ | |
214 | int sbusl = pil_to_sbus[irq]; | |
215 | ||
216 | /* FIXME: Is this necessary?? */ | |
217 | cc_get_ipen(); | |
218 | ||
219 | cc_set_iclr(1 << irq); | |
220 | ||
0d84438d | 221 | old_regs = set_irq_regs(regs); |
1da177e4 LT |
222 | irq_enter(); |
223 | kstat_cpu(cpu).irqs[irq]++; | |
224 | if (!sbusl) { | |
225 | action = *(irq + irq_action); | |
226 | if (!action) | |
227 | unexpected_irq(irq, NULL, regs); | |
228 | do { | |
0d84438d | 229 | action->handler(irq, action->dev_id); |
1da177e4 LT |
230 | action = action->next; |
231 | } while (action); | |
232 | } else { | |
233 | int bus_mask = bw_get_intr_mask(sbusl) & 0x3ffff; | |
234 | int sbino; | |
235 | struct sbus_action *actionp; | |
236 | unsigned mask, slot; | |
237 | int sbil = (sbusl << 2); | |
238 | ||
239 | bw_clear_intr_mask(sbusl, bus_mask); | |
240 | ||
241 | /* Loop for each pending SBI */ | |
242 | for (sbino = 0; bus_mask; sbino++, bus_mask >>= 1) | |
243 | if (bus_mask & 1) { | |
244 | mask = acquire_sbi(SBI2DEVID(sbino), 0xf << sbil); | |
245 | mask &= (0xf << sbil); | |
246 | actionp = sbus_actions + (sbino << 5) + (sbil); | |
247 | /* Loop for each pending SBI slot */ | |
248 | for (slot = (1 << sbil); mask; slot <<= 1, actionp++) | |
249 | if (mask & slot) { | |
250 | mask &= ~slot; | |
251 | action = actionp->action; | |
252 | ||
253 | if (!action) | |
254 | unexpected_irq(irq, NULL, regs); | |
255 | do { | |
0d84438d | 256 | action->handler(irq, action->dev_id); |
1da177e4 LT |
257 | action = action->next; |
258 | } while (action); | |
259 | release_sbi(SBI2DEVID(sbino), slot); | |
260 | } | |
261 | } | |
262 | } | |
263 | irq_exit(); | |
0d84438d | 264 | set_irq_regs(old_regs); |
1da177e4 LT |
265 | } |
266 | ||
1da177e4 | 267 | int sun4d_request_irq(unsigned int irq, |
40220c1a | 268 | irq_handler_t handler, |
1da177e4 LT |
269 | unsigned long irqflags, const char * devname, void *dev_id) |
270 | { | |
271 | struct irqaction *action, *tmp = NULL, **actionp; | |
272 | unsigned long flags; | |
273 | int ret; | |
274 | ||
275 | if(irq > 14 && irq < (1 << 5)) { | |
276 | ret = -EINVAL; | |
277 | goto out; | |
278 | } | |
279 | ||
280 | if (!handler) { | |
281 | ret = -EINVAL; | |
282 | goto out; | |
283 | } | |
284 | ||
285 | spin_lock_irqsave(&irq_action_lock, flags); | |
286 | ||
287 | if (irq >= (1 << 5)) | |
288 | actionp = &(sbus_actions[irq - (1 << 5)].action); | |
289 | else | |
290 | actionp = irq + irq_action; | |
291 | action = *actionp; | |
292 | ||
293 | if (action) { | |
67413202 | 294 | if ((action->flags & IRQF_SHARED) && (irqflags & IRQF_SHARED)) { |
1da177e4 LT |
295 | for (tmp = action; tmp->next; tmp = tmp->next); |
296 | } else { | |
297 | ret = -EBUSY; | |
298 | goto out_unlock; | |
299 | } | |
67413202 | 300 | if ((action->flags & IRQF_DISABLED) ^ (irqflags & IRQF_DISABLED)) { |
1da177e4 LT |
301 | printk("Attempt to mix fast and slow interrupts on IRQ%d denied\n", irq); |
302 | ret = -EBUSY; | |
303 | goto out_unlock; | |
304 | } | |
305 | action = NULL; /* Or else! */ | |
306 | } | |
307 | ||
308 | /* If this is flagged as statically allocated then we use our | |
309 | * private struct which is never freed. | |
310 | */ | |
311 | if (irqflags & SA_STATIC_ALLOC) { | |
312 | if (static_irq_count < MAX_STATIC_ALLOC) | |
313 | action = &static_irqaction[static_irq_count++]; | |
314 | else | |
315 | printk("Request for IRQ%d (%s) SA_STATIC_ALLOC failed using kmalloc\n", irq, devname); | |
316 | } | |
317 | ||
318 | if (action == NULL) | |
5cbded58 | 319 | action = kmalloc(sizeof(struct irqaction), |
1da177e4 LT |
320 | GFP_ATOMIC); |
321 | ||
322 | if (!action) { | |
323 | ret = -ENOMEM; | |
324 | goto out_unlock; | |
325 | } | |
326 | ||
327 | action->handler = handler; | |
328 | action->flags = irqflags; | |
1da177e4 LT |
329 | action->name = devname; |
330 | action->next = NULL; | |
331 | action->dev_id = dev_id; | |
332 | ||
333 | if (tmp) | |
334 | tmp->next = action; | |
335 | else | |
336 | *actionp = action; | |
337 | ||
0f516813 | 338 | __enable_irq(irq); |
1da177e4 LT |
339 | |
340 | ret = 0; | |
341 | out_unlock: | |
342 | spin_unlock_irqrestore(&irq_action_lock, flags); | |
343 | out: | |
344 | return ret; | |
345 | } | |
346 | ||
347 | static void sun4d_disable_irq(unsigned int irq) | |
348 | { | |
1da177e4 LT |
349 | int tid = sbus_tid[(irq >> 5) - 1]; |
350 | unsigned long flags; | |
1da177e4 | 351 | |
f8376e93 DM |
352 | if (irq < NR_IRQS) |
353 | return; | |
354 | ||
1da177e4 LT |
355 | spin_lock_irqsave(&sun4d_imsk_lock, flags); |
356 | cc_set_imsk_other(tid, cc_get_imsk_other(tid) | (1 << sbus_to_pil[(irq >> 2) & 7])); | |
357 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); | |
1da177e4 LT |
358 | } |
359 | ||
360 | static void sun4d_enable_irq(unsigned int irq) | |
361 | { | |
1da177e4 LT |
362 | int tid = sbus_tid[(irq >> 5) - 1]; |
363 | unsigned long flags; | |
1da177e4 | 364 | |
f8376e93 DM |
365 | if (irq < NR_IRQS) |
366 | return; | |
367 | ||
1da177e4 LT |
368 | spin_lock_irqsave(&sun4d_imsk_lock, flags); |
369 | cc_set_imsk_other(tid, cc_get_imsk_other(tid) & ~(1 << sbus_to_pil[(irq >> 2) & 7])); | |
370 | spin_unlock_irqrestore(&sun4d_imsk_lock, flags); | |
1da177e4 LT |
371 | } |
372 | ||
373 | #ifdef CONFIG_SMP | |
374 | static void sun4d_set_cpu_int(int cpu, int level) | |
375 | { | |
376 | sun4d_send_ipi(cpu, level); | |
377 | } | |
378 | ||
379 | static void sun4d_clear_ipi(int cpu, int level) | |
380 | { | |
381 | } | |
382 | ||
383 | static void sun4d_set_udt(int cpu) | |
384 | { | |
385 | } | |
386 | ||
387 | /* Setup IRQ distribution scheme. */ | |
388 | void __init sun4d_distribute_irqs(void) | |
389 | { | |
71d37211 DM |
390 | struct device_node *dp; |
391 | ||
1da177e4 | 392 | #ifdef DISTRIBUTE_IRQS |
71d37211 | 393 | cpumask_t sbus_serving_map; |
1da177e4 LT |
394 | |
395 | sbus_serving_map = cpu_present_map; | |
71d37211 DM |
396 | for_each_node_by_name(dp, "sbi") { |
397 | int board = of_getintprop_default(dp, "board#", 0); | |
398 | ||
399 | if ((board * 2) == boot_cpu_id && cpu_isset(board * 2 + 1, cpu_present_map)) | |
400 | sbus_tid[board] = (board * 2 + 1); | |
401 | else if (cpu_isset(board * 2, cpu_present_map)) | |
402 | sbus_tid[board] = (board * 2); | |
403 | else if (cpu_isset(board * 2 + 1, cpu_present_map)) | |
404 | sbus_tid[board] = (board * 2 + 1); | |
1da177e4 | 405 | else |
71d37211 DM |
406 | sbus_tid[board] = 0xff; |
407 | if (sbus_tid[board] != 0xff) | |
408 | cpu_clear(sbus_tid[board], sbus_serving_map); | |
1da177e4 | 409 | } |
71d37211 DM |
410 | for_each_node_by_name(dp, "sbi") { |
411 | int board = of_getintprop_default(dp, "board#", 0); | |
412 | if (sbus_tid[board] == 0xff) { | |
1da177e4 LT |
413 | int i = 31; |
414 | ||
71d37211 | 415 | if (cpus_empty(sbus_serving_map)) |
1da177e4 | 416 | sbus_serving_map = cpu_present_map; |
71d37211 | 417 | while (cpu_isset(i, sbus_serving_map)) |
1da177e4 | 418 | i--; |
71d37211 DM |
419 | sbus_tid[board] = i; |
420 | cpu_clear(i, sbus_serving_map); | |
1da177e4 | 421 | } |
71d37211 DM |
422 | } |
423 | for_each_node_by_name(dp, "sbi") { | |
424 | int devid = of_getintprop_default(dp, "device-id", 0); | |
425 | int board = of_getintprop_default(dp, "board#", 0); | |
426 | printk("sbus%d IRQs directed to CPU%d\n", board, sbus_tid[board]); | |
427 | set_sbi_tid(devid, sbus_tid[board] << 3); | |
1da177e4 LT |
428 | } |
429 | #else | |
1da177e4 LT |
430 | int cpuid = cpu_logical_map(1); |
431 | ||
432 | if (cpuid == -1) | |
433 | cpuid = cpu_logical_map(0); | |
71d37211 DM |
434 | for_each_node_by_name(dp, "sbi") { |
435 | int devid = of_getintprop_default(dp, "device-id", 0); | |
436 | int board = of_getintprop_default(dp, "board#", 0); | |
437 | sbus_tid[board] = cpuid; | |
438 | set_sbi_tid(devid, cpuid << 3); | |
1da177e4 LT |
439 | } |
440 | printk("All sbus IRQs directed to CPU%d\n", cpuid); | |
441 | #endif | |
442 | } | |
443 | #endif | |
444 | ||
445 | static void sun4d_clear_clock_irq(void) | |
446 | { | |
f5f10857 | 447 | sbus_readl(&sun4d_timers->l10_timer_limit); |
1da177e4 LT |
448 | } |
449 | ||
1da177e4 LT |
450 | static void sun4d_load_profile_irq(int cpu, unsigned int limit) |
451 | { | |
452 | bw_set_prof_limit(cpu, limit); | |
453 | } | |
454 | ||
f5f10857 | 455 | static void __init sun4d_load_profile_irqs(void) |
1da177e4 | 456 | { |
f5f10857 | 457 | int cpu = 0, mid; |
1da177e4 | 458 | |
f5f10857 DM |
459 | while (!cpu_find_by_instance(cpu, NULL, &mid)) { |
460 | sun4d_load_profile_irq(mid >> 3, 0); | |
461 | cpu++; | |
462 | } | |
463 | } | |
464 | ||
465 | static void __init sun4d_fixup_trap_table(void) | |
466 | { | |
1da177e4 | 467 | #ifdef CONFIG_SMP |
f5f10857 DM |
468 | unsigned long flags; |
469 | extern unsigned long lvl14_save[4]; | |
470 | struct tt_entry *trap_table = &sparc_ttable[SP_TRAP_IRQ1 + (14 - 1)]; | |
471 | extern unsigned int real_irq_entry[], smp4d_ticker[]; | |
472 | extern unsigned int patchme_maybe_smp_msg[]; | |
473 | ||
474 | /* Adjust so that we jump directly to smp4d_ticker */ | |
475 | lvl14_save[2] += smp4d_ticker - real_irq_entry; | |
476 | ||
477 | /* For SMP we use the level 14 ticker, however the bootup code | |
478 | * has copied the firmware's level 14 vector into the boot cpu's | |
479 | * trap table, we must fix this now or we get squashed. | |
480 | */ | |
481 | local_irq_save(flags); | |
482 | patchme_maybe_smp_msg[0] = 0x01000000; /* NOP out the branch */ | |
483 | trap_table->inst_one = lvl14_save[0]; | |
484 | trap_table->inst_two = lvl14_save[1]; | |
485 | trap_table->inst_three = lvl14_save[2]; | |
486 | trap_table->inst_four = lvl14_save[3]; | |
487 | local_flush_cache_all(); | |
488 | local_irq_restore(flags); | |
1da177e4 | 489 | #endif |
f5f10857 DM |
490 | } |
491 | ||
492 | static void __init sun4d_init_timers(irq_handler_t counter_fn) | |
493 | { | |
494 | struct device_node *dp; | |
495 | struct resource res; | |
496 | const u32 *reg; | |
497 | int err; | |
498 | ||
499 | dp = of_find_node_by_name(NULL, "cpu-unit"); | |
500 | if (!dp) { | |
501 | prom_printf("sun4d_init_timers: Unable to find cpu-unit\n"); | |
502 | prom_halt(); | |
503 | } | |
504 | ||
505 | /* Which cpu-unit we use is arbitrary, we can view the bootbus timer | |
506 | * registers via any cpu's mapping. The first 'reg' property is the | |
507 | * bootbus. | |
508 | */ | |
509 | reg = of_get_property(dp, "reg", NULL); | |
c2e27c35 | 510 | of_node_put(dp); |
f5f10857 DM |
511 | if (!reg) { |
512 | prom_printf("sun4d_init_timers: No reg property\n"); | |
513 | prom_halt(); | |
514 | } | |
515 | ||
516 | res.start = reg[1]; | |
517 | res.end = reg[2] - 1; | |
518 | res.flags = reg[0] & 0xff; | |
519 | sun4d_timers = of_ioremap(&res, BW_TIMER_LIMIT, | |
520 | sizeof(struct sun4d_timer_regs), "user timer"); | |
521 | if (!sun4d_timers) { | |
522 | prom_printf("sun4d_init_timers: Can't map timer regs\n"); | |
523 | prom_halt(); | |
524 | } | |
525 | ||
526 | sbus_writel((((1000000/HZ) + 1) << 10), &sun4d_timers->l10_timer_limit); | |
1da177e4 | 527 | |
1da177e4 | 528 | master_l10_counter = &sun4d_timers->l10_cur_count; |
1da177e4 | 529 | |
f5f10857 | 530 | err = request_irq(TIMER_IRQ, counter_fn, |
67413202 | 531 | (IRQF_DISABLED | SA_STATIC_ALLOC), |
1da177e4 | 532 | "timer", NULL); |
f5f10857 DM |
533 | if (err) { |
534 | prom_printf("sun4d_init_timers: request_irq() failed with %d\n", err); | |
1da177e4 LT |
535 | prom_halt(); |
536 | } | |
f5f10857 DM |
537 | sun4d_load_profile_irqs(); |
538 | sun4d_fixup_trap_table(); | |
1da177e4 LT |
539 | } |
540 | ||
541 | void __init sun4d_init_sbi_irq(void) | |
542 | { | |
71d37211 | 543 | struct device_node *dp; |
f8376e93 DM |
544 | int target_cpu = 0; |
545 | ||
546 | #ifdef CONFIG_SMP | |
547 | target_cpu = boot_cpu_id; | |
548 | #endif | |
1da177e4 LT |
549 | |
550 | nsbi = 0; | |
71d37211 | 551 | for_each_node_by_name(dp, "sbi") |
1da177e4 | 552 | nsbi++; |
c80892d1 | 553 | sbus_actions = kzalloc (nsbi * 8 * 4 * sizeof(struct sbus_action), GFP_ATOMIC); |
d4accd60 DM |
554 | if (!sbus_actions) { |
555 | prom_printf("SUN4D: Cannot allocate sbus_actions, halting.\n"); | |
556 | prom_halt(); | |
557 | } | |
71d37211 DM |
558 | for_each_node_by_name(dp, "sbi") { |
559 | int devid = of_getintprop_default(dp, "device-id", 0); | |
560 | int board = of_getintprop_default(dp, "board#", 0); | |
561 | unsigned int mask; | |
562 | ||
f8376e93 DM |
563 | set_sbi_tid(devid, target_cpu << 3); |
564 | sbus_tid[board] = target_cpu; | |
565 | ||
1da177e4 | 566 | /* Get rid of pending irqs from PROM */ |
71d37211 | 567 | mask = acquire_sbi(devid, 0xffffffff); |
1da177e4 | 568 | if (mask) { |
71d37211 DM |
569 | printk ("Clearing pending IRQs %08x on SBI %d\n", mask, board); |
570 | release_sbi(devid, mask); | |
1da177e4 LT |
571 | } |
572 | } | |
573 | } | |
574 | ||
1da177e4 LT |
575 | void __init sun4d_init_IRQ(void) |
576 | { | |
577 | local_irq_disable(); | |
578 | ||
1da177e4 LT |
579 | BTFIXUPSET_CALL(enable_irq, sun4d_enable_irq, BTFIXUPCALL_NORM); |
580 | BTFIXUPSET_CALL(disable_irq, sun4d_disable_irq, BTFIXUPCALL_NORM); | |
581 | BTFIXUPSET_CALL(clear_clock_irq, sun4d_clear_clock_irq, BTFIXUPCALL_NORM); | |
1da177e4 | 582 | BTFIXUPSET_CALL(load_profile_irq, sun4d_load_profile_irq, BTFIXUPCALL_NORM); |
1da177e4 LT |
583 | sparc_init_timers = sun4d_init_timers; |
584 | #ifdef CONFIG_SMP | |
585 | BTFIXUPSET_CALL(set_cpu_int, sun4d_set_cpu_int, BTFIXUPCALL_NORM); | |
586 | BTFIXUPSET_CALL(clear_cpu_int, sun4d_clear_ipi, BTFIXUPCALL_NOP); | |
587 | BTFIXUPSET_CALL(set_irq_udt, sun4d_set_udt, BTFIXUPCALL_NOP); | |
588 | #endif | |
589 | /* Cannot enable interrupts until OBP ticker is disabled. */ | |
590 | } |