[U-Boot] [PATCH 1/3] kirkwood: add kirkwood_mpp_save/restore functions

[Valentin Longchamp]

These 2 functions can be used in pair if one needs to set a mpp
configuration only for a given time and then switch back to the previous
mpp config.

Signed-off-by: Valentin Longchamp <valentin.longchamp at keymile.com>
cc: Holger Brunck <holger.brunck at keymile.com>
cc: Prafulla Wadaskar <prafulla at marvell.com>
---
 arch/arm/cpu/arm926ejs/kirkwood/mpp.c    |   18 ++++++++++++++++++
 arch/arm/include/asm/arch-kirkwood/mpp.h |    2 ++
 2 files changed, 20 insertions(+), 0 deletions(-)

diff --git a/arch/arm/cpu/arm926ejs/kirkwood/mpp.c b/arch/arm/cpu/arm926ejs/kirkwood/mpp.c
index 3da6c98..43f5053 100644
--- a/arch/arm/cpu/arm926ejs/kirkwood/mpp.c
+++ b/arch/arm/cpu/arm926ejs/kirkwood/mpp.c
@@ -80,3 +80,21 @@ void kirkwood_mpp_conf(u32 *mpp_list)
 	debug("\n");
 
 }
+
+u32 mpp_regs[MPP_NR_REGS];
+
+void kirkwood_mpp_save(void)
+{
+	int i;
+
+	for (i = 0; i < MPP_NR_REGS; i++)
+		mpp_regs[i] = readl(MPP_CTRL(i));
+}
+
+void kirkwood_mpp_restore(void)
+{
+	int i;
+
+	for (i = 0; i < MPP_NR_REGS; i++)
+		writel(mpp_regs[i], MPP_CTRL(i));
+}
diff --git a/arch/arm/include/asm/arch-kirkwood/mpp.h b/arch/arm/include/asm/arch-kirkwood/mpp.h
index b3c090e..da65b4d 100644
--- a/arch/arm/include/asm/arch-kirkwood/mpp.h
+++ b/arch/arm/include/asm/arch-kirkwood/mpp.h
@@ -313,5 +313,7 @@
 #define MPP_MAX			49
 
 void kirkwood_mpp_conf(unsigned int *mpp_list);
+void kirkwood_mpp_save(void);
+void kirkwood_mpp_restore(void);
 
 #endif
-- 
1.7.1