From patchwork Tue Jul 24 01:09:24 2012 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Cyril Chemparathy X-Patchwork-Id: 1415601 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-process-083081@patchwork1.kernel.org Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) by patchwork1.kernel.org (Postfix) with ESMTP id E960F3FC71 for ; Thu, 6 Sep 2012 15:06:13 +0000 (UTC) Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.76 #1 (Red Hat Linux)) id 1T9dZO-0004H9-69; Thu, 06 Sep 2012 15:00:40 +0000 Received: from devils.ext.ti.com ([198.47.26.153]) by merlin.infradead.org with esmtps (Exim 4.76 #1 (Red Hat Linux)) id 1StTdC-0002ZL-FI for linux-arm-kernel@lists.infradead.org; Tue, 24 Jul 2012 01:10:28 +0000 Received: from dlelxv30.itg.ti.com ([172.17.2.17]) by devils.ext.ti.com (8.13.7/8.13.7) with ESMTP id q6O19efx027117; Mon, 23 Jul 2012 20:09:40 -0500 Received: from DFLE73.ent.ti.com (dfle73.ent.ti.com [128.247.5.110]) by dlelxv30.itg.ti.com (8.13.8/8.13.8) with ESMTP id q6O19e01010287; Mon, 23 Jul 2012 20:09:40 -0500 Received: from dlelxv22.itg.ti.com (172.17.1.197) by dfle73.ent.ti.com (128.247.5.110) with Microsoft SMTP Server id 14.1.323.3; Mon, 23 Jul 2012 20:09:40 -0500 Received: from ares-ubuntu.am.dhcp.ti.com (ares-ubuntu.am.dhcp.ti.com [158.218.103.17]) by dlelxv22.itg.ti.com (8.13.8/8.13.8) with ESMTP id q6O19ehV024620; Mon, 23 Jul 2012 20:09:40 -0500 Received: from a0875269 by ares-ubuntu.am.dhcp.ti.com with local (Exim 4.76) (envelope-from ) id 1StTd6-0002Uu-5A; Mon, 23 Jul 2012 21:09:40 -0400 From: Cyril Chemparathy To: Subject: [RFC 22/23] ARM: keystone: enable SMP on Keystone machines Date: Mon, 23 Jul 2012 21:09:24 -0400 Message-ID: <1343092165-9470-23-git-send-email-cyril@ti.com> X-Mailer: git-send-email 1.7.9.5 In-Reply-To: <1343092165-9470-1-git-send-email-cyril@ti.com> References: <1343092165-9470-1-git-send-email-cyril@ti.com> MIME-Version: 1.0 X-Bad-Reply: References and In-Reply-To but no 'Re:' in Subject. X-Spam-Note: CRM114 invocation failed X-Spam-Score: -6.9 (------) X-Spam-Report: SpamAssassin version 3.3.2 on merlin.infradead.org summary: Content analysis details: (-6.9 points) pts rule name description ---- ---------------------- -------------------------------------------------- -5.0 RCVD_IN_DNSWL_HI RBL: Sender listed at http://www.dnswl.org/, high trust [198.47.26.153 listed in list.dnswl.org] -0.0 T_RP_MATCHES_RCVD Envelope sender domain matches handover relay domain -0.0 SPF_PASS SPF: sender matches SPF record -1.9 BAYES_00 BODY: Bayes spam probability is 0 to 1% [score: 0.0000] X-Mailman-Approved-At: Thu, 06 Sep 2012 10:43:38 -0400 Cc: nico@linaro.org, catalin.marinas@arm.com, will.deacon@arm.com, linux-kernel@vger.kernel.org, Vitaly Andrianov , Cyril Chemparathy X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.14 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: linux-arm-kernel-bounces@lists.infradead.org Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org This patch adds basic SMP support for Keystone machines. Nothing very fancy here, just enough to get 4 CPUs booted up. This does not include support for hotplug, etc. Signed-off-by: Vitaly Andrianov Signed-off-by: Cyril Chemparathy --- arch/arm/Kconfig | 1 + arch/arm/configs/keystone_defconfig | 2 + arch/arm/mach-keystone/Makefile | 1 + arch/arm/mach-keystone/keystone.c | 3 ++ arch/arm/mach-keystone/platsmp.c | 73 +++++++++++++++++++++++++++++++++++ 5 files changed, 80 insertions(+) create mode 100644 arch/arm/mach-keystone/platsmp.c diff --git a/arch/arm/Kconfig b/arch/arm/Kconfig index 04c846b..5b82879 100644 --- a/arch/arm/Kconfig +++ b/arch/arm/Kconfig @@ -372,6 +372,7 @@ config ARCH_KEYSTONE select SPARSE_IRQ select NEED_MACH_MEMORY_H select HAVE_SCHED_CLOCK + select HAVE_SMP help Support for boards based on the Texas Instruments Keystone family of SoCs. diff --git a/arch/arm/configs/keystone_defconfig b/arch/arm/configs/keystone_defconfig index 7f2a04b..5f71e66 100644 --- a/arch/arm/configs/keystone_defconfig +++ b/arch/arm/configs/keystone_defconfig @@ -1,7 +1,9 @@ CONFIG_EXPERIMENTAL=y CONFIG_BLK_DEV_INITRD=y CONFIG_ARCH_KEYSTONE=y +CONFIG_SMP=y CONFIG_ARM_ARCH_TIMER=y +CONFIG_NR_CPUS=4 CONFIG_AEABI=y CONFIG_HIGHMEM=y CONFIG_VFP=y diff --git a/arch/arm/mach-keystone/Makefile b/arch/arm/mach-keystone/Makefile index d4671d5..3f6b8ab 100644 --- a/arch/arm/mach-keystone/Makefile +++ b/arch/arm/mach-keystone/Makefile @@ -1 +1,2 @@ obj-y := keystone.o +obj-$(CONFIG_SMP) += platsmp.o diff --git a/arch/arm/mach-keystone/keystone.c b/arch/arm/mach-keystone/keystone.c index 9583dc4..650e202 100644 --- a/arch/arm/mach-keystone/keystone.c +++ b/arch/arm/mach-keystone/keystone.c @@ -26,6 +26,8 @@ #include #include +extern struct smp_ops keystone_smp_ops; + static struct map_desc io_desc[] = { { .virtual = 0xfe800000UL, @@ -73,6 +75,7 @@ static const char *keystone_match[] __initconst = { }; DT_MACHINE_START(KEYSTONE, "Keystone") + smp_ops(keystone_smp_ops) .map_io = keystone_map_io, .init_irq = keystone_init_irq, .timer = &keystone_timer, diff --git a/arch/arm/mach-keystone/platsmp.c b/arch/arm/mach-keystone/platsmp.c new file mode 100644 index 0000000..437659a --- /dev/null +++ b/arch/arm/mach-keystone/platsmp.c @@ -0,0 +1,73 @@ +/* + * Copyright 2012 Texas Instruments, Inc. + * + * Based on platsmp.c, Copyright 2010-2011 Calxeda, Inc. + * Based on platsmp.c, Copyright (C) 2002 ARM Ltd. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms and conditions of the GNU General Public License, + * version 2, as published by the Free Software Foundation. + * + * This program is distributed in the hope it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * You should have received a copy of the GNU General Public License along with + * this program. If not, see . + */ +#include +#include +#include + +#include +#include +#include +#include +#include + +extern void secondary_startup(void); + +static void __init keystone_smp_init_cpus(void) +{ + unsigned int i, ncores; + + ncores = 4; + + /* sanity check */ + if (ncores > NR_CPUS) { + pr_warn("restricted to %d cpus\n", NR_CPUS); + ncores = NR_CPUS; + } + + for (i = 0; i < ncores; i++) + set_cpu_possible(i, true); + + set_smp_cross_call(gic_raise_softirq); +} + +static void __init keystone_smp_prepare_cpus(unsigned int max_cpus) +{ + /* nothing for now */ +} + +static void __cpuinit keystone_secondary_init(unsigned int cpu) +{ + gic_secondary_init(0); +} + +static int __cpuinit +keystone_boot_secondary(unsigned int cpu, struct task_struct *idle) +{ + unsigned long *jump_ptr = phys_to_virt(0x800001f0); + + jump_ptr[cpu] = virt_to_idmap(&secondary_startup); + __cpuc_flush_dcache_area(jump_ptr, sizeof(jump_ptr) * 4); + + return 0; +} + +struct smp_ops keystone_smp_ops __initdata = { + smp_init_ops(keystone) + smp_secondary_ops(keystone) +};