2 * arch/sparc/kernel/sun4d_irq.c:
3 * SS1000/SC2000 interrupt handling.
5 * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
6 * Heavily based on arch/sparc/kernel/irq.c.
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>
20 #include <linux/spinlock.h>
21 #include <linux/seq_file.h>
23 #include <linux/of_device.h>
25 #include <asm/ptrace.h>
26 #include <asm/processor.h>
27 #include <asm/system.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>
37 #include <asm/pgalloc.h>
38 #include <asm/pgtable.h>
40 #include <asm/cacheflush.h>
41 #include <asm/irq_regs.h>
46 /* If you trust current SCSI layer to handle different SCSI IRQs, enable this. I don't trust it... -jj */
47 /* #define DISTRIBUTE_IRQS */
49 struct sun4d_timer_regs
{
52 u32 l10_limit_noclear
;
57 static struct sun4d_timer_regs __iomem
*sun4d_timers
;
61 #define MAX_STATIC_ALLOC 4
62 extern int static_irq_count
;
63 static unsigned char sbus_tid
[32];
65 static struct irqaction
*irq_action
[NR_IRQS
];
66 extern spinlock_t irq_action_lock
;
68 static struct sbus_action
{
69 struct irqaction
*action
;
70 /* For SMP this needs to be extended */
73 static int pil_to_sbus
[] = {
74 0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0,
77 static int sbus_to_pil
[] = {
78 0, 2, 3, 5, 7, 9, 11, 13,
83 /* Exported for sun4d_smp.c */
84 DEFINE_SPINLOCK(sun4d_imsk_lock
);
86 int show_sun4d_interrupts(struct seq_file
*p
, void *v
)
88 int i
= *(loff_t
*) v
, j
= 0, k
= 0, sbusl
;
89 struct irqaction
* action
;
95 spin_lock_irqsave(&irq_action_lock
, flags
);
97 sbusl
= pil_to_sbus
[i
];
99 action
= *(i
+ irq_action
);
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
))
110 found_it
: seq_printf(p
, "%3d: ", i
);
112 seq_printf(p
, "%10u ", kstat_irqs(i
));
114 for_each_online_cpu(x
)
115 seq_printf(p
, "%10u ",
116 kstat_cpu(cpu_logical_map(x
)).irqs
[i
]);
118 seq_printf(p
, "%c %s",
119 (action
->flags
& IRQF_DISABLED
) ? '+' : ' ',
121 action
= action
->next
;
123 for (; action
; action
= action
->next
) {
124 seq_printf(p
, ",%s %s",
125 (action
->flags
& IRQF_DISABLED
) ? " +" : "",
131 action
= sbus_actions
[(j
<< 5) + (sbusl
<< 2) + k
].action
;
134 if (j
== nsbi
) break;
136 action
= sbus_actions
[(j
<< 5) + (sbusl
<< 2)].action
;
142 spin_unlock_irqrestore(&irq_action_lock
, flags
);
146 void sun4d_free_irq(unsigned int irq
, void *dev_id
)
148 struct irqaction
*action
, **actionp
;
149 struct irqaction
*tmp
= NULL
;
152 spin_lock_irqsave(&irq_action_lock
, flags
);
154 actionp
= irq
+ irq_action
;
156 actionp
= &(sbus_actions
[irq
- (1 << 5)].action
);
159 printk("Trying to free free IRQ%d\n",irq
);
163 for (; action
; action
= action
->next
) {
164 if (action
->dev_id
== dev_id
)
169 printk("Trying to free free shared IRQ%d\n",irq
);
172 } else if (action
->flags
& IRQF_SHARED
) {
173 printk("Trying to free shared IRQ%d with NULL device ID\n", irq
);
176 if (action
->flags
& SA_STATIC_ALLOC
)
178 /* This interrupt is marked as specially allocated
179 * so it is a bad idea to free it.
181 printk("Attempt to free statically allocated IRQ%d (%s)\n",
187 tmp
->next
= action
->next
;
189 *actionp
= action
->next
;
191 spin_unlock_irqrestore(&irq_action_lock
, flags
);
193 synchronize_irq(irq
);
195 spin_lock_irqsave(&irq_action_lock
, flags
);
203 spin_unlock_irqrestore(&irq_action_lock
, flags
);
206 extern void unexpected_irq(int, void *, struct pt_regs
*);
208 void sun4d_handler_irq(int irq
, struct pt_regs
* regs
)
210 struct pt_regs
*old_regs
;
211 struct irqaction
* action
;
212 int cpu
= smp_processor_id();
213 /* SBUS IRQ level (1 - 7) */
214 int sbusl
= pil_to_sbus
[irq
];
216 /* FIXME: Is this necessary?? */
219 cc_set_iclr(1 << irq
);
221 old_regs
= set_irq_regs(regs
);
223 kstat_cpu(cpu
).irqs
[irq
]++;
225 action
= *(irq
+ irq_action
);
227 unexpected_irq(irq
, NULL
, regs
);
229 action
->handler(irq
, action
->dev_id
);
230 action
= action
->next
;
233 int bus_mask
= bw_get_intr_mask(sbusl
) & 0x3ffff;
235 struct sbus_action
*actionp
;
237 int sbil
= (sbusl
<< 2);
239 bw_clear_intr_mask(sbusl
, bus_mask
);
241 /* Loop for each pending SBI */
242 for (sbino
= 0; bus_mask
; sbino
++, 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
++)
251 action
= actionp
->action
;
254 unexpected_irq(irq
, NULL
, regs
);
256 action
->handler(irq
, action
->dev_id
);
257 action
= action
->next
;
259 release_sbi(SBI2DEVID(sbino
), slot
);
264 set_irq_regs(old_regs
);
267 int sun4d_request_irq(unsigned int irq
,
268 irq_handler_t handler
,
269 unsigned long irqflags
, const char * devname
, void *dev_id
)
271 struct irqaction
*action
, *tmp
= NULL
, **actionp
;
275 if(irq
> 14 && irq
< (1 << 5)) {
285 spin_lock_irqsave(&irq_action_lock
, flags
);
288 actionp
= &(sbus_actions
[irq
- (1 << 5)].action
);
290 actionp
= irq
+ irq_action
;
294 if ((action
->flags
& IRQF_SHARED
) && (irqflags
& IRQF_SHARED
)) {
295 for (tmp
= action
; tmp
->next
; tmp
= tmp
->next
);
300 if ((action
->flags
& IRQF_DISABLED
) ^ (irqflags
& IRQF_DISABLED
)) {
301 printk("Attempt to mix fast and slow interrupts on IRQ%d denied\n", irq
);
305 action
= NULL
; /* Or else! */
308 /* If this is flagged as statically allocated then we use our
309 * private struct which is never freed.
311 if (irqflags
& SA_STATIC_ALLOC
) {
312 if (static_irq_count
< MAX_STATIC_ALLOC
)
313 action
= &static_irqaction
[static_irq_count
++];
315 printk("Request for IRQ%d (%s) SA_STATIC_ALLOC failed using kmalloc\n", irq
, devname
);
319 action
= kmalloc(sizeof(struct irqaction
),
327 action
->handler
= handler
;
328 action
->flags
= irqflags
;
329 action
->name
= devname
;
331 action
->dev_id
= dev_id
;
342 spin_unlock_irqrestore(&irq_action_lock
, flags
);
347 static void sun4d_disable_irq(unsigned int irq
)
349 int tid
= sbus_tid
[(irq
>> 5) - 1];
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
);
360 static void sun4d_enable_irq(unsigned int irq
)
362 int tid
= sbus_tid
[(irq
>> 5) - 1];
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
);
374 static void sun4d_set_cpu_int(int cpu
, int level
)
376 sun4d_send_ipi(cpu
, level
);
379 static void sun4d_clear_ipi(int cpu
, int level
)
383 static void sun4d_set_udt(int cpu
)
387 /* Setup IRQ distribution scheme. */
388 void __init
sun4d_distribute_irqs(void)
390 struct device_node
*dp
;
392 #ifdef DISTRIBUTE_IRQS
393 cpumask_t sbus_serving_map
;
395 sbus_serving_map
= cpu_present_map
;
396 for_each_node_by_name(dp
, "sbi") {
397 int board
= of_getintprop_default(dp
, "board#", 0);
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);
406 sbus_tid
[board
] = 0xff;
407 if (sbus_tid
[board
] != 0xff)
408 cpu_clear(sbus_tid
[board
], sbus_serving_map
);
410 for_each_node_by_name(dp
, "sbi") {
411 int board
= of_getintprop_default(dp
, "board#", 0);
412 if (sbus_tid
[board
] == 0xff) {
415 if (cpus_empty(sbus_serving_map
))
416 sbus_serving_map
= cpu_present_map
;
417 while (cpu_isset(i
, sbus_serving_map
))
420 cpu_clear(i
, sbus_serving_map
);
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);
430 int cpuid
= cpu_logical_map(1);
433 cpuid
= cpu_logical_map(0);
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);
440 printk("All sbus IRQs directed to CPU%d\n", cpuid
);
445 static void sun4d_clear_clock_irq(void)
447 sbus_readl(&sun4d_timers
->l10_timer_limit
);
450 static void sun4d_load_profile_irq(int cpu
, unsigned int limit
)
452 bw_set_prof_limit(cpu
, limit
);
455 static void __init
sun4d_load_profile_irqs(void)
459 while (!cpu_find_by_instance(cpu
, NULL
, &mid
)) {
460 sun4d_load_profile_irq(mid
>> 3, 0);
465 static void __init
sun4d_fixup_trap_table(void)
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
[];
474 /* Adjust so that we jump directly to smp4d_ticker */
475 lvl14_save
[2] += smp4d_ticker
- real_irq_entry
;
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.
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
);
492 static void __init
sun4d_init_timers(irq_handler_t counter_fn
)
494 struct device_node
*dp
;
499 dp
= of_find_node_by_name(NULL
, "cpu-unit");
501 prom_printf("sun4d_init_timers: Unable to find cpu-unit\n");
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
509 reg
= of_get_property(dp
, "reg", NULL
);
512 prom_printf("sun4d_init_timers: No reg property\n");
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");
522 prom_printf("sun4d_init_timers: Can't map timer regs\n");
526 sbus_writel((((1000000/HZ
) + 1) << 10), &sun4d_timers
->l10_timer_limit
);
528 master_l10_counter
= &sun4d_timers
->l10_cur_count
;
530 err
= request_irq(TIMER_IRQ
, counter_fn
,
531 (IRQF_DISABLED
| SA_STATIC_ALLOC
),
534 prom_printf("sun4d_init_timers: request_irq() failed with %d\n", err
);
537 sun4d_load_profile_irqs();
538 sun4d_fixup_trap_table();
541 void __init
sun4d_init_sbi_irq(void)
543 struct device_node
*dp
;
547 target_cpu
= boot_cpu_id
;
551 for_each_node_by_name(dp
, "sbi")
553 sbus_actions
= kzalloc (nsbi
* 8 * 4 * sizeof(struct sbus_action
), GFP_ATOMIC
);
555 prom_printf("SUN4D: Cannot allocate sbus_actions, halting.\n");
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);
563 set_sbi_tid(devid
, target_cpu
<< 3);
564 sbus_tid
[board
] = target_cpu
;
566 /* Get rid of pending irqs from PROM */
567 mask
= acquire_sbi(devid
, 0xffffffff);
569 printk ("Clearing pending IRQs %08x on SBI %d\n", mask
, board
);
570 release_sbi(devid
, mask
);
575 void __init
sun4d_init_IRQ(void)
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
);
582 BTFIXUPSET_CALL(load_profile_irq
, sun4d_load_profile_irq
, BTFIXUPCALL_NORM
);
583 sparc_init_timers
= sun4d_init_timers
;
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
);
589 /* Cannot enable interrupts until OBP ticker is disabled. */