Fedora kernel-2.6.17-1.2142_FC4 patched with stable patch-2.6.17.4-vs2.0.2-rc26.diff
[linux-2.6.git] / arch / mips / sgi-ip27 / ip27-irq.c
index 61817a1..2e643d2 100644 (file)
@@ -5,6 +5,9 @@
  * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
  * Copyright (C) 1999 - 2001 Kanoj Sarcar
  */
+
+#undef DEBUG
+
 #include <linux/config.h>
 #include <linux/init.h>
 #include <linux/irq.h>
 #include <linux/types.h>
 #include <linux/interrupt.h>
 #include <linux/ioport.h>
-#include <linux/irq.h>
 #include <linux/timex.h>
 #include <linux/slab.h>
 #include <linux/random.h>
 #include <linux/smp_lock.h>
+#include <linux/kernel.h>
 #include <linux/kernel_stat.h>
 #include <linux/delay.h>
 #include <linux/bitops.h>
 #include <asm/sn/hub.h>
 #include <asm/sn/intr.h>
 
-#undef DEBUG_IRQ
-#ifdef DEBUG_IRQ
-#define DBG(x...) printk(x)
-#else
-#define DBG(x...)
-#endif
-
 /*
  * Linux has a controller-independent x86 interrupt architecture.
  * every controller has a 'controller-template', that is used
@@ -74,14 +70,15 @@ extern int irq_to_slot[];
 
 static inline int alloc_level(int cpu, int irq)
 {
+       struct hub_data *hub = hub_data(cpu_to_node(cpu));
        struct slice_data *si = cpu_data[cpu].data;
-       int level;                              /* pre-allocated entries */
+       int level;
 
-       level = find_first_zero_bit(si->irq_alloc_mask, LEVELS_PER_SLICE);
+       level = find_first_zero_bit(hub->irq_alloc_mask, LEVELS_PER_SLICE);
        if (level >= LEVELS_PER_SLICE)
                panic("Cpu %d flooded with devices\n", cpu);
 
-       __set_bit(level, si->irq_alloc_mask);
+       __set_bit(level, hub->irq_alloc_mask);
        si->level_to_irq[level] = irq;
 
        return level;
