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