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 }