From 34b557dbd172172e3213d4140672363c44c44d05 Mon Sep 17 00:00:00 2001
From: Paul Mundt <lethal@linux-sh.org>
Date: Fri, 15 Jan 2010 16:31:04 +0900
Subject: [PATCH] --- yaml --- r: 181091 b: refs/heads/master c:
 6f832e8aab8c4c6d28629e970e4a85e74a8d0be6 h: refs/heads/master i:   181089:
 0b108018b37fac17b6c2056efdb44be3380b2daa   181087:
 ccde26564abc4c905f1ceeebe8a250245ae2956a v: v3

---
 [refs]                                    |  2 +-
 trunk/arch/sh/boards/mach-sdk7786/setup.c | 18 ++++++++++++++++++
 2 files changed, 19 insertions(+), 1 deletion(-)

diff --git a/[refs] b/[refs]
index adc79c25f606..ddac6680de54 100644
--- a/[refs]
+++ b/[refs]
@@ -1,2 +1,2 @@
 ---
-refs/heads/master: f0cb77372c3cf8c0cb17bbfb30a62506ea119286
+refs/heads/master: 6f832e8aab8c4c6d28629e970e4a85e74a8d0be6
diff --git a/trunk/arch/sh/boards/mach-sdk7786/setup.c b/trunk/arch/sh/boards/mach-sdk7786/setup.c
index f2d4b75bf31c..c38c6cc293b5 100644
--- a/trunk/arch/sh/boards/mach-sdk7786/setup.c
+++ b/trunk/arch/sh/boards/mach-sdk7786/setup.c
@@ -218,6 +218,23 @@ static void __init init_sdk7786_IRQ(void)
 	plat_irq_setup_pins(IRQ_MODE_IRL3210_MASK);
 }
 
+#define MODSWR_REGS	0x07fff830
+
+static int sdk7786_mode_pins(void)
+{
+	void __iomem *modswr;
+	int pin_states;
+
+	modswr = ioremap_nocache(MODSWR_REGS, SZ_16);
+	if (!modswr)
+		return -ENXIO;
+
+	pin_states = ioread16(modswr);
+	iounmap(modswr);
+
+	return pin_states;
+}
+
 /* Initialize the board */
 static void __init sdk7786_setup(char **cmdline_p)
 {
@@ -230,5 +247,6 @@ static void __init sdk7786_setup(char **cmdline_p)
 static struct sh_machine_vector mv_sdk7786 __initmv = {
 	.mv_name		= "SDK7786",
 	.mv_setup		= sdk7786_setup,
+	.mv_mode_pins		= sdk7786_mode_pins,
 	.mv_init_irq		= init_sdk7786_IRQ,
 };