1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <command.h>
12#include <fdtdec.h>
13#include <irq_func.h>
14#include <log.h>
15#include <malloc.h>
16#include <asm/microblaze_intc.h>
17#include <asm/asm.h>
18
19DECLARE_GLOBAL_DATA_PTR;
20
21void enable_interrupts(void)
22{
23 debug("Enable interrupts for the whole CPU\n");
24 MSRSET(0x2);
25}
26
27int disable_interrupts(void)
28{
29 unsigned int msr;
30
31 MFS(msr, rmsr);
32 MSRCLR(0x2);
33 return (msr & 0x2) != 0;
34}
35
36static struct irq_action *vecs;
37static u32 irq_no;
38
39
40microblaze_intc_t *intc;
41
42
43static void def_hdlr(void)
44{
45 puts("def_hdlr\n");
46}
47
48static void enable_one_interrupt(int irq)
49{
50 int mask;
51 int offset = 1;
52
53 offset <<= irq;
54 mask = intc->ier;
55 intc->ier = (mask | offset);
56
57 debug("Enable one interrupt irq %x - mask %x,ier %x\n", offset, mask,
58 intc->ier);
59 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
60 intc->iar, intc->mer);
61}
62
63static void disable_one_interrupt(int irq)
64{
65 int mask;
66 int offset = 1;
67
68 offset <<= irq;
69 mask = intc->ier;
70 intc->ier = (mask & ~offset);
71
72 debug("Disable one interrupt irq %x - mask %x,ier %x\n", irq, mask,
73 intc->ier);
74 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
75 intc->iar, intc->mer);
76}
77
78int install_interrupt_handler(int irq, interrupt_handler_t *hdlr, void *arg)
79{
80 struct irq_action *act;
81
82
83 if ((irq < 0) || (irq > irq_no)) {
84 puts("IRQ out of range\n");
85 return -1;
86 }
87 act = &vecs[irq];
88 if (hdlr) {
89 act->handler = hdlr;
90 act->arg = arg;
91 act->count = 0;
92 enable_one_interrupt(irq);
93 return 0;
94 }
95
96
97 act->handler = (interrupt_handler_t *)def_hdlr;
98 act->arg = (void *)irq;
99 disable_one_interrupt(irq);
100 return 1;
101}
102
103
104static void intc_init(void)
105{
106 intc->mer = 0;
107 intc->ier = 0;
108 intc->iar = 0xFFFFFFFF;
109
110 intc->mer = 0x3;
111
112 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
113 intc->iar, intc->mer);
114}
115
116int interrupt_init(void)
117{
118 int i;
119 const void *blob = gd->fdt_blob;
120 int node = 0;
121
122 debug("INTC: Initialization\n");
123
124 node = fdt_node_offset_by_compatible(blob, node,
125 "xlnx,xps-intc-1.00.a");
126 if (node != -1) {
127 fdt_addr_t base = fdtdec_get_addr(blob, node, "reg");
128 if (base == FDT_ADDR_T_NONE)
129 return -1;
130
131 debug("INTC: Base addr %lx\n", base);
132 intc = (microblaze_intc_t *)base;
133 irq_no = fdtdec_get_int(blob, node, "xlnx,num-intr-inputs", 0);
134 debug("INTC: IRQ NO %x\n", irq_no);
135 } else {
136 return node;
137 }
138
139 if (irq_no) {
140 vecs = calloc(1, sizeof(struct irq_action) * irq_no);
141 if (vecs == NULL) {
142 puts("Interrupt vector allocation failed\n");
143 return -1;
144 }
145
146
147 for (i = 0; i < irq_no; i++) {
148 vecs[i].handler = (interrupt_handler_t *)def_hdlr;
149 vecs[i].arg = (void *)i;
150 vecs[i].count = 0;
151 }
152
153 intc_init();
154 enable_interrupts();
155 } else {
156 puts("Undefined interrupt controller\n");
157 }
158 return 0;
159}
160
161void interrupt_handler(void)
162{
163 int irqs = intc->ivr;
164 int mask = 1;
165 int value;
166 struct irq_action *act = vecs + irqs;
167
168 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
169 intc->iar, intc->mer);
170#ifdef DEBUG
171 R14(value);
172#endif
173 debug("Interrupt handler on %x line, r14 %x\n", irqs, value);
174
175 debug("Jumping to interrupt handler rutine addr %x,count %x,arg %x\n",
176 (u32)act->handler, act->count, (u32)act->arg);
177 act->handler(act->arg);
178 act->count++;
179
180 intc->iar = mask << irqs;
181
182 debug("Dump INTC reg, isr %x, ier %x, iar %x, mer %x\n", intc->isr,
183 intc->ier, intc->iar, intc->mer);
184#ifdef DEBUG
185 R14(value);
186#endif
187 debug("Interrupt handler on %x line, r14 %x\n", irqs, value);
188}
189
190#if defined(CONFIG_CMD_IRQ)
191int do_irqinfo(struct cmd_tbl *cmdtp, int flag, int argc, const char *argv[])
192{
193 int i;
194 struct irq_action *act = vecs;
195
196 if (irq_no) {
197 puts("\nInterrupt-Information:\n\n"
198 "Nr Routine Arg Count\n"
199 "-----------------------------\n");
200
201 for (i = 0; i < irq_no; i++) {
202 if (act->handler != (interrupt_handler_t *)def_hdlr) {
203 printf("%02d %08x %08x %d\n", i,
204 (int)act->handler, (int)act->arg,
205 act->count);
206 }
207 act++;
208 }
209 puts("\n");
210 } else {
211 puts("Undefined interrupt controller\n");
212 }
213 return 0;
214}
215#endif
216