@@ -91,12 +88,9 @@ static inline int find_level(cpuid_t *cpunum, int irq)
 {
        int cpu, i;
 
-       for (cpu = 0; cpu <= NR_CPUS; cpu++) {
+       for_each_online_cpu(cpu) {
                struct slice_data *si = cpu_data[cpu].data;
 
-               if (!cpu_online(cpu))
-                       continue;
-
                for (i = BASE_PCI_IRQ; i < LEVELS_PER_SLICE; i++)
                        if (si->level_to_irq[i] == irq) {
                                *cpunum = cpu;
@@ -136,7 +130,7 @@ static int ms1bit(unsigned long x)
  * Kanoj 05.13.00
  */
 
-void ip27_do_irq_mask0(struct pt_regs *regs)
+static void ip27_do_irq_mask0(struct pt_regs *regs)
 {
        int irq, swlevel;
        hubreg_t pend0, mask0;
@@ -177,7 +171,7 @@ void ip27_do_irq_mask0(struct pt_regs *regs)
        LOCAL_HUB_L(PI_INT_PEND0);
 }
 
-void ip27_do_irq_mask1(struct pt_regs *regs)
+static void ip27_do_irq_mask1(struct pt_regs *regs)
 {
        int irq, swlevel;
        hubreg_t pend1, mask1;
@@ -202,12 +196,12 @@ void ip27_do_irq_mask1(struct pt_regs *regs)
        LOCAL_HUB_L(PI_INT_PEND1);
 }
 
-void ip27_prof_timer(struct pt_regs *regs)
+static void ip27_prof_timer(struct pt_regs *regs)
 {
        panic("CPU %d got a profiling interrupt", smp_processor_id());
 }
 
-void ip27_hub_error(struct pt_regs *regs)
+static void ip27_hub_error(struct pt_regs *regs)
 {
        panic("CPU %d got a hub error interrupt", smp_processor_id());
 }
@@ -216,9 +210,11 @@ static int intr_connect_level(int cpu, int bit)
 {
        nasid_t nasid = COMPACT_TO_NASID_NODEID(cpu_to_node(cpu));
        struct slice_data *si = cpu_data[cpu].data;
+       unsigned long flags;
 
-       __set_bit(bit, si->irq_enable_mask);
+       set_bit(bit, si->irq_enable_mask);
 
+       local_irq_save(flags);
        if (!cputoslice(cpu)) {
                REMOTE_HUB_S(nasid, PI_INT_MASK0_A, si->irq_enable_mask[0]);
                REMOTE_HUB_S(nasid, PI_INT_MASK1_A, si->irq_enable_mask[1]);
@@ -226,6 +222,7 @@ static int intr_connect_level(int cpu, int bit)
                REMOTE_HUB_S(nasid, PI_INT_MASK0_B, si->irq_enable_mask[0]);
                REMOTE_HUB_S(nasid, PI_INT_MASK1_B, si->irq_enable_mask[1]);
        }
+       local_irq_restore(flags);
 
        return 0;
 }
@@ -235,7 +232,7 @@ static int intr_disconnect_level(int cpu, int bit)
        nasid_t nasid = COMPACT_TO_NASID_NODEID(cpu_to_node(cpu));
        struct slice_data *si = cpu_data[cpu].data;
 
-       __clear_bit(bit, si->irq_enable_mask);
+       clear_bit(bit, si->irq_enable_mask);
 
        if (!cputoslice(cpu)) {
                REMOTE_HUB_S(nasid, PI_INT_MASK0_A, si->irq_enable_mask[0]);
@@ -261,7 +258,7 @@ static unsigned int startup_bridge_irq(unsigned int irq)
        bc = IRQ_TO_BRIDGE(irq);
        bridge = bc->base;
 
-       DBG("bridge_startup(): irq= 0x%x  pin=%d\n", irq, pin);
+       pr_debug("bridge_startup(): irq= 0x%x  pin=%d\n", irq, pin);
        /*
         * "map" irq to a swlevel greater than 6 since the first 6 bits
         * of INT_PEND0 are taken
@@ -298,12 +295,13 @@ static unsigned int startup_bridge_irq(unsigned int irq)
 static void shutdown_bridge_irq(unsigned int irq)
 {
        struct bridge_controller *bc = IRQ_TO_BRIDGE(irq);
+       struct hub_data *hub = hub_data(cpu_to_node(bc->irq_cpu));
        bridge_t *bridge = bc->base;
        struct slice_data *si = cpu_data[bc->irq_cpu].data;
        int pin, swlevel;
        cpuid_t cpu;
 
-       DBG("bridge_shutdown: irq 0x%x\n", irq);
+       pr_debug("bridge_shutdown: irq 0x%x\n", irq);
        pin = SLOT_FROM_PCI_IRQ(irq);
 
        /*
@@ -313,7 +311,7 @@ static void shutdown_bridge_irq(unsigned int irq)
        swlevel = find_level(&cpu, irq);
        intr_disconnect_level(cpu, swlevel);
 
-       __clear_bit(swlevel, si->irq_alloc_mask);
+       __clear_bit(swlevel, hub->irq_alloc_mask);
        si->level_to_irq[swlevel] = -1;
 
        bridge->b_int_enable &= ~(1 << pin);
@@ -423,9 +421,26 @@ int __devinit request_bridge_irq(struct bridge_controller *bc)
        return irq;
 }
 
+extern void ip27_rt_timer_interrupt(struct pt_regs *regs);
+
+asmlinkage void plat_irq_dispatch(struct pt_regs *regs)
+{
+       unsigned long pending = read_c0_cause() & read_c0_status();
+
+       if (pending & CAUSEF_IP4)
+               ip27_rt_timer_interrupt(regs);
+       else if (pending & CAUSEF_IP2)  /* PI_INT_PEND_0 or CC_PEND_{A|B} */
+               ip27_do_irq_mask0(regs);
+       else if (pending & CAUSEF_IP3)  /* PI_INT_PEND_1 */
+               ip27_do_irq_mask1(regs);
+       else if (pending & CAUSEF_IP5)
+               ip27_prof_timer(regs);
+       else if (pending & CAUSEF_IP6)
+               ip27_hub_error(regs);
+}
+
 void __init arch_init_irq(void)
 {
-       set_except_vector(0, ip27_irq);
 }
 
 void install_ipi(void)
@@ -433,25 +448,24 @@ void install_ipi(void)
        int slice = LOCAL_HUB_L(PI_CPU_NUM);
        int cpu = smp_processor_id();
        struct slice_data *si = cpu_data[cpu].data;
-       hubreg_t mask, set;
+       struct hub_data *hub = hub_data(cpu_to_node(cpu));
+       int resched, call;
+
+       resched = CPU_RESCHED_A_IRQ + slice;
+       __set_bit(resched, hub->irq_alloc_mask);
+       __set_bit(resched, si->irq_enable_mask);
+       LOCAL_HUB_CLR_INTR(resched);
+
+       call = CPU_CALL_A_IRQ + slice;
+       __set_bit(call, hub->irq_alloc_mask);
+       __set_bit(call, si->irq_enable_mask);
+       LOCAL_HUB_CLR_INTR(call);
 
        if (slice == 0) {
-               LOCAL_HUB_CLR_INTR(CPU_RESCHED_A_IRQ);
-               LOCAL_HUB_CLR_INTR(CPU_CALL_A_IRQ);
-               mask = LOCAL_HUB_L(PI_INT_MASK0_A);     /* Slice A */
-               set = (1UL << CPU_RESCHED_A_IRQ) | (1UL << CPU_CALL_A_IRQ);
-               mask |= set;
-               si->irq_enable_mask[0] |= set;
-               si->irq_alloc_mask[0] |= set;
-               LOCAL_HUB_S(PI_INT_MASK0_A, mask);
+               LOCAL_HUB_S(PI_INT_MASK0_A, si->irq_enable_mask[0]);
+               LOCAL_HUB_S(PI_INT_MASK1_A, si->irq_enable_mask[1]);
        } else {
-               LOCAL_HUB_CLR_INTR(CPU_RESCHED_B_IRQ);
-               LOCAL_HUB_CLR_INTR(CPU_CALL_B_IRQ);
-               mask = LOCAL_HUB_L(PI_INT_MASK0_B);     /* Slice B */
-               set = (1UL << CPU_RESCHED_B_IRQ) | (1UL << CPU_CALL_B_IRQ);
-               mask |= set;
-               si->irq_enable_mask[1] |= set;
-               si->irq_alloc_mask[1] |= set;
-               LOCAL_HUB_S(PI_INT_MASK0_B, mask);
+               LOCAL_HUB_S(PI_INT_MASK0_B, si->irq_enable_mask[0]);
+               LOCAL_HUB_S(PI_INT_MASK1_B, si->irq_enable_mask[1]);
        }
 }