@ -1,6 +1,8 @@
/*
/*
* ( C ) Copyright 2007 Michal Simek
* ( C ) Copyright 2004 Atmark Techno , Inc . * ( C ) Copyright 2004 Atmark Techno , Inc .
* *
* Michal SIMEK < monstr @ monstr . eu >
* Yasushi SHOJI < yashi @ atmark - techno . com > * Yasushi SHOJI < yashi @ atmark - techno . com >
* *
* See file CREDITS for list of people who contributed to this * See file CREDITS for list of people who contributed to this
@ -13,7 +15,7 @@
* *
* This program is distributed in the hope that it will be useful , * This program is distributed in the hope that it will be useful ,
* but WITHOUT ANY WARRANTY ; without even the implied warranty of * but WITHOUT ANY WARRANTY ; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE . See the * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE . See the
* GNU General Public License for more details . * GNU General Public License for more details .
* *
* You should have received a copy of the GNU General Public License * You should have received a copy of the GNU General Public License
@ -22,11 +24,185 @@
* MA 02111 - 1307 USA * MA 02111 - 1307 USA
*/ */
void enable_interrupts ( void ) # include <common.h>
# include <command.h>
# include <asm/microblaze_intc.h>
# undef DEBUG_INT
extern void microblaze_disable_interrupts ( void ) ;
extern void microblaze_enable_interrupts ( void ) ;
void enable_interrupts ( void )
{ {
microblaze_enable_interrupts ( ) ;
} }
int disable_interrupts ( void ) int disable_interrupts ( void )
{ {
microblaze_disable_interrupts ( ) ;
return 0 ; return 0 ;
} }
# ifdef CFG_INTC_0
# ifdef CFG_TIMER_0
extern void timer_init ( void ) ;
# endif
static struct irq_action vecs [ CFG_INTC_0_NUM ] ;
/* mapping structure to interrupt controller */
microblaze_intc_t * intc = ( microblaze_intc_t * ) ( CFG_INTC_0_ADDR ) ;
/* default handler */
void def_hdlr ( void )
{
puts ( " def_hdlr \n " ) ;
}
void enable_one_interrupt ( int irq )
{
int mask ;
int offset = 1 ;
offset < < = irq ;
mask = intc - > ier ;
intc - > ier = ( mask | offset ) ;
# ifdef DEBUG_INT
printf ( " Enable one interrupt irq %x - mask %x,ier %x \n " , offset , mask ,
intc - > ier ) ;
printf ( " INTC isr %x, ier %x, iar %x, mer %x \n " , intc - > isr , intc - > ier ,
intc - > iar , intc - > mer ) ;
# endif
}
void disable_one_interrupt ( int irq )
{
int mask ;
int offset = 1 ;
offset < < = irq ;
mask = intc - > ier ;
intc - > ier = ( mask & ~ offset ) ;
# ifdef DEBUG_INT
printf ( " Disable one interrupt irq %x - mask %x,ier %x \n " , irq , mask ,
intc - > ier ) ;
printf ( " INTC isr %x, ier %x, iar %x, mer %x \n " , intc - > isr , intc - > ier ,
intc - > iar , intc - > mer ) ;
# endif
}
/* adding new handler for interrupt */
void install_interrupt_handler ( int irq , interrupt_handler_t * hdlr , void * arg )
{
struct irq_action * act ;
/* irq out of range */
if ( ( irq < 0 ) | | ( irq > CONFIG_XILINX_INTC_0_NUM_INTR_INPUTS ) ) {
puts ( " IRQ out of range \n " ) ;
return ;
}
act = & vecs [ irq ] ;
if ( hdlr ) { /* enable */
act - > handler = hdlr ;
act - > arg = arg ;
act - > count = 0 ;
enable_one_interrupt ( irq ) ;
} else { /* disable */
act - > handler = ( interrupt_handler_t * ) def_hdlr ;
act - > arg = ( void * ) irq ;
disable_one_interrupt ( irq ) ;
}
}
/* initialization interrupt controller - hardware */
void intc_init ( void )
{
intc - > mer = 0 ;
intc - > ier = 0 ;
intc - > iar = 0xFFFFFFFF ;
/* XIntc_Start - hw_interrupt enable and all interrupt enable */
intc - > mer = 0x3 ;
# ifdef DEBUG_INT
printf ( " INTC isr %x, ier %x, iar %x, mer %x \n " , intc - > isr , intc - > ier ,
intc - > iar , intc - > mer ) ;
# endif
}
int interrupts_init ( void )
{
int i ;
/* initialize irq list */
for ( i = 0 ; i < CONFIG_XILINX_INTC_0_NUM_INTR_INPUTS ; i + + ) {
vecs [ i ] . handler = ( interrupt_handler_t * ) def_hdlr ;
vecs [ i ] . arg = ( void * ) i ;
vecs [ i ] . count = 0 ;
}
/* initialize intc controller */
intc_init ( ) ;
# ifdef CFG_TIMER_0
timer_init ( ) ;
# endif
enable_interrupts ( ) ;
return 0 ;
}
void interrupt_handler ( void )
{
int irqs ;
irqs = ( intc - > isr & intc - > ier ) ; /* find active interrupt */
# ifdef DEBUG_INT
printf ( " INTC isr %x, ier %x, iar %x, mer %x \n " , intc - > isr , intc - > ier ,
intc - > iar , intc - > mer ) ;
printf ( " Interrupt handler on %x line, r14 %x \n " , irqs , value ) ;
# endif
struct irq_action * act = vecs ;
while ( irqs ) {
if ( irqs & 1 ) {
# ifdef DEBUG_INT
printf
( " Jumping to interrupt handler rutine addr %x,count %x,arg %x \n " ,
act - > handler , act - > count , act - > arg ) ;
# endif
act - > handler ( act - > arg ) ;
act - > count + + ;
}
irqs > > = 1 ;
act + + ;
}
intc - > iar = 0xFFFFFFFF ; /* erase all events */
# ifdef DEBUG
printf ( " Dump INTC reg, isr %x, ier %x, iar %x, mer %x \n " , intc - > isr ,
intc - > ier , intc - > iar , intc - > mer ) ;
printf ( " Interrupt handler on %x line, r14 \n " , irqs ) ;
# endif
}
# endif
# if (CONFIG_COMMANDS & CFG_CMD_IRQ)
# ifdef CFG_INTC_0
int do_irqinfo ( cmd_tbl_t * cmdtp , int flag , int argc , char * argv [ ] )
{
int i ;
struct irq_action * act = vecs ;
puts ( " \n Interrupt-Information: \n \n "
" Nr Routine Arg Count \n "
" ----------------------------- \n " ) ;
for ( i = 0 ; i < CONFIG_XILINX_INTC_0_NUM_INTR_INPUTS ; i + + ) {
if ( act - > handler ! = ( interrupt_handler_t * ) def_hdlr ) {
printf ( " %02d %08lx %08lx %d \n " , i ,
( int ) act - > handler , ( int ) act - > arg , act - > count ) ;
}
act + + ;
}
puts ( " \n " ) ;
return ( 0 ) ;
}
# else
int do_irqinfo ( cmd_tbl_t * cmdtp , int flag , int argc , char * argv [ ] )
{
puts ( " Undefined interrupt controller \n " ) ;
}
# endif
# endif /* CONFIG_COMMANDS & CFG_CMD_IRQ */
Michal Simek
18 years ago