From patchwork Fri Aug 24 08:33:57 2012 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Kyungmin Park X-Patchwork-Id: 1370091 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-process-083081@patchwork2.kernel.org Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) by patchwork2.kernel.org (Postfix) with ESMTP id A5233DF264 for ; Fri, 24 Aug 2012 08:36:27 +0000 (UTC) Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.76 #1 (Red Hat Linux)) id 1T4pKe-00050B-Np; Fri, 24 Aug 2012 08:33:32 +0000 Received: from mailout2.samsung.com ([203.254.224.25]) by merlin.infradead.org with esmtp (Exim 4.76 #1 (Red Hat Linux)) id 1T4pKV-0004yN-Lu for linux-arm-kernel@lists.infradead.org; Fri, 24 Aug 2012 08:33:26 +0000 Received: from epcpsbgm2.samsung.com (mailout2.samsung.com [203.254.224.25]) by mailout2.samsung.com (Oracle Communications Messaging Server 7u4-24.01(7.0.4.24.0) 64bit (built Nov 17 2011)) with ESMTP id <0M99003BE3RB9MP0@mailout2.samsung.com> for linux-arm-kernel@lists.infradead.org; Fri, 24 Aug 2012 17:33:20 +0900 (KST) X-AuditID: cbfee61b-b7faf6d00000476a-3c-50373c5062f0 Received: from epmmp1.local.host ( [203.254.227.16]) by epcpsbgm2.samsung.com (EPCPMTA) with SMTP id 10.A7.18282.05C37305; Fri, 24 Aug 2012 17:33:20 +0900 (KST) Received: from july ([165.213.74.254]) by mmp1.samsung.com (Oracle Communications Messaging Server 7u4-24.01 (7.0.4.24.0) 64bit (built Nov 17 2011)) with ESMTPA id <0M99001MH3RJOD50@mmp1.samsung.com> for linux-arm-kernel@lists.infradead.org; Fri, 24 Aug 2012 17:33:20 +0900 (KST) Received: by july (sSMTP sendmail emulation); Fri, 24 Aug 2012 17:33:57 +0900 Date: Fri, 24 Aug 2012 17:33:57 +0900 From: Kyungmin Park To: Russell King , Arnd Bergmann Subject: [PATCH v5 2/2] ARM: EXYNOS: SMC instruction (aka firmware) support Message-id: <20120824083357.GA25384@july> MIME-version: 1.0 Content-disposition: inline rom: Kyungmin Park User-Agent: Mutt/1.5.21 (2010-09-15) X-Brightmail-Tracker: H4sIAAAAAAAAA+NgFlrFLMWRmVeSWpSXmKPExsVy+t9jAd0AG/MAg97dhhabHl9jdWD02Lyk PoAxissmJTUnsyy1SN8ugStjwvN1rAXv1Cq+bFzP1MD4Q76LkZNDQsBE4v3+WcwQtpjEhXvr 2boYuTiEBBYxSpw8M48VwpnPJPF4zgywKiEBX4llPWdYQWwWAVWJu937wGw2AS2JKx/2sIPY IgIeEp0d18HqmQUaGSV2zfYDsYUFvCVaFpxnAbF5BTQl7k55BmULSvyYfI8Fol5LYv3O40wQ trTEo78z2CH2akoc/fuGDcQWFVCRmHJyG9sERoFZSNpnIWmfhaR9ASPzKkbR1ILkguKk9Fwj veLE3OLSvHS95PzcTYzgEHwmvYNxVYPFIUYBDkYlHt4dLWYBQqyJZcWVuYcYJTiYlUR45z8G CvGmJFZWpRblxxeV5qQWH2KU5mBREufl7zMMEBJITyxJzU5NLUgtgskycXBKNTDWN2Uf2luo 1+23fM8Tu0O3G8IWrOwJX756aS/zhfUffjpOZVxmvkXg0+VPAdNDo/Sz32XPlhEXq5x2ef+3 gu6Y31O3THqbwMLfX1R+ejK7y829DhO4WPf2tLhdV7kuf1Jtgiz7g/b1W303X/gSG3z8mfrk H8eWltetaRd4sC5wVfrtfY8qw1uvK7EUZyQaajEXFScCAEbUp8Y9AgAA X-TM-AS-MML: No X-Spam-Note: CRM114 invocation failed X-Spam-Score: -6.8 (------) X-Spam-Report: SpamAssassin version 3.3.2 on merlin.infradead.org summary: Content analysis details: (-6.8 points) pts rule name description ---- ---------------------- -------------------------------------------------- -5.0 RCVD_IN_DNSWL_HI RBL: Sender listed at http://www.dnswl.org/, high trust [203.254.224.25 listed in list.dnswl.org] -0.0 SPF_HELO_PASS SPF: HELO matches SPF record -1.9 BAYES_00 BODY: Bayes spam probability is 0 to 1% [score: 0.0000] 0.1 HDRS_LCASE Odd capitalization of message header Cc: olof@lixom.net, dave.martin@linaro.org, linux-arm-kernel@lists.infradead.org, Marek Szyprowski 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 From: Kyungmin Park Some boards, e.g., exynos4412, can use smc instruction (aka firmware) interally. Signed-off-by: Kyungmin Park --- Changelog v4 use call_firmware_op instead of indirect call diff --git a/arch/arm/mach-exynos/Makefile b/arch/arm/mach-exynos/Makefile index 9b58024..8ee779c 100644 --- a/arch/arm/mach-exynos/Makefile +++ b/arch/arm/mach-exynos/Makefile @@ -30,6 +30,11 @@ obj-$(CONFIG_EXYNOS4_MCT) += mct.o obj-$(CONFIG_HOTPLUG_CPU) += hotplug.o +obj-$(CONFIG_ARM_FIRMWARE) += exynos-smc.o firmware.o + +plus_sec := $(call as-instr,.arch_extension sec,+sec) +AFLAGS_exynos-smc.o :=-Wa,-march=armv7-a$(plus_sec) + # machine support obj-$(CONFIG_MACH_SMDKC210) += mach-smdkv310.o diff --git a/arch/arm/mach-exynos/common.h b/arch/arm/mach-exynos/common.h index aed2eeb..540918f 100644 --- a/arch/arm/mach-exynos/common.h +++ b/arch/arm/mach-exynos/common.h @@ -21,6 +21,8 @@ void exynos4_restart(char mode, const char *cmd); void exynos5_restart(char mode, const char *cmd); void exynos_init_late(void); +void exynos_firmware_init(void); + #ifdef CONFIG_PM_GENERIC_DOMAINS int exynos_pm_late_initcall(void); #else diff --git a/arch/arm/mach-exynos/exynos-smc.S b/arch/arm/mach-exynos/exynos-smc.S new file mode 100644 index 0000000..2e27aa3 --- /dev/null +++ b/arch/arm/mach-exynos/exynos-smc.S @@ -0,0 +1,22 @@ +/* + * Copyright (C) 2012 Samsung Electronics. + * + * Copied from omap-smc.S Copyright (C) 2010 Texas Instruments, Inc. + * + * 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 + +/* + * Function signature: void exynos_smc(u32 cmd, u32 arg1, u32 arg2, u32 arg3) + */ + +ENTRY(exynos_smc) + stmfd sp!, {r4-r11, lr} + dsb + smc #0 + ldmfd sp!, {r4-r11, pc} +ENDPROC(exynos_smc) diff --git a/arch/arm/mach-exynos/firmware.c b/arch/arm/mach-exynos/firmware.c new file mode 100644 index 0000000..a144593 --- /dev/null +++ b/arch/arm/mach-exynos/firmware.c @@ -0,0 +1,37 @@ +/* + * Copyright (C) 2012 Samsung Electronics. + * Kyungmin Park + * + * 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 "smc.h" + +static int exynos_do_idle(void) +{ + exynos_smc(SMC_CMD_SLEEP, 0, 0, 0); + return 0; +} + +static void exynos_cpu_boot(int cpu) +{ + exynos_smc(SMC_CMD_CPU1BOOT, cpu, 0, 0); +} + +static struct firmware_ops exynos_firmware_ops __initdata = { + .do_idle = exynos_do_idle, + .cpu_boot = exynos_cpu_boot, +}; + +int __init exynos_firmware_init(void) +{ + firmware_ops = exynos_firmware_ops; + return 0; +} diff --git a/arch/arm/mach-exynos/platsmp.c b/arch/arm/mach-exynos/platsmp.c index 36c3984..c664a86 100644 --- a/arch/arm/mach-exynos/platsmp.c +++ b/arch/arm/mach-exynos/platsmp.c @@ -25,6 +25,7 @@ #include #include #include +#include #include #include @@ -139,6 +140,12 @@ int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle) __raw_writel(virt_to_phys(exynos4_secondary_startup), CPU1_BOOT_REG); + + if (IS_ENABLED(CONFIG_ARM_FIRMWARE)) { + /* Call Exynos specific smc call */ + call_firmware_op(cpu_boot, cpu); + } + gic_raise_softirq(cpumask_of(cpu), 1); if (pen_release == -1) diff --git a/arch/arm/mach-exynos/smc.h b/arch/arm/mach-exynos/smc.h new file mode 100644 index 0000000..e972390 --- /dev/null +++ b/arch/arm/mach-exynos/smc.h @@ -0,0 +1,31 @@ +/* + * Copyright (c) 2012 Samsung Electronics. + * + * EXYNOS - SMC Call + * + * 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. + */ + +#ifndef __ASM_ARCH_EXYNOS_SMC_H +#define __ASM_ARCH_EXYNOS_SMC_H + +#define SMC_CMD_INIT (-1) +#define SMC_CMD_INFO (-2) +/* For Power Management */ +#define SMC_CMD_SLEEP (-3) +#define SMC_CMD_CPU1BOOT (-4) +#define SMC_CMD_CPU0AFTR (-5) +/* For CP15 Access */ +#define SMC_CMD_C15RESUME (-11) +/* For L2 Cache Access */ +#define SMC_CMD_L2X0CTRL (-21) +#define SMC_CMD_L2X0SETUP1 (-22) +#define SMC_CMD_L2X0SETUP2 (-23) +#define SMC_CMD_L2X0INVALL (-24) +#define SMC_CMD_L2X0DEBUG (-25) + +extern void exynos_smc(u32 cmd, u32 arg1, u32 arg2, u32 arg3); + +#endif