diff options
| author | Daniel Hellstrom <daniel@gaisler.com> | 2012-04-05 10:23:21 -0500 |
|---|---|---|
| committer | Joel Sherrill <joel.sherrill@oarcorp.com> | 2012-04-06 09:03:40 -0500 |
| commit | 3722ff5a735e43e1b3effe03c866d92883eae0de (patch) | |
| tree | c9e122bb3c3abc9d21cb5d175b5a370e5a4ef461 /c/src/lib/libbsp/sparc/leon3/amba/amba.c | |
| parent | LEON3: halt boot if IRQ controller not found (diff) | |
| download | rtems-3722ff5a735e43e1b3effe03c866d92883eae0de.tar.bz2 | |
LEON3: added IRQAMP support
Diffstat (limited to 'c/src/lib/libbsp/sparc/leon3/amba/amba.c')
| -rw-r--r-- | c/src/lib/libbsp/sparc/leon3/amba/amba.c | 14 |
1 files changed, 14 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/sparc/leon3/amba/amba.c b/c/src/lib/libbsp/sparc/leon3/amba/amba.c index e334aecd09..56ff57f9aa 100644 --- a/c/src/lib/libbsp/sparc/leon3/amba/amba.c +++ b/c/src/lib/libbsp/sparc/leon3/amba/amba.c @@ -39,6 +39,7 @@ extern int scan_uarts(void); void amba_initialize(void) { int i; + int icsel; amba_apb_device dev; /* Scan the AMBA Plug&Play info at the default LEON3 area */ @@ -55,6 +56,19 @@ void amba_initialize(void) } LEON3_IrqCtrl_Regs = (volatile LEON3_IrqCtrl_Regs_Map *) dev.start; + if ((LEON3_IrqCtrl_Regs->ampctrl >> 28) > 0) { + /* IRQ Controller has support for multiple IRQ Controllers, each + * CPU can be routed to different Controllers, we find out which + * controller by looking at the IRQCTRL Select Register for this CPU. + * Each Controller is located at a 4KByte offset. + */ + icsel = LEON3_IrqCtrl_Regs->icsel[LEON3_Cpu_Index/8]; + icsel = (icsel >> ((7 - (LEON3_Cpu_Index & 0x7)) * 4)) & 0xf; + LEON3_IrqCtrl_Regs += icsel; + LEON3_IrqCtrl_Regs->mask[LEON3_Cpu_Index] = 0; + LEON3_IrqCtrl_Regs->force[LEON3_Cpu_Index] = 0; + LEON3_IrqCtrl_Regs->iclear = 0xffffffff; + } /* Init Extended IRQ controller if available */ leon3_ext_irq_init(); |