1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49#include <common.h>
50#include <asm/interrupt.h>
51
52struct irq_action {
53 interrupt_handler_t *handler;
54 void *arg;
55 unsigned int count;
56};
57
58static struct irq_action irq_handlers[CONFIG_SYS_NUM_IRQS] = { {0} };
59static int spurious_irq_cnt = 0;
60static int spurious_irq = 0;
61
62void irq_install_handler(int irq, interrupt_handler_t *handler, void *arg)
63{
64 int status;
65
66 if (irq < 0 || irq >= CONFIG_SYS_NUM_IRQS) {
67 printf("irq_install_handler: bad irq number %d\n", irq);
68 return;
69 }
70
71 if (irq_handlers[irq].handler != NULL)
72 printf("irq_install_handler: 0x%08lx replacing 0x%08lx\n",
73 (ulong) handler + gd->reloc_off,
74 (ulong) irq_handlers[irq].handler);
75
76 status = disable_interrupts ();
77
78 irq_handlers[irq].handler = handler + gd->reloc_off;
79 irq_handlers[irq].arg = arg;
80 irq_handlers[irq].count = 0;
81
82 unmask_irq(irq);
83
84 if (status)
85 enable_interrupts();
86
87 return;
88}
89
90void irq_free_handler(int irq)
91{
92 int status;
93
94 if (irq < 0 || irq >= CONFIG_SYS_NUM_IRQS) {
95 printf("irq_free_handler: bad irq number %d\n", irq);
96 return;
97 }
98
99 status = disable_interrupts ();
100
101 mask_irq(irq);
102
103 irq_handlers[irq].handler = NULL;
104 irq_handlers[irq].arg = NULL;
105
106 if (status)
107 enable_interrupts();
108
109 return;
110}
111
112__isr__ do_irq(int irq)
113{
114 if (irq < 0 || irq >= CONFIG_SYS_NUM_IRQS) {
115 printf("do_irq: bad irq number %d\n", irq);
116 return;
117 }
118
119 if (irq_handlers[irq].handler) {
120 mask_irq(irq);
121
122 irq_handlers[irq].handler(irq_handlers[irq].arg);
123 irq_handlers[irq].count++;
124
125 unmask_irq(irq);
126 specific_eoi(irq);
127
128 } else {
129 if ((irq & 7) != 7) {
130 spurious_irq_cnt++;
131 spurious_irq = irq;
132 }
133 }
134}
135
136#if defined(CONFIG_CMD_IRQ)
137int do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
138{
139 int irq;
140
141 printf("Spurious IRQ: %u, last unknown IRQ: %d\n",
142 spurious_irq_cnt, spurious_irq);
143
144 printf ("Interrupt-Information:\n");
145 printf ("Nr Routine Arg Count\n");
146
147 for (irq = 0; irq <= CONFIG_SYS_NUM_IRQS; irq++) {
148 if (irq_handlers[irq].handler != NULL) {
149 printf ("%02d %08lx %08lx %d\n",
150 irq,
151 (ulong)irq_handlers[irq].handler,
152 (ulong)irq_handlers[irq].arg,
153 irq_handlers[irq].count);
154 }
155 }
156
157 return 0;
158}
159#endif
160