Revert to Fedora kernel-2.6.17-1.2187_FC5 patched with vs2.0.2.1; there are too many...
[linux-2.6.git] / arch / m68k / amiga / amiints.c
index 96c79d8..b0aa61b 100644 (file)
@@ -22,7 +22,7 @@
  *
  * 07/08/99: rewamp of the interrupt handling - we now have two types of
  *           interrupts, normal and fast handlers, fast handlers being
- *           marked with IRQF_DISABLED and runs with all other interrupts
+ *           marked with SA_INTERRUPT and runs with all other interrupts
  *           disabled. Normal interrupts disable their own source but
  *           run with all other interrupt sources enabled.
  *           PORTS and EXTER interrupts are always shared even if the
  *           /Jes
  */
 
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/kernel_stat.h>
 #include <linux/init.h>
-#include <linux/interrupt.h>
 #include <linux/errno.h>
+#include <linux/seq_file.h>
 
+#include <asm/system.h>
 #include <asm/irq.h>
 #include <asm/traps.h>
 #include <asm/amigahw.h>
 #include <asm/amigaints.h>
 #include <asm/amipcmcia.h>
 
-static void amiga_enable_irq(unsigned int irq);
-static void amiga_disable_irq(unsigned int irq);
-static irqreturn_t ami_int1(int irq, void *dev_id, struct pt_regs *fp);
-static irqreturn_t ami_int3(int irq, void *dev_id, struct pt_regs *fp);
-static irqreturn_t ami_int4(int irq, void *dev_id, struct pt_regs *fp);
-static irqreturn_t ami_int5(int irq, void *dev_id, struct pt_regs *fp);
-
-static struct irq_controller amiga_irq_controller = {
-       .name           = "amiga",
-       .lock           = SPIN_LOCK_UNLOCKED,
-       .enable         = amiga_enable_irq,
-       .disable        = amiga_disable_irq,
+extern int cia_request_irq(struct ciabase *base,int irq,
+                           irqreturn_t (*handler)(int, void *, struct pt_regs *),
+                           unsigned long flags, const char *devname, void *dev_id);
+extern void cia_free_irq(struct ciabase *base, unsigned int irq, void *dev_id);
+extern void cia_init_IRQ(struct ciabase *base);
+extern int cia_get_irq_list(struct ciabase *base, struct seq_file *p);
+
+/* irq node variables for amiga interrupt sources */
+static irq_node_t *ami_irq_list[AMI_STD_IRQS];
+
+static unsigned short amiga_intena_vals[AMI_STD_IRQS] = {
+       [IRQ_AMIGA_VERTB]       = IF_VERTB,
+       [IRQ_AMIGA_COPPER]      = IF_COPER,
+       [IRQ_AMIGA_AUD0]        = IF_AUD0,
+       [IRQ_AMIGA_AUD1]        = IF_AUD1,
+       [IRQ_AMIGA_AUD2]        = IF_AUD2,
+       [IRQ_AMIGA_AUD3]        = IF_AUD3,
+       [IRQ_AMIGA_BLIT]        = IF_BLIT,
+       [IRQ_AMIGA_DSKSYN]      = IF_DSKSYN,
+       [IRQ_AMIGA_DSKBLK]      = IF_DSKBLK,
+       [IRQ_AMIGA_RBF]         = IF_RBF,
+       [IRQ_AMIGA_TBE]         = IF_TBE,
+       [IRQ_AMIGA_SOFT]        = IF_SOFT,
+       [IRQ_AMIGA_PORTS]       = IF_PORTS,
+       [IRQ_AMIGA_EXTER]       = IF_EXTER
+};
+static const unsigned char ami_servers[AMI_STD_IRQS] = {
+       [IRQ_AMIGA_VERTB]       = 1,
+       [IRQ_AMIGA_PORTS]       = 1,
+       [IRQ_AMIGA_EXTER]       = 1
 };
 
+static short ami_ablecount[AMI_IRQS];
+
+static irqreturn_t ami_badint(int irq, void *dev_id, struct pt_regs *fp)
+{
+       num_spurious += 1;
+       return IRQ_NONE;
+}
+
 /*
  * void amiga_init_IRQ(void)
  *
@@ -72,12 +103,23 @@ static struct irq_controller amiga_irq_controller = {
 
 void __init amiga_init_IRQ(void)
 {
-       request_irq(IRQ_AUTO_1, ami_int1, 0, "int1", NULL);
-       request_irq(IRQ_AUTO_3, ami_int3, 0, "int3", NULL);
-       request_irq(IRQ_AUTO_4, ami_int4, 0, "int4", NULL);
-       request_irq(IRQ_AUTO_5, ami_int5, 0, "int5", NULL);
+       int i;
 
-       m68k_setup_irq_controller(&amiga_irq_controller, IRQ_USER, AMI_STD_IRQS);
+       /* initialize handlers */
+       for (i = 0; i < AMI_STD_IRQS; i++) {
+               if (ami_servers[i]) {
+                       ami_irq_list[i] = NULL;
+               } else {
+                       ami_irq_list[i] = new_irq_node();
+                       ami_irq_list[i]->handler = ami_badint;
+                       ami_irq_list[i]->flags   = 0;
+                       ami_irq_list[i]->dev_id  = NULL;
+                       ami_irq_list[i]->devname = NULL;
+                       ami_irq_list[i]->next    = NULL;
+               }
+       }
+       for (i = 0; i < AMI_IRQS; i++)
+               ami_ablecount[i] = 0;
 
        /* turn off PCMCIA interrupts */
        if (AMIGAHW_PRESENT(PCMCIA))
@@ -92,21 +134,249 @@ void __init amiga_init_IRQ(void)
        cia_init_IRQ(&ciab_base);
 }
 
