From patchwork Tue Oct 23 15:22:56 2012 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Shawn Guo X-Patchwork-Id: 193513 Return-Path: X-Original-To: incoming-imx@patchwork.ozlabs.org Delivered-To: patchwork-incoming-imx@bilbo.ozlabs.org Received: from merlin.infradead.org (merlin.infradead.org [IPv6:2001:4978:20e::2]) (using TLSv1 with cipher DHE-RSA-AES256-SHA (256/256 bits)) (Client did not present a certificate) by ozlabs.org (Postfix) with ESMTPS id 368AD2C0109 for ; Wed, 24 Oct 2012 02:27:01 +1100 (EST) Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.76 #1 (Red Hat Linux)) id 1TQgLA-0001FO-UO; Tue, 23 Oct 2012 15:24:27 +0000 Received: from mail-pa0-f49.google.com ([209.85.220.49]) by merlin.infradead.org with esmtps (Exim 4.76 #1 (Red Hat Linux)) id 1TQgJm-0000d2-KY for linux-arm-kernel@lists.infradead.org; Tue, 23 Oct 2012 15:23:00 +0000 Received: by mail-pa0-f49.google.com with SMTP id bi5so2647161pad.36 for ; Tue, 23 Oct 2012 08:22:58 -0700 (PDT) X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=20120113; h=from:to:cc:subject:date:message-id:x-mailer:in-reply-to:references :x-gm-message-state; bh=mrOSrEBBmbHXqQemsT+d26mVSYxQPdK1maisne4Tg4c=; b=lULWJExXNeQBK3cgJpHKaY7NJClsoXhHNaANQ58SIwTrsW0cxn9iuTidXE1PMPMbq5 QRh4MbJxxrD6TPasZ9nimFjd+IKgiev0VOjnvRPspBC5pWEdPbboxmUWwDhSGk3UtsOz uNf2ZDBNaMkeEaLtRYnin1CBrdUSNkIVQJpcPeAzW0RU/7bGnOqmdGr0S3wU48TXE9lW bLzNcWhmJml6mzwPK6Iwe59mRjwTZ1jVUe0mjwZ5KLj8TGzKR0Oj1TcSKrJSWaUVBqkj PE+nC8NKUD+2gOePNA5Sh+T9SGANp0cZZJKfNjLLjln5XehJX8D2FWfsdSFmob0KJ6wa 6vpw== Received: by 10.66.73.98 with SMTP id k2mr12591724pav.23.1351005778361; Tue, 23 Oct 2012 08:22:58 -0700 (PDT) Received: from S2101-09.ap.freescale.net ([58.209.136.71]) by mx.google.com with ESMTPS id pj10sm7842864pbb.46.2012.10.23.08.22.51 (version=TLSv1/SSLv3 cipher=OTHER); Tue, 23 Oct 2012 08:22:57 -0700 (PDT) From: Shawn Guo To: linux-arm-kernel@lists.infradead.org Subject: [PATCH 07/10] ARM: imx6q: get v7_cpu_resume ready for cpuidle Date: Tue, 23 Oct 2012 23:22:56 +0800 Message-Id: <1351005779-30347-8-git-send-email-shawn.guo@linaro.org> X-Mailer: git-send-email 1.7.9.5 In-Reply-To: <1351005779-30347-1-git-send-email-shawn.guo@linaro.org> References: <1351005779-30347-1-git-send-email-shawn.guo@linaro.org> X-Gm-Message-State: ALoCoQnv9cTobipz5/nHge9it96Uuw7f42Vn3CdJHag3VpywvyfoLTa2IirOqnL3PCDNKD2WnC5H X-Spam-Note: CRM114 invocation failed X-Spam-Score: -2.6 (--) X-Spam-Report: SpamAssassin version 3.3.2 on merlin.infradead.org summary: Content analysis details: (-2.6 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.7 RCVD_IN_DNSWL_LOW RBL: Sender listed at http://www.dnswl.org/, low trust [209.85.220.49 listed in list.dnswl.org] -1.9 BAYES_00 BODY: Bayes spam probability is 0 to 1% [score: 0.0000] Cc: Sascha Hauer , Shawn Guo , Robert Lee X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.14 Precedence: list List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Sender: linux-arm-kernel-bounces@lists.infradead.org Errors-To: linux-arm-kernel-bounces+incoming-imx=patchwork.ozlabs.org@lists.infradead.org List-Id: linux-imx-kernel.lists.patchwork.ozlabs.org To get v7_cpu_resume ready for cpuidle power gating case, we need the following changes. * L2X0_POWER_CTRL register needs to be restored. * Enable SCU inside v7_cpu_resume. As the result, function imx_smp_prepare gets eliminated. * Remove v7_invalidate_l1 invoking from v7_cpu_resume. It turns out that v7_invalidate_l1 only needs to be called for secondary cores startup. Signed-off-by: Shawn Guo --- arch/arm/mach-imx/common.h | 2 -- arch/arm/mach-imx/headsmp.S | 25 ++++++++++++++++++++++--- arch/arm/mach-imx/platsmp.c | 7 +------ arch/arm/mach-imx/pm-imx6q.c | 1 - 4 files changed, 23 insertions(+), 12 deletions(-) diff --git a/arch/arm/mach-imx/common.h b/arch/arm/mach-imx/common.h index 9ff0776..ea11bbc 100644 --- a/arch/arm/mach-imx/common.h +++ b/arch/arm/mach-imx/common.h @@ -125,11 +125,9 @@ extern u32 *pl310_get_save_ptr(void); #ifdef CONFIG_SMP extern void v7_secondary_startup(void); extern void imx_scu_map_io(void); -extern void imx_smp_prepare(void); extern void imx_scu_standby_enable(bool enable); #else static inline void imx_scu_map_io(void) {} -static inline void imx_smp_prepare(void) {} static inline void imx_scu_standby_enable(bool enable) {} #endif extern void imx_enable_cpu(int cpu, bool enable); diff --git a/arch/arm/mach-imx/headsmp.S b/arch/arm/mach-imx/headsmp.S index 7e49deb..ac8a967 100644 --- a/arch/arm/mach-imx/headsmp.S +++ b/arch/arm/mach-imx/headsmp.S @@ -27,8 +27,7 @@ * clean + invalidate, before jumping into the kernel. * * This funciton is cloned from arch/arm/mach-tegra/headsmp.S, and needs - * to be called for both secondary cores startup and primary core resume - * procedures. Ideally, it should be moved into arch/arm/mm/cache-v7.S. + * to be called for secondary cores startup. */ ENTRY(v7_invalidate_l1) mov r0, #0 @@ -84,10 +83,16 @@ ENDPROC(v7_secondary_startup) .macro pl310_resume ldr r2, phys_l2x0_saved_regs ldr r0, [r2, #L2X0_R_PHY_BASE] @ get physical base of l2x0 + ldr r1, [r0, #L2X0_CTRL] @ check if already enabled + tst r1, #1 + bne 1f ldr r1, [r2, #L2X0_R_AUX_CTRL] @ get aux_ctrl value str r1, [r0, #L2X0_AUX_CTRL] @ restore aux_ctrl + ldr r1, [r2, #L2X0_R_PWR_CTRL] + str r1, [r0, #L2X0_POWER_CTRL] mov r1, #0x1 str r1, [r0, #L2X0_CTRL] @ re-enable L2 +1: .endm .globl phys_l2x0_saved_regs @@ -98,9 +103,23 @@ phys_l2x0_saved_regs: .endm #endif +#ifdef CONFIG_SMP + .macro _scu_enable + /* Enable SCU */ + mrc p15, 4, r0, c15, c0, 0 @ r0 = scu physical base + ldr r1, [r0] @ r1 = scu control register + tst r1, #0x1 @ check if already enabled + orreq r1, r1, #0x1 + streq r1, [r0] + .endm +#else + .macro _scu_enable + .endm +#endif + ENTRY(v7_cpu_resume) - bl v7_invalidate_l1 pl310_resume + _scu_enable b cpu_resume ENDPROC(v7_cpu_resume) #endif diff --git a/arch/arm/mach-imx/platsmp.c b/arch/arm/mach-imx/platsmp.c index c739a8a..fc25062 100644 --- a/arch/arm/mach-imx/platsmp.c +++ b/arch/arm/mach-imx/platsmp.c @@ -89,14 +89,9 @@ static void __init imx_smp_init_cpus(void) set_smp_cross_call(gic_raise_softirq); } -void imx_smp_prepare(void) -{ - scu_enable(scu_base); -} - static void __init imx_smp_prepare_cpus(unsigned int max_cpus) { - imx_smp_prepare(); + scu_enable(scu_base); } struct smp_operations imx_smp_ops __initdata = { diff --git a/arch/arm/mach-imx/pm-imx6q.c b/arch/arm/mach-imx/pm-imx6q.c index a17543d..7c4347b 100644 --- a/arch/arm/mach-imx/pm-imx6q.c +++ b/arch/arm/mach-imx/pm-imx6q.c @@ -39,7 +39,6 @@ static int imx6q_pm_enter(suspend_state_t state) imx_set_cpu_jump(0, v7_cpu_resume); /* Zzz ... */ cpu_suspend(0, imx6q_suspend_finish); - imx_smp_prepare(); imx_gpc_post_resume(); break; default: