From 5795c686d04b7944d0c2a955d221a031e603c079 Mon Sep 17 00:00:00 2001 From: Imre Kaloz Date: Thu, 7 Jul 2011 17:17:06 +0000 Subject: [PATCH] [cns3xxx]: make smp code more similar to upstream SVN-Revision: 27525 --- .../patches-3.0/049-cns3xxx_smp_support.patch | 106 ++++++++---------- 1 file changed, 46 insertions(+), 60 deletions(-) diff --git a/target/linux/cns3xxx/patches-3.0/049-cns3xxx_smp_support.patch b/target/linux/cns3xxx/patches-3.0/049-cns3xxx_smp_support.patch index f629166075..df428caf74 100644 --- a/target/linux/cns3xxx/patches-3.0/049-cns3xxx_smp_support.patch +++ b/target/linux/cns3xxx/patches-3.0/049-cns3xxx_smp_support.patch @@ -9,14 +9,13 @@ +obj-$(CONFIG_LOCAL_TIMERS) += localtimer.o --- /dev/null +++ b/arch/arm/mach-cns3xxx/headsmp.S -@@ -0,0 +1,43 @@ +@@ -0,0 +1,42 @@ +/* + * linux/arch/arm/mach-cns3xxx/headsmp.S + * -+ * Copyright (c) 2003 ARM Limited -+ * Copyright 2011 Gateworks Corporation -+ * Chris Lang ++ * Cloned from linux/arch/arm/mach-realview/hotplug.c + * ++ * Copyright (C) 2002 ARM Ltd. + * All Rights Reserved + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. -+ */ ++*/ ++ +#include +#include +#include @@ -83,7 +81,7 @@ + + flush_cache_all(); + asm volatile( -+ "mcr p15, 0, %1, c7, c5, 0\n" ++ " mcr p15, 0, %1, c7, c5, 0\n" + " mcr p15, 0, %1, c7, c10, 4\n" + /* + * Turn off coherency @@ -104,7 +102,7 @@ + unsigned int v; + + asm volatile( -+ "mrc p15, 0, %0, c1, c0, 0\n" ++ "mrc p15, 0, %0, c1, c0, 0\n" + " orr %0, %0, %1\n" + " mcr p15, 0, %0, c1, c0, 0\n" + " mrc p15, 0, %0, c1, c0, 1\n" @@ -189,52 +187,50 @@ +} --- /dev/null +++ b/arch/arm/mach-cns3xxx/localtimer.c -@@ -0,0 +1,29 @@ -+/* -+ * linux/arch/arm/mach-cns3xxx/localtimer.c +@@ -0,0 +1,26 @@ ++/* linux/arch/arm/mach-cns3xxx/localtimer.c + * -+ * Copyright (C) 2002 ARM Ltd. -+ * Copyright 2011 Gateworks Corporation -+ * Chris Lang ++ * Cloned from linux/arch/arm/mach-realview/localtimer.c + * ++ * Copyright (C) 2002 ARM Ltd. + * All Rights Reserved + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. -+ */ -+#include -+#include ++*/ ++ +#include + -+#include ++#include +#include -+#include + +/* + * Setup the local clock events for a CPU. + */ -+void __cpuinit local_timer_setup(struct clock_event_device *evt) ++int __cpuinit local_timer_setup(struct clock_event_device *evt) +{ + evt->irq = IRQ_LOCALTIMER; + twd_timer_setup(evt); ++ return 0; +} --- /dev/null +++ b/arch/arm/mach-cns3xxx/platsmp.c -@@ -0,0 +1,168 @@ -+/* -+ * linux/arch/arm/mach-cns3xxx/platsmp.c +@@ -0,0 +1,175 @@ ++/* linux/arch/arm/mach-cns3xxx/platsmp.c + * -+ * Copyright (C) 2002 ARM Ltd. -+ * Copyright 2011 Gateworks Corporation ++ * Copyright 2011 Gateworks Corporation + * Chris Lang ++ * Cloned from linux/arch/arm/mach-vexpress/platsmp.c + * ++ * Copyright (C) 2002 ARM Ltd. + * All Rights Reserved + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. -+ */ ++*/ ++ +#include +#include +#include @@ -244,19 +240,20 @@ +#include + +#include ++#include +#include +#include ++ +#include +#include + -+#include "core.h" -+ +extern void cns3xxx_secondary_startup(void); + +/* + * control for which core is the next to come out of the secondary + * boot "holding pen" + */ ++ +volatile int __cpuinitdata pen_release = -1; + +/* @@ -264,7 +261,7 @@ + * observers, irrespective of whether they're taking part in coherency + * or not. This is necessary for the hotplug code to work reliably. + */ -+static void __cpuinit write_pen_release(int val) ++static void write_pen_release(int val) +{ + pen_release = val; + smp_wmb(); @@ -312,10 +309,12 @@ + spin_lock(&boot_lock); + + /* -+ * This is really belt and braces; we hold unintended secondary -+ * CPUs in the holding pen until we're ready for them. However, -+ * since we haven't sent them a soft interrupt, they shouldn't -+ * be there. ++ * The secondary processor is waiting to be released from ++ * the holding pen - release it, then wait for it to flag ++ * that it has been released by resetting pen_release. ++ * ++ * Note that "pen_release" is the hardware CPU ID, whereas ++ * "cpu" is Linux's internal ID. + */ + write_pen_release(cpu); + @@ -324,7 +323,7 @@ + * the boot monitor to read the system wide flags register, + * and branch to the address found there. + */ -+ smp_cross_call(cpumask_of(cpu), 1); ++ gic_raise_softirq(cpumask_of(cpu), 1); + + timeout = jiffies + (1 * HZ); + while (time_before(jiffies, timeout)) { @@ -348,6 +347,7 @@ + * Initialise the CPU possible map early - this describes the CPUs + * which may be present or become present in the system. + */ ++ +void __init smp_init_cpus(void) +{ + void __iomem *scu_base = scu_base_addr(); @@ -366,6 +366,8 @@ + + for (i = 0; i < ncores; i++) + set_cpu_possible(i, true); ++ ++ set_smp_cross_call(gic_raise_softirq); +} + +void __init platform_smp_prepare_cpus(unsigned int max_cpus) @@ -388,27 +390,11 @@ + * secondary CPU branches to this address. + */ + __raw_writel(virt_to_phys(cns3xxx_secondary_startup), -+ (void __iomem *)(0xFFF07000 + 0x0600)); -+} ---- /dev/null -+++ b/arch/arm/mach-cns3xxx/include/mach/smp.h -@@ -0,0 +1,13 @@ -+#ifndef __MACH_SMP_H -+#define __MACH_SMP_H -+ -+#include -+ -+/* -+ * We use IRQ1 as the IPI -+ */ -+static inline void smp_cross_call(const struct cpumask *mask, int ipi) -+{ -+ gic_raise_softirq(mask, ipi); ++ (void __iomem *)(CNS3XXX_MISC_BASE_VIRT + 0x0600)); +} -+#endif --- a/arch/arm/Kconfig +++ b/arch/arm/Kconfig -@@ -1311,7 +1311,7 @@ config SMP +@@ -1312,7 +1312,7 @@ config SMP depends on REALVIEW_EB_ARM11MP || REALVIEW_EB_A9MP || \ MACH_REALVIEW_PB11MP || MACH_REALVIEW_PBX || ARCH_OMAP4 || \ ARCH_EXYNOS4 || ARCH_TEGRA || ARCH_U8500 || ARCH_VEXPRESS_CA9X4 || \ -- 2.30.2