+static inline int amiga_insert_irq(irq_node_t **list, irq_node_t *node)
+{
+       unsigned long flags;
+       irq_node_t *cur;
+
+       if (!node->dev_id)
+               printk("%s: Warning: dev_id of %s is zero\n",
+                      __FUNCTION__, node->devname);
+
+       local_irq_save(flags);
+
+       cur = *list;
+
+       if (node->flags & SA_INTERRUPT) {
+               if (node->flags & SA_SHIRQ)
+                       return -EBUSY;
+               /*
+                * There should never be more than one
+                */
+               while (cur && cur->flags & SA_INTERRUPT) {
+                       list = &cur->next;
+                       cur = cur->next;
+               }
+       } else {
+               while (cur) {
+                       list = &cur->next;
+                       cur = cur->next;
+               }
+       }
+
+       node->next = cur;
+       *list = node;
+
+       local_irq_restore(flags);
+       return 0;
+}
+
+static inline void amiga_delete_irq(irq_node_t **list, void *dev_id)
+{
+       unsigned long flags;
+       irq_node_t *node;
+
+       local_irq_save(flags);
+
+       for (node = *list; node; list = &node->next, node = *list) {
+               if (node->dev_id == dev_id) {
+                       *list = node->next;
+                       /* Mark it as free. */
+                       node->handler = NULL;
+                       local_irq_restore(flags);
+                       return;
+               }
+       }
+       local_irq_restore(flags);
+       printk ("%s: tried to remove invalid irq\n", __FUNCTION__);
+}
+
+/*
+ * amiga_request_irq : add an interrupt service routine for a particular
+ *                     machine specific interrupt source.
+ *                     If the addition was successful, it returns 0.
+ */
+
+int amiga_request_irq(unsigned int irq,
+                     irqreturn_t (*handler)(int, void *, struct pt_regs *),
+                      unsigned long flags, const char *devname, void *dev_id)
+{
+       irq_node_t *node;
+       int error = 0;
+
+       if (irq >= AMI_IRQS) {
+               printk ("%s: Unknown IRQ %d from %s\n", __FUNCTION__,
+                       irq, devname);
+               return -ENXIO;
+       }
+
+       if (irq >= IRQ_AMIGA_AUTO)
+               return cpu_request_irq(irq - IRQ_AMIGA_AUTO, handler,
+                                      flags, devname, dev_id);
+
+       if (irq >= IRQ_AMIGA_CIAB)
+               return cia_request_irq(&ciab_base, irq - IRQ_AMIGA_CIAB,
+                                      handler, flags, devname, dev_id);
+
+       if (irq >= IRQ_AMIGA_CIAA)
+               return cia_request_irq(&ciaa_base, irq - IRQ_AMIGA_CIAA,
+                                      handler, flags, devname, dev_id);
+
+       /*
+        * IRQ_AMIGA_PORTS & IRQ_AMIGA_EXTER defaults to shared,
+        * we could add a check here for the SA_SHIRQ flag but all drivers
+        * should be aware of sharing anyway.
+        */
+       if (ami_servers[irq]) {
+               if (!(node = new_irq_node()))
+                       return -ENOMEM;
+               node->handler = handler;
+               node->flags   = flags;
+               node->dev_id  = dev_id;
+               node->devname = devname;
+               node->next    = NULL;
+               error = amiga_insert_irq(&ami_irq_list[irq], node);
+       } else {
+               ami_irq_list[irq]->handler = handler;
+               ami_irq_list[irq]->flags   = flags;
+               ami_irq_list[irq]->dev_id  = dev_id;
+               ami_irq_list[irq]->devname = devname;
+       }
+
+       /* enable the interrupt */
+       if (irq < IRQ_AMIGA_PORTS && !ami_ablecount[irq])
+               amiga_custom.intena = IF_SETCLR | amiga_intena_vals[irq];
+
+       return error;
+}
+
+void amiga_free_irq(unsigned int irq, void *dev_id)
+{
+       if (irq >= AMI_IRQS) {
+               printk ("%s: Unknown IRQ %d\n", __FUNCTION__, irq);
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_AUTO)
+               cpu_free_irq(irq - IRQ_AMIGA_AUTO, dev_id);
+
+       if (irq >= IRQ_AMIGA_CIAB) {
+               cia_free_irq(&ciab_base, irq - IRQ_AMIGA_CIAB, dev_id);
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_CIAA) {
+               cia_free_irq(&ciaa_base, irq - IRQ_AMIGA_CIAA, dev_id);
+               return;
+       }
+
+       if (ami_servers[irq]) {
+               amiga_delete_irq(&ami_irq_list[irq], dev_id);
+               /* if server list empty, disable the interrupt */
+               if (!ami_irq_list[irq] && irq < IRQ_AMIGA_PORTS)
+                       amiga_custom.intena = amiga_intena_vals[irq];
+       } else {
+               if (ami_irq_list[irq]->dev_id != dev_id)
+                       printk("%s: removing probably wrong IRQ %d from %s\n",
+                              __FUNCTION__, irq, ami_irq_list[irq]->devname);
+               ami_irq_list[irq]->handler = ami_badint;
+               ami_irq_list[irq]->flags   = 0;
+               ami_irq_list[irq]->dev_id  = NULL;
+               ami_irq_list[irq]->devname = NULL;
+               amiga_custom.intena = amiga_intena_vals[irq];
+       }
+}
+
 /*
  * Enable/disable a particular machine specific interrupt source.
  * Note that this may affect other interrupts in case of a shared interrupt.
  * This function should only be called for a _very_ short time to change some
  * internal data, that may not be changed by the interrupt at the same time.
+ * ami_(enable|disable)_irq calls may also be nested.
  */
 
