This source file includes following definitions.
- disable_microdev_irq
- enable_microdev_irq
- make_microdev_irq
- init_microdev_irq
- microdev_print_fpga_intc_status
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 #include <linux/init.h>
  11 #include <linux/irq.h>
  12 #include <linux/interrupt.h>
  13 #include <asm/io.h>
  14 #include <mach/microdev.h>
  15 
  16 #define NUM_EXTERNAL_IRQS 16    
  17 
  18 static const struct {
  19         unsigned char fpgaIrq;
  20         unsigned char mapped;
  21         const char *name;
  22 } fpgaIrqTable[NUM_EXTERNAL_IRQS] = {
  23         { 0,                            0,      "unused"   },           
  24         { MICRODEV_FPGA_IRQ_KEYBOARD,   1,      "keyboard" },           
  25         { MICRODEV_FPGA_IRQ_SERIAL1,    1,      "Serial #1"},           
  26         { MICRODEV_FPGA_IRQ_ETHERNET,   1,      "Ethernet" },           
  27         { MICRODEV_FPGA_IRQ_SERIAL2,    0,      "Serial #2"},           
  28         { 0,                            0,      "unused"   },           
  29         { 0,                            0,      "unused"   },           
  30         { MICRODEV_FPGA_IRQ_USB_HC,     1,      "USB"      },           
  31         { MICRODEV_IRQ_PCI_INTA,        1,      "PCI INTA" },           
  32         { MICRODEV_IRQ_PCI_INTB,        1,      "PCI INTB" },           
  33         { MICRODEV_IRQ_PCI_INTC,        1,      "PCI INTC" },           
  34         { MICRODEV_IRQ_PCI_INTD,        1,      "PCI INTD" },           
  35         { MICRODEV_FPGA_IRQ_MOUSE,      1,      "mouse"    },           
  36         { MICRODEV_FPGA_IRQ_IDE2,       1,      "IDE #2"   },           
  37         { MICRODEV_FPGA_IRQ_IDE1,       1,      "IDE #1"   },           
  38         { 0,                            0,      "unused"   },           
  39 };
  40 
  41 #if (MICRODEV_LINUX_IRQ_KEYBOARD != 1)
  42 #  error Inconsistancy in defining the IRQ# for Keyboard!
  43 #endif
  44 
  45 #if (MICRODEV_LINUX_IRQ_ETHERNET != 3)
  46 #  error Inconsistancy in defining the IRQ# for Ethernet!
  47 #endif
  48 
  49 #if (MICRODEV_LINUX_IRQ_USB_HC != 7)
  50 #  error Inconsistancy in defining the IRQ# for USB!
  51 #endif
  52 
  53 #if (MICRODEV_LINUX_IRQ_MOUSE != 12)
  54 #  error Inconsistancy in defining the IRQ# for PS/2 Mouse!
  55 #endif
  56 
  57 #if (MICRODEV_LINUX_IRQ_IDE2 != 13)
  58 #  error Inconsistancy in defining the IRQ# for secondary IDE!
  59 #endif
  60 
  61 #if (MICRODEV_LINUX_IRQ_IDE1 != 14)
  62 #  error Inconsistancy in defining the IRQ# for primary IDE!
  63 #endif
  64 
  65 static void disable_microdev_irq(struct irq_data *data)
  66 {
  67         unsigned int irq = data->irq;
  68         unsigned int fpgaIrq;
  69 
  70         if (irq >= NUM_EXTERNAL_IRQS)
  71                 return;
  72         if (!fpgaIrqTable[irq].mapped)
  73                 return;
  74 
  75         fpgaIrq = fpgaIrqTable[irq].fpgaIrq;
  76 
  77         
  78         __raw_writel(MICRODEV_FPGA_INTC_MASK(fpgaIrq), MICRODEV_FPGA_INTDSB_REG);
  79 }
  80 
  81 static void enable_microdev_irq(struct irq_data *data)
  82 {
  83         unsigned int irq = data->irq;
  84         unsigned long priorityReg, priorities, pri;
  85         unsigned int fpgaIrq;
  86 
  87         if (unlikely(irq >= NUM_EXTERNAL_IRQS))
  88                 return;
  89         if (unlikely(!fpgaIrqTable[irq].mapped))
  90                 return;
  91 
  92         pri = 15 - irq;
  93 
  94         fpgaIrq = fpgaIrqTable[irq].fpgaIrq;
  95         priorityReg = MICRODEV_FPGA_INTPRI_REG(fpgaIrq);
  96 
  97         
  98         priorities = __raw_readl(priorityReg);
  99         priorities &= ~MICRODEV_FPGA_INTPRI_MASK(fpgaIrq);
 100         priorities |= MICRODEV_FPGA_INTPRI_LEVEL(fpgaIrq, pri);
 101         __raw_writel(priorities, priorityReg);
 102 
 103         
 104         __raw_writel(MICRODEV_FPGA_INTC_MASK(fpgaIrq), MICRODEV_FPGA_INTENB_REG);
 105 }
 106 
 107 static struct irq_chip microdev_irq_type = {
 108         .name = "MicroDev-IRQ",
 109         .irq_unmask = enable_microdev_irq,
 110         .irq_mask = disable_microdev_irq,
 111 };
 112 
 113 
 114 static void __init make_microdev_irq(unsigned int irq)
 115 {
 116         disable_irq_nosync(irq);
 117         irq_set_chip_and_handler(irq, µdev_irq_type, handle_level_irq);
 118         disable_microdev_irq(irq_get_irq_data(irq));
 119 }
 120 
 121 extern void __init init_microdev_irq(void)
 122 {
 123         int i;
 124 
 125         
 126         __raw_writel(~0ul, MICRODEV_FPGA_INTDSB_REG);
 127 
 128         for (i = 0; i < NUM_EXTERNAL_IRQS; i++)
 129                 make_microdev_irq(i);
 130 }
 131 
 132 extern void microdev_print_fpga_intc_status(void)
 133 {
 134         volatile unsigned int * const intenb = (unsigned int*)MICRODEV_FPGA_INTENB_REG;
 135         volatile unsigned int * const intdsb = (unsigned int*)MICRODEV_FPGA_INTDSB_REG;
 136         volatile unsigned int * const intpria = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(0);
 137         volatile unsigned int * const intprib = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(8);
 138         volatile unsigned int * const intpric = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(16);
 139         volatile unsigned int * const intprid = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(24);
 140         volatile unsigned int * const intsrc = (unsigned int*)MICRODEV_FPGA_INTSRC_REG;
 141         volatile unsigned int * const intreq = (unsigned int*)MICRODEV_FPGA_INTREQ_REG;
 142 
 143         printk("-------------------------- microdev_print_fpga_intc_status() ------------------\n");
 144         printk("FPGA_INTENB = 0x%08x\n", *intenb);
 145         printk("FPGA_INTDSB = 0x%08x\n", *intdsb);
 146         printk("FPGA_INTSRC = 0x%08x\n", *intsrc);
 147         printk("FPGA_INTREQ = 0x%08x\n", *intreq);
 148         printk("FPGA_INTPRI[3..0] = %08x:%08x:%08x:%08x\n", *intprid, *intpric, *intprib, *intpria);
 149         printk("-------------------------------------------------------------------------------\n");
 150 }