1 /* 2 * (C) Copyright 2007 Michal Simek 3 * (C) Copyright 2004 Atmark Techno, Inc. 4 * 5 * Michal SIMEK <monstr@monstr.eu> 6 * Yasushi SHOJI <yashi@atmark-techno.com> 7 * 8 * See file CREDITS for list of people who contributed to this 9 * project. 10 * 11 * This program is free software; you can redistribute it and/or 12 * modify it under the terms of the GNU General Public License as 13 * published by the Free Software Foundation; either version 2 of 14 * the License, or (at your option) any later version. 15 * 16 * This program is distributed in the hope that it will be useful, 17 * but WITHOUT ANY WARRANTY; without even the implied warranty of 18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 19 * GNU General Public License for more details. 20 * 21 * You should have received a copy of the GNU General Public License 22 * along with this program; if not, write to the Free Software 23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 24 * MA 02111-1307 USA 25 */ 26 27 #include <common.h> 28 #include <command.h> 29 #include <asm/microblaze_intc.h> 30 #include <asm/asm.h> 31 32 #undef DEBUG_INT 33 34 extern void microblaze_disable_interrupts (void); 35 extern void microblaze_enable_interrupts (void); 36 37 void enable_interrupts (void) 38 { 39 MSRSET(0x2); 40 } 41 42 int disable_interrupts (void) 43 { 44 MSRCLR(0x2); 45 return 0; 46 } 47 48 #ifdef CONFIG_SYS_INTC_0 49 50 static struct irq_action vecs[CONFIG_SYS_INTC_0_NUM]; 51 52 /* mapping structure to interrupt controller */ 53 microblaze_intc_t *intc = (microblaze_intc_t *) (CONFIG_SYS_INTC_0_ADDR); 54 55 /* default handler */ 56 void def_hdlr (void) 57 { 58 puts ("def_hdlr\n"); 59 } 60 61 void enable_one_interrupt (int irq) 62 { 63 int mask; 64 int offset = 1; 65 offset <<= irq; 66 mask = intc->ier; 67 intc->ier = (mask | offset); 68 #ifdef DEBUG_INT 69 printf ("Enable one interrupt irq %x - mask %x,ier %x\n", offset, mask, 70 intc->ier); 71 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier, 72 intc->iar, intc->mer); 73 #endif 74 } 75 76 void disable_one_interrupt (int irq) 77 { 78 int mask; 79 int offset = 1; 80 offset <<= irq; 81 mask = intc->ier; 82 intc->ier = (mask & ~offset); 83 #ifdef DEBUG_INT 84 printf ("Disable one interrupt irq %x - mask %x,ier %x\n", irq, mask, 85 intc->ier); 86 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier, 87 intc->iar, intc->mer); 88 #endif 89 } 90 91 /* adding new handler for interrupt */ 92 void install_interrupt_handler (int irq, interrupt_handler_t * hdlr, void *arg) 93 { 94 struct irq_action *act; 95 /* irq out of range */ 96 if ((irq < 0) || (irq > CONFIG_SYS_INTC_0_NUM)) { 97 puts ("IRQ out of range\n"); 98 return; 99 } 100 act = &vecs[irq]; 101 if (hdlr) { /* enable */ 102 act->handler = hdlr; 103 act->arg = arg; 104 act->count = 0; 105 enable_one_interrupt (irq); 106 } else { /* disable */ 107 act->handler = (interrupt_handler_t *) def_hdlr; 108 act->arg = (void *)irq; 109 disable_one_interrupt (irq); 110 } 111 } 112 113 /* initialization interrupt controller - hardware */ 114 void intc_init (void) 115 { 116 intc->mer = 0; 117 intc->ier = 0; 118 intc->iar = 0xFFFFFFFF; 119 /* XIntc_Start - hw_interrupt enable and all interrupt enable */ 120 intc->mer = 0x3; 121 #ifdef DEBUG_INT 122 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier, 123 intc->iar, intc->mer); 124 #endif 125 } 126 127 int interrupts_init (void) 128 { 129 int i; 130 /* initialize irq list */ 131 for (i = 0; i < CONFIG_SYS_INTC_0_NUM; i++) { 132 vecs[i].handler = (interrupt_handler_t *) def_hdlr; 133 vecs[i].arg = (void *)i; 134 vecs[i].count = 0; 135 } 136 /* initialize intc controller */ 137 intc_init (); 138 enable_interrupts (); 139 return 0; 140 } 141 142 void interrupt_handler (void) 143 { 144 int irqs = intc->ivr; /* find active interrupt */ 145 int mask = 1; 146 #ifdef DEBUG_INT 147 int value; 148 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier, 149 intc->iar, intc->mer); 150 R14(value); 151 printf ("Interrupt handler on %x line, r14 %x\n", irqs, value); 152 #endif 153 struct irq_action *act = vecs + irqs; 154 155 intc->iar = mask << irqs; 156 157 #ifdef DEBUG_INT 158 printf 159 ("Jumping to interrupt handler rutine addr %x,count %x,arg %x\n", 160 act->handler, act->count, act->arg); 161 #endif 162 act->handler (act->arg); 163 act->count++; 164 165 #ifdef DEBUG_INT 166 printf ("Dump INTC reg, isr %x, ier %x, iar %x, mer %x\n", intc->isr, 167 intc->ier, intc->iar, intc->mer); 168 R14(value); 169 printf ("Interrupt handler on %x line, r14 %x\n", irqs, value); 170 #endif 171 } 172 #endif 173 174 #if defined(CONFIG_CMD_IRQ) 175 #ifdef CONFIG_SYS_INTC_0 176 int do_irqinfo (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) 177 { 178 int i; 179 struct irq_action *act = vecs; 180 181 puts ("\nInterrupt-Information:\n\n" 182 "Nr Routine Arg Count\n" 183 "-----------------------------\n"); 184 185 for (i = 0; i < CONFIG_SYS_INTC_0_NUM; i++) { 186 if (act->handler != (interrupt_handler_t*) def_hdlr) { 187 printf ("%02d %08x %08x %d\n", i, 188 (int)act->handler, (int)act->arg, act->count); 189 } 190 act++; 191 } 192 puts ("\n"); 193 return (0); 194 } 195 #else 196 int do_irqinfo (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) 197 { 198 puts ("Undefined interrupt controller\n"); 199 } 200 #endif 201 #endif 202