-static void amiga_enable_irq(unsigned int irq)
+void amiga_enable_irq(unsigned int irq)
+{
+       if (irq >= AMI_IRQS) {
+               printk("%s: Unknown IRQ %d\n", __FUNCTION__, irq);
+               return;
+       }
+
+       if (--ami_ablecount[irq])
+               return;
+
+       /* No action for auto-vector interrupts */
+       if (irq >= IRQ_AMIGA_AUTO){
+               printk("%s: Trying to enable auto-vector IRQ %i\n",
+                      __FUNCTION__, irq - IRQ_AMIGA_AUTO);
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_CIAB) {
+               cia_set_irq(&ciab_base, (1 << (irq - IRQ_AMIGA_CIAB)));
+               cia_able_irq(&ciab_base, CIA_ICR_SETCLR |
+                            (1 << (irq - IRQ_AMIGA_CIAB)));
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_CIAA) {
+               cia_set_irq(&ciaa_base, (1 << (irq - IRQ_AMIGA_CIAA)));
+               cia_able_irq(&ciaa_base, CIA_ICR_SETCLR |
+                            (1 << (irq - IRQ_AMIGA_CIAA)));
+               return;
+       }
+
+       /* enable the interrupt */
+       amiga_custom.intena = IF_SETCLR | amiga_intena_vals[irq];
+}
+
+void amiga_disable_irq(unsigned int irq)
+{
+       if (irq >= AMI_IRQS) {
+               printk("%s: Unknown IRQ %d\n", __FUNCTION__, irq);
+               return;
+       }
+
+       if (ami_ablecount[irq]++)
+               return;
+
+       /* No action for auto-vector interrupts */
+       if (irq >= IRQ_AMIGA_AUTO) {
+               printk("%s: Trying to disable auto-vector IRQ %i\n",
+                      __FUNCTION__, irq - IRQ_AMIGA_AUTO);
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_CIAB) {
+               cia_able_irq(&ciab_base, 1 << (irq - IRQ_AMIGA_CIAB));
+               return;
+       }
+
+       if (irq >= IRQ_AMIGA_CIAA) {
+               cia_able_irq(&ciaa_base, 1 << (irq - IRQ_AMIGA_CIAA));
+               return;
+       }
+
+       /* disable the interrupt */
+       amiga_custom.intena = amiga_intena_vals[irq];
+}
+
+inline void amiga_do_irq(int irq, struct pt_regs *fp)
 {
-       amiga_custom.intena = IF_SETCLR | (1 << (irq - IRQ_USER));
+       kstat_cpu(0).irqs[SYS_IRQS + irq]++;
+       ami_irq_list[irq]->handler(irq, ami_irq_list[irq]->dev_id, fp);
 }
 
