From patchwork Tue Jan 15 08:13:13 2013
Content-Type: text/plain; charset="utf-8"
MIME-Version: 1.0
Content-Transfer-Encoding: 7bit
Subject: [v3,4/9] ARM: Add API to detect SCU base address from CP15
From: Hiroshi Doyu <hdoyu@nvidia.com>
X-Patchwork-Id: 212012
Message-Id: <1358237598-32413-5-git-send-email-hdoyu@nvidia.com>
To: <linux-tegra@vger.kernel.org>
Cc: <linux-arm-kernel@lists.infradead.org>,
 <lorenzo.pieralisi@arm.com>, <rob.herring@calxeda.com>,
 Hiroshi Doyu <hdoyu@nvidia.com>
Date: Tue, 15 Jan 2013 10:13:13 +0200

Add API to detect SCU base address from CP15.

Signed-off-by: Hiroshi Doyu <hdoyu@nvidia.com>

---
arch/arm/include/asm/smp_scu.h |   17 +++++++++++++++++
 1 file changed, 17 insertions(+)

diff --git a/arch/arm/include/asm/smp_scu.h b/arch/arm/include/asm/smp_scu.h
index 4eb6d00..f619eef 100644
--- a/arch/arm/include/asm/smp_scu.h
+++ b/arch/arm/include/asm/smp_scu.h
@@ -6,6 +6,23 @@
 #define SCU_PM_POWEROFF	3
 
 #ifndef __ASSEMBLER__
+
+#include <asm/cputype.h>
+
+static inline phys_addr_t scu_get_base(void)
+{
+	phys_addr_t pa;
+	unsigned long part_number = read_cpuid_part_number();
+
+	switch (part_number) {
+	case ARM_CPU_PART_CORTEX_A9:
+		/* Get SCU physical base */
+		asm("mrc p15, 4, %0, c15, c0, 0" : "=r" (pa));
+		return pa;
+	default:
+		return 0;
+	}
+}
 unsigned int scu_get_core_count(void __iomem *);
 void scu_enable(void __iomem *);
 int scu_power_mode(void __iomem *, unsigned int);