diff options
Diffstat (limited to 'target/linux/leon/patches/006-amp_support.patch')
-rw-r--r-- | target/linux/leon/patches/006-amp_support.patch | 85 |
1 files changed, 85 insertions, 0 deletions
diff --git a/target/linux/leon/patches/006-amp_support.patch b/target/linux/leon/patches/006-amp_support.patch new file mode 100644 index 0000000..98d1c9f --- /dev/null +++ b/target/linux/leon/patches/006-amp_support.patch @@ -0,0 +1,85 @@ +From 25a68b8cd8ea1553f8b56278418d6c1ecc12e247 Mon Sep 17 00:00:00 2001 +From: Daniel Hellstrom <daniel@gaisler.com> +Date: Wed, 22 Sep 2010 10:19:34 +0200 +Subject: [PATCH] SPARC/LEON: added support for AMP systems with IRQAMP IRQ Controller. + +Signed-off-by: Daniel Hellstrom <daniel@gaisler.com> +--- + arch/sparc/include/asm/leon.h | 12 ++++++++++++ + arch/sparc/include/asm/leon_amba.h | 6 +++--- + arch/sparc/kernel/leon_kernel.c | 14 ++++++++++++++ + 3 files changed, 29 insertions(+), 3 deletions(-) + +--- a/arch/sparc/include/asm/leon.h ++++ b/arch/sparc/include/asm/leon.h +@@ -224,6 +224,18 @@ static inline void sparc_leon3_disable_c + "sta %%l2, [%%g0] 2\n\t" : : : "l1", "l2"); + }; + ++static inline unsigned long sparc_leon3_asr17(void) ++{ ++ u32 asr17; ++ __asm__ __volatile__ ("rd %%asr17, %0\n\t" : "=r"(asr17)); ++ return asr17; ++}; ++ ++static inline int sparc_leon3_cpuid(void) ++{ ++ return sparc_leon3_asr17() >> 28; ++} ++ + #endif /*!__ASSEMBLY__*/ + + #ifdef CONFIG_SMP +--- a/arch/sparc/include/asm/leon_amba.h ++++ b/arch/sparc/include/asm/leon_amba.h +@@ -100,9 +100,8 @@ struct leon3_irqctrl_regs_map { + u32 mpbroadcast; + u32 notused02; + u32 notused03; +- u32 notused10; +- u32 notused11; +- u32 notused12; ++ u32 ampctrl; ++ u32 icsel[2]; + u32 notused13; + u32 notused20; + u32 notused21; +@@ -112,6 +111,7 @@ struct leon3_irqctrl_regs_map { + u32 force[16]; + /* Extended IRQ registers */ + u32 intid[16]; /* 0xc0 */ ++ u32 unused[(0x1000-0x100)/4]; + }; + + struct leon3_apbuart_regs_map { +--- a/arch/sparc/kernel/leon_kernel.c ++++ b/arch/sparc/kernel/leon_kernel.c +@@ -108,6 +108,7 @@ void __init leon_init_timers(irq_handler + struct device_node *rootnp, *np; + struct property *pp; + int len; ++ int cpu, icsel; + + leondebug_irq_disable = 0; + leon_debug_irqout = 0; +@@ -153,6 +154,19 @@ void __init leon_init_timers(irq_handler + LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[1].ctrl, 0); + # endif + ++ /* The IRQ controller may (if implemented) consist of multiple ++ * IRQ controllers, each mapped on a 4Kb boundary. ++ * Each CPU may be routed to different IRQCTRLs, however ++ * we assume that all CPUs (in SMP system) is routed to the ++ * same IRQ Controller, and for non-SMP only one IRQCTRL is ++ * accessed anyway. ++ * In AMP systems, Linux may not be run on CPU0. ++ */ ++ cpu = sparc_leon3_cpuid(); ++ icsel = LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->icsel[cpu/8]); ++ icsel = (icsel >> ((7 - (cpu&0x7)) * 4)) & 0xf; ++ leon3_irqctrl_regs += icsel; ++ + LEON3_BYPASS_STORE_PA(&(leon3_irqctrl_regs->mask[0]), 0); + eirq = (LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs->mpstatus) >> 16) & 0xf; + if ( eirq != 0 ) { |