1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2007 Michal Simek
4 * (C) Copyright 2004 Atmark Techno, Inc.
6 * Michal SIMEK <monstr@monstr.eu>
7 * Yasushi SHOJI <yashi@atmark-techno.com>
14 #include <asm/microblaze_intc.h>
17 DECLARE_GLOBAL_DATA_PTR;
19 void enable_interrupts(void)
21 debug("Enable interrupts for the whole CPU\n");
25 int disable_interrupts(void)
31 return (msr & 0x2) != 0;
34 static struct irq_action *vecs;
37 /* mapping structure to interrupt controller */
38 microblaze_intc_t *intc;
41 static void def_hdlr(void)
46 static void enable_one_interrupt(int irq)
53 intc->ier = (mask | offset);
55 debug("Enable one interrupt irq %x - mask %x,ier %x\n", offset, mask,
57 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
58 intc->iar, intc->mer);
61 static void disable_one_interrupt(int irq)
68 intc->ier = (mask & ~offset);
70 debug("Disable one interrupt irq %x - mask %x,ier %x\n", irq, mask,
72 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
73 intc->iar, intc->mer);
76 int install_interrupt_handler(int irq, interrupt_handler_t *hdlr, void *arg)
78 struct irq_action *act;
80 /* irq out of range */
81 if ((irq < 0) || (irq > irq_no)) {
82 puts("IRQ out of range\n");
86 if (hdlr) { /* enable */
90 enable_one_interrupt(irq);
95 act->handler = (interrupt_handler_t *)def_hdlr;
96 act->arg = (void *)irq;
97 disable_one_interrupt(irq);
101 /* initialization interrupt controller - hardware */
102 static void intc_init(void)
106 intc->iar = 0xFFFFFFFF;
107 /* XIntc_Start - hw_interrupt enable and all interrupt enable */
110 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
111 intc->iar, intc->mer);
114 int interrupt_init(void)
117 const void *blob = gd->fdt_blob;
120 debug("INTC: Initialization\n");
122 node = fdt_node_offset_by_compatible(blob, node,
123 "xlnx,xps-intc-1.00.a");
125 fdt_addr_t base = fdtdec_get_addr(blob, node, "reg");
126 if (base == FDT_ADDR_T_NONE)
129 debug("INTC: Base addr %lx\n", base);
130 intc = (microblaze_intc_t *)base;
131 irq_no = fdtdec_get_int(blob, node, "xlnx,num-intr-inputs", 0);
132 debug("INTC: IRQ NO %x\n", irq_no);
138 vecs = calloc(1, sizeof(struct irq_action) * irq_no);
140 puts("Interrupt vector allocation failed\n");
144 /* initialize irq list */
145 for (i = 0; i < irq_no; i++) {
146 vecs[i].handler = (interrupt_handler_t *)def_hdlr;
147 vecs[i].arg = (void *)i;
150 /* initialize intc controller */
154 puts("Undefined interrupt controller\n");
159 void interrupt_handler(void)
161 int irqs = intc->ivr; /* find active interrupt */
164 struct irq_action *act = vecs + irqs;
166 debug("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
167 intc->iar, intc->mer);
171 debug("Interrupt handler on %x line, r14 %x\n", irqs, value);
173 debug("Jumping to interrupt handler rutine addr %x,count %x,arg %x\n",
174 (u32)act->handler, act->count, (u32)act->arg);
175 act->handler(act->arg);
178 intc->iar = mask << irqs;
180 debug("Dump INTC reg, isr %x, ier %x, iar %x, mer %x\n", intc->isr,
181 intc->ier, intc->iar, intc->mer);
185 debug("Interrupt handler on %x line, r14 %x\n", irqs, value);
188 #if defined(CONFIG_CMD_IRQ)
189 int do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, const char *argv[])
192 struct irq_action *act = vecs;
195 puts("\nInterrupt-Information:\n\n"
196 "Nr Routine Arg Count\n"
197 "-----------------------------\n");
199 for (i = 0; i < irq_no; i++) {
200 if (act->handler != (interrupt_handler_t *)def_hdlr) {
201 printf("%02d %08x %08x %d\n", i,
202 (int)act->handler, (int)act->arg,
209 puts("Undefined interrupt controller\n");