[PATCH v2 1/3] ARM: asm: Add convenience fucntions to access VBAR

[Andrey Smirnov]

Add two functions to get/set VBAR register.

Signed-off-by: Andrey Smirnov <andrew.smirnov at gmail.com>
---

Changes since v1 (http://lists.infradead.org/pipermail/barebox/2015-December/025685.html):

 - Use CONFIG_CPU_32v7 instead of __LINUX_ARM_ARCH__

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

diff --git a/arch/arm/include/asm/system.h b/arch/arm/include/asm/system.h
index 26fb18c..b118a42 100644
--- a/arch/arm/include/asm/system.h
+++ b/arch/arm/include/asm/system.h
@@ -71,6 +71,26 @@ static inline void set_cr(unsigned int val)
 	isb();
 }

+#ifdef CONFIG_CPU_32v7
+static inline unsigned int get_vbar(void)
+{
+	unsigned int vbar;
+	asm volatile("mrc p15, 0, %0, c12, c0, 0 @ get VBAR"
+		     : "=r" (vbar) : : "cc");
+	return vbar;
+}
+
+static inline void set_vbar(unsigned int vbar)
+{
+	asm volatile("mcr p15, 0, %0, c12, c0, 0 @ set VBAR"
+		     : : "r" (vbar) : "cc");
+	isb();
+}
+#else
+static inline unsigned int get_vbar(void) { return 0; }
+static inline void set_vbar(unsigned int vbar) {}
+#endif
+
 #endif

 #endif /* __ASM_ARM_SYSTEM_H */
--
2.5.0