From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1756330AbbCRMwb (ORCPT ); Wed, 18 Mar 2015 08:52:31 -0400 Received: from mailout2.samsung.com ([203.254.224.25]:23503 "EHLO mailout2.samsung.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1756277AbbCRMwZ (ORCPT ); Wed, 18 Mar 2015 08:52:25 -0400 X-AuditID: cbfee61a-f79c06d000004e71-39-55097508e077 From: Bartlomiej Zolnierkiewicz To: Kukjin Kim , Kukjin Kim Cc: Daniel Lezcano , Tomasz Figa , Kyungmin Park , linux-samsung-soc@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-pm@vger.kernel.org, linux-kernel@vger.kernel.org, b.zolnierkie@samsung.com Subject: [PATCH v3 2/4] ARM: EXYNOS: add code for setting/clearing boot flag Date: Wed, 18 Mar 2015 13:51:51 +0100 Message-id: <1426683113-31209-3-git-send-email-b.zolnierkie@samsung.com> X-Mailer: git-send-email 1.7.10.4 In-reply-to: <1426683113-31209-1-git-send-email-b.zolnierkie@samsung.com> References: <1426683113-31209-1-git-send-email-b.zolnierkie@samsung.com> X-Brightmail-Tracker: H4sIAAAAAAAAA+NgFlrKLMWRmVeSWpSXmKPExsVy+t9jAV2OUs5Qg/YbHBYbZ6xntZj3Wdai d8FVNov+x6+ZLc42vWG32PT4GqvF5V1z2Cw+9x5htJhxfh+TxapdfxgduDx2zrrL7rFpVSeb x51re9g8Ni+p9+jbsorR4/MmuQC2KC6blNSczLLUIn27BK6Me2ubGAuW8Ff8vbOPpYHxBU8X IweHhICJxPpF+V2MnECmmMSFe+vZuhi5OIQEFjFKTF6ymwkkISTQxSTxYmo6iM0mYCUxsX0V I4gtIuAqMefKJEaQBmaBhUwSs94+YQdJCAv4SFx6fYIZxGYRUJWYP68bzOYV8JB4dP0NE8Q2 RYnuZxPYQGxOAU+JecdnsUAs85DYdqGDaQIj7wJGhlWMoqkFyQXFSem5hnrFibnFpXnpesn5 uZsYwYH3TGoH48oGi0OMAhyMSjy8Elc5QoVYE8uKK3MPMUpwMCuJ8HJncYYK8aYkVlalFuXH F5XmpBYfYpTmYFES51WybwsREkhPLEnNTk0tSC2CyTJxcEo1MFqx8h87dTZvwY/P53fc11NP 51X8UG2wQKTzpt2Rxo9Mj5a97ZRtXrMiac7/NU97N85fd4NX7qfT+Z4t9z1f9nAyHnY4xP7D OHZFm0ZGO5919vmty2dnM5g/kzlwq/D57VMft9eXXD++aZvvhv+fS+Z89vJ9eIrdZcvX0w5X Zwga/LbR+pPmKaikxFKckWioxVxUnAgAnhbweTgCAAA= Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org This code is needed for cpuidle (W-)AFTR mode support on Exynos3250. Cc: Daniel Lezcano Signed-off-by: Bartlomiej Zolnierkiewicz Acked-by: Kyungmin Park --- arch/arm/mach-exynos/common.h | 6 ++++++ arch/arm/mach-exynos/exynos.c | 25 +++++++++++++++++++++++++ 2 files changed, 31 insertions(+) diff --git a/arch/arm/mach-exynos/common.h b/arch/arm/mach-exynos/common.h index f70eca7..87bf1f3 100644 --- a/arch/arm/mach-exynos/common.h +++ b/arch/arm/mach-exynos/common.h @@ -119,6 +119,12 @@ extern void __iomem *sysram_base_addr; extern void __iomem *pmu_base_addr; void exynos_sysram_init(void); +/* CPU BOOT mode flag */ +#define C2_STATE (1 << 3) + +void exynos_set_boot_flag(unsigned int cpu, unsigned int mode); +void exynos_clear_boot_flag(unsigned int cpu, unsigned int mode); + enum { FW_DO_IDLE_SLEEP, FW_DO_IDLE_AFTR, diff --git a/arch/arm/mach-exynos/exynos.c b/arch/arm/mach-exynos/exynos.c index 4031a96..90ed2e5 100644 --- a/arch/arm/mach-exynos/exynos.c +++ b/arch/arm/mach-exynos/exynos.c @@ -117,6 +117,31 @@ static void __init exynos_init_late(void) exynos_pm_init(); } +#define REG_CPU_STATE_ADDR (sysram_ns_base_addr + 0x28) +#define BOOT_MODE_MASK 0x1f + +void exynos_set_boot_flag(unsigned int cpu, unsigned int mode) +{ + unsigned int tmp; + + tmp = __raw_readl(REG_CPU_STATE_ADDR + cpu * 4); + + if (mode & BOOT_MODE_MASK) + tmp &= ~BOOT_MODE_MASK; + + tmp |= mode; + __raw_writel(tmp, REG_CPU_STATE_ADDR + cpu * 4); +} + +void exynos_clear_boot_flag(unsigned int cpu, unsigned int mode) +{ + unsigned int tmp; + + tmp = __raw_readl(REG_CPU_STATE_ADDR + cpu * 4); + tmp &= ~mode; + __raw_writel(tmp, REG_CPU_STATE_ADDR + cpu * 4); +} + static int __init exynos_fdt_map_chipid(unsigned long node, const char *uname, int depth, void *data) { -- 1.8.2.3