-static void amiga_disable_irq(unsigned int irq)
+void amiga_do_irq_list(int irq, struct pt_regs *fp)
 {
-       amiga_custom.intena = 1 << (irq - IRQ_USER);
+       irq_node_t *node;
+
+       kstat_cpu(0).irqs[SYS_IRQS + irq]++;
+
+       amiga_custom.intreq = amiga_intena_vals[irq];
+
+       for (node = ami_irq_list[irq]; node; node = node->next)
+               node->handler(irq, node->dev_id, fp);
 }
 
 /*
@@ -120,19 +390,19 @@ static irqreturn_t ami_int1(int irq, void *dev_id, struct pt_regs *fp)
        /* if serial transmit buffer empty, interrupt */
        if (ints & IF_TBE) {
                amiga_custom.intreq = IF_TBE;
-               m68k_handle_int(IRQ_AMIGA_TBE, fp);
+               amiga_do_irq(IRQ_AMIGA_TBE, fp);
        }
 
        /* if floppy disk transfer complete, interrupt */
        if (ints & IF_DSKBLK) {
                amiga_custom.intreq = IF_DSKBLK;
-               m68k_handle_int(IRQ_AMIGA_DSKBLK, fp);
+               amiga_do_irq(IRQ_AMIGA_DSKBLK, fp);
        }
 
        /* if software interrupt set, interrupt */
        if (ints & IF_SOFT) {
                amiga_custom.intreq = IF_SOFT;
-               m68k_handle_int(IRQ_AMIGA_SOFT, fp);
+               amiga_do_irq(IRQ_AMIGA_SOFT, fp);
        }
        return IRQ_HANDLED;
 }
@@ -144,20 +414,18 @@ static irqreturn_t ami_int3(int irq, void *dev_id, struct pt_regs *fp)
        /* if a blitter interrupt */
        if (ints & IF_BLIT) {
                amiga_custom.intreq = IF_BLIT;
-               m68k_handle_int(IRQ_AMIGA_BLIT, fp);
+               amiga_do_irq(IRQ_AMIGA_BLIT, fp);
        }
 
        /* if a copper interrupt */
        if (ints & IF_COPER) {
                amiga_custom.intreq = IF_COPER;
-               m68k_handle_int(IRQ_AMIGA_COPPER, fp);
+               amiga_do_irq(IRQ_AMIGA_COPPER, fp);
        }
 
        /* if a vertical blank interrupt */
