blob: 26e88cb519bc6f0ca797bd16bfeb87aceddd2448 [file] [log] [blame]
wdenk12490652004-04-18 21:13:41 +00001/*
Michal Simek922ce202007-03-11 13:48:24 +01002 * (C) Copyright 2007 Michal Simek
wdenk12490652004-04-18 21:13:41 +00003 * (C) Copyright 2004 Atmark Techno, Inc.
4 *
Michal Simek922ce202007-03-11 13:48:24 +01005 * Michal SIMEK <monstr@monstr.eu>
wdenk12490652004-04-18 21:13:41 +00006 * 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
Michal Simek922ce202007-03-11 13:48:24 +010018 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
wdenk12490652004-04-18 21:13:41 +000019 * 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
Michal Simek922ce202007-03-11 13:48:24 +010027#include <common.h>
28#include <command.h>
29#include <asm/microblaze_intc.h>
Michal Simek77a1e242007-05-07 17:22:25 +020030#include <asm/asm.h>
Michal Simek922ce202007-03-11 13:48:24 +010031
32#undef DEBUG_INT
33
34extern void microblaze_disable_interrupts (void);
35extern void microblaze_enable_interrupts (void);
36
37void enable_interrupts (void)
wdenk12490652004-04-18 21:13:41 +000038{
Michal Simek98c19792007-05-07 23:58:31 +020039 MSRSET(0x2);
wdenk12490652004-04-18 21:13:41 +000040}
41
Michal Simek922ce202007-03-11 13:48:24 +010042int disable_interrupts (void)
wdenk12490652004-04-18 21:13:41 +000043{
Michal Simek98c19792007-05-07 23:58:31 +020044 MSRCLR(0x2);
wdenk12490652004-04-18 21:13:41 +000045 return 0;
46}
Michal Simek922ce202007-03-11 13:48:24 +010047
48#ifdef CFG_INTC_0
49#ifdef CFG_TIMER_0
50extern void timer_init (void);
51#endif
Michal Simekb5daff52007-05-07 19:12:43 +020052#ifdef CFG_FSL_2
53extern void fsl_init2 (void);
54#endif
55
Michal Simek922ce202007-03-11 13:48:24 +010056
57static struct irq_action vecs[CFG_INTC_0_NUM];
58
59/* mapping structure to interrupt controller */
60microblaze_intc_t *intc = (microblaze_intc_t *) (CFG_INTC_0_ADDR);
61
62/* default handler */
63void def_hdlr (void)
64{
65 puts ("def_hdlr\n");
66}
67
68void enable_one_interrupt (int irq)
69{
70 int mask;
71 int offset = 1;
72 offset <<= irq;
73 mask = intc->ier;
74 intc->ier = (mask | offset);
75#ifdef DEBUG_INT
76 printf ("Enable one interrupt irq %x - mask %x,ier %x\n", offset, mask,
77 intc->ier);
78 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
79 intc->iar, intc->mer);
80#endif
81}
82
83void disable_one_interrupt (int irq)
84{
85 int mask;
86 int offset = 1;
87 offset <<= irq;
88 mask = intc->ier;
89 intc->ier = (mask & ~offset);
90#ifdef DEBUG_INT
91 printf ("Disable one interrupt irq %x - mask %x,ier %x\n", irq, mask,
92 intc->ier);
93 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
94 intc->iar, intc->mer);
95#endif
96}
97
98/* adding new handler for interrupt */
99void install_interrupt_handler (int irq, interrupt_handler_t * hdlr, void *arg)
100{
101 struct irq_action *act;
102 /* irq out of range */
Michal Simek1f0c40c2007-03-26 01:39:07 +0200103 if ((irq < 0) || (irq > CFG_INTC_0_NUM)) {
Michal Simek922ce202007-03-11 13:48:24 +0100104 puts ("IRQ out of range\n");
105 return;
106 }
107 act = &vecs[irq];
108 if (hdlr) { /* enable */
109 act->handler = hdlr;
110 act->arg = arg;
111 act->count = 0;
112 enable_one_interrupt (irq);
113 } else { /* disable */
Michal Simek922ce202007-03-11 13:48:24 +0100114 act->handler = (interrupt_handler_t *) def_hdlr;
115 act->arg = (void *)irq;
116 disable_one_interrupt (irq);
117 }
118}
119
120/* initialization interrupt controller - hardware */
121void intc_init (void)
122{
123 intc->mer = 0;
124 intc->ier = 0;
125 intc->iar = 0xFFFFFFFF;
126 /* XIntc_Start - hw_interrupt enable and all interrupt enable */
127 intc->mer = 0x3;
128#ifdef DEBUG_INT
129 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
130 intc->iar, intc->mer);
131#endif
132}
133
134int interrupts_init (void)
135{
136 int i;
137 /* initialize irq list */
Michal Simek1f0c40c2007-03-26 01:39:07 +0200138 for (i = 0; i < CFG_INTC_0_NUM; i++) {
Michal Simek922ce202007-03-11 13:48:24 +0100139 vecs[i].handler = (interrupt_handler_t *) def_hdlr;
140 vecs[i].arg = (void *)i;
141 vecs[i].count = 0;
142 }
143 /* initialize intc controller */
144 intc_init ();
145#ifdef CFG_TIMER_0
146 timer_init ();
147#endif
Michal Simekb5daff52007-05-07 19:12:43 +0200148#ifdef CFG_FSL_2
149 fsl_init2 ();
150#endif
Michal Simek922ce202007-03-11 13:48:24 +0100151 enable_interrupts ();
152 return 0;
153}
154
155void interrupt_handler (void)
156{
Michal Simek77a1e242007-05-07 17:22:25 +0200157 int irqs = (intc->isr & intc->ier); /* find active interrupt */
158 int i = 1;
Michal Simek922ce202007-03-11 13:48:24 +0100159#ifdef DEBUG_INT
Michal Simek77a1e242007-05-07 17:22:25 +0200160 int value;
Michal Simek922ce202007-03-11 13:48:24 +0100161 printf ("INTC isr %x, ier %x, iar %x, mer %x\n", intc->isr, intc->ier,
162 intc->iar, intc->mer);
Michal Simek77a1e242007-05-07 17:22:25 +0200163 R14(value);
Michal Simek922ce202007-03-11 13:48:24 +0100164 printf ("Interrupt handler on %x line, r14 %x\n", irqs, value);
165#endif
166 struct irq_action *act = vecs;
167 while (irqs) {
168 if (irqs & 1) {
169#ifdef DEBUG_INT
170 printf
171 ("Jumping to interrupt handler rutine addr %x,count %x,arg %x\n",
172 act->handler, act->count, act->arg);
173#endif
174 act->handler (act->arg);
175 act->count++;
Michal Simek77a1e242007-05-07 17:22:25 +0200176 intc->iar = i;
177 return;
Michal Simek922ce202007-03-11 13:48:24 +0100178 }
179 irqs >>= 1;
180 act++;
Michal Simek77a1e242007-05-07 17:22:25 +0200181 i <<= 1;
Michal Simek922ce202007-03-11 13:48:24 +0100182 }
Michal Simek77a1e242007-05-07 17:22:25 +0200183
184#ifdef DEBUG_INT
Michal Simek922ce202007-03-11 13:48:24 +0100185 printf ("Dump INTC reg, isr %x, ier %x, iar %x, mer %x\n", intc->isr,
186 intc->ier, intc->iar, intc->mer);
Michal Simek77a1e242007-05-07 17:22:25 +0200187 R14(value);
188 printf ("Interrupt handler on %x line, r14 %x\n", irqs, value);
Michal Simek922ce202007-03-11 13:48:24 +0100189#endif
190}
191#endif
192
Jon Loeliger526e5ce2007-07-09 19:06:00 -0500193#if defined(CONFIG_CMD_IRQ)
Michal Simek922ce202007-03-11 13:48:24 +0100194#ifdef CFG_INTC_0
195int do_irqinfo (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
196{
197 int i;
198 struct irq_action *act = vecs;
199
200 puts ("\nInterrupt-Information:\n\n"
201 "Nr Routine Arg Count\n"
202 "-----------------------------\n");
203
Michal Simek1f0c40c2007-03-26 01:39:07 +0200204 for (i = 0; i < CFG_INTC_0_NUM; i++) {
Michal Simek922ce202007-03-11 13:48:24 +0100205 if (act->handler != (interrupt_handler_t*) def_hdlr) {
Michal Simekadf146e2008-07-17 12:25:46 +0200206 printf ("%02d %08x %08x %d\n", i,
Michal Simek922ce202007-03-11 13:48:24 +0100207 (int)act->handler, (int)act->arg, act->count);
208 }
209 act++;
210 }
211 puts ("\n");
212 return (0);
213}
214#else
215int do_irqinfo (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
216{
217 puts ("Undefined interrupt controller\n");
218}
219#endif
Jon Loeliger526e5ce2007-07-09 19:06:00 -0500220#endif