-       if (ints & IF_VERTB) {
-               amiga_custom.intreq = IF_VERTB;
-               m68k_handle_int(IRQ_AMIGA_VERTB, fp);
-       }
+       if (ints & IF_VERTB)
+               amiga_do_irq_list(IRQ_AMIGA_VERTB, fp);
        return IRQ_HANDLED;
 }
 
@@ -168,25 +436,25 @@ static irqreturn_t ami_int4(int irq, void *dev_id, struct pt_regs *fp)
        /* if audio 0 interrupt */
        if (ints & IF_AUD0) {
                amiga_custom.intreq = IF_AUD0;
-               m68k_handle_int(IRQ_AMIGA_AUD0, fp);
+               amiga_do_irq(IRQ_AMIGA_AUD0, fp);
        }
 
        /* if audio 1 interrupt */
        if (ints & IF_AUD1) {
                amiga_custom.intreq = IF_AUD1;
-               m68k_handle_int(IRQ_AMIGA_AUD1, fp);
+               amiga_do_irq(IRQ_AMIGA_AUD1, fp);
        }
 
        /* if audio 2 interrupt */
        if (ints & IF_AUD2) {
                amiga_custom.intreq = IF_AUD2;
-               m68k_handle_int(IRQ_AMIGA_AUD2, fp);
+               amiga_do_irq(IRQ_AMIGA_AUD2, fp);
        }
 
        /* if audio 3 interrupt */
        if (ints & IF_AUD3) {
                amiga_custom.intreq = IF_AUD3;
-               m68k_handle_int(IRQ_AMIGA_AUD3, fp);
+               amiga_do_irq(IRQ_AMIGA_AUD3, fp);
        }
        return IRQ_HANDLED;
 }
@@ -198,13 +466,55 @@ static irqreturn_t ami_int5(int irq, void *dev_id, struct pt_regs *fp)
        /* if serial receive buffer full interrupt */
        if (ints & IF_RBF) {
                /* acknowledge of IF_RBF must be done by the serial interrupt */
-               m68k_handle_int(IRQ_AMIGA_RBF, fp);
+               amiga_do_irq(IRQ_AMIGA_RBF, fp);
        }
 
        /* if a disk sync interrupt */
        if (ints & IF_DSKSYN) {
                amiga_custom.intreq = IF_DSKSYN;
-               m68k_handle_int(IRQ_AMIGA_DSKSYN, fp);
+               amiga_do_irq(IRQ_AMIGA_DSKSYN, fp);
        }
        return IRQ_HANDLED;
 }
+
+static irqreturn_t ami_int7(int irq, void *dev_id, struct pt_regs *fp)
+{
+       panic ("level 7 interrupt received\n");
+}
+
+irqreturn_t (*amiga_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
+       [0] = ami_badint,
+       [1] = ami_int1,
+       [2] = ami_badint,
+       [3] = ami_int3,
+       [4] = ami_int4,
+       [5] = ami_int5,
+       [6] = ami_badint,
+       [7] = ami_int7
+};
+
+int show_amiga_interrupts(struct seq_file *p, void *v)
+{
+       int i;
+       irq_node_t *node;
+
+       for (i = 0; i < AMI_STD_IRQS; i++) {
+               if (!(node = ami_irq_list[i]))
+                       continue;
+               seq_printf(p, "ami  %2d: %10u ", i,
+                              kstat_cpu(0).irqs[SYS_IRQS + i]);
+               do {
+                       if (node->flags & SA_INTERRUPT)
+                               seq_puts(p, "F ");
+                       else
+                               seq_puts(p, "  ");
+                       seq_printf(p, "%s\n", node->devname);
+                       if ((node = node->next))
+                               seq_puts(p, "                    ");
+               } while (node);
+       }
+
+       cia_get_irq_list(&ciaa_base, p);
+       cia_get_irq_list(&ciab_base, p);
+       return 0;
+}