[ARM] pxa: support mfp of pxa935

Add and initialize the mfp setting of pxa935 chip.

Signed-off-by: Haojian Zhuang <haojian.zhuang@marvell.com>
Signed-off-by: Eric Miao <eric.y.miao@gmail.com>

2 files changed, 86 insertions, 1 deletions

diff --git a/arch/arm/mach-pxa/pxa930.c b/arch/arm/mach-pxa/pxa930.c
index 71131742fffd..064292008288 100644
--- a/arch/arm/mach-pxa/pxa930.c
+++ b/arch/arm/mach-pxa/pxa930.c
@@ -176,13 +176,30 @@ static struct mfp_addr_map pxa930_mfp_addr_map[] __initdata = {
         MFP_ADDR_END,
 };
 
+static struct mfp_addr_map pxa935_mfp_addr_map[] __initdata = {
+        MFP_ADDR(GPIO159, 0x0524),
+        MFP_ADDR(GPIO163, 0x0534),
+        MFP_ADDR(GPIO167, 0x0544),
+        MFP_ADDR(GPIO168, 0x0548),
+        MFP_ADDR(GPIO169, 0x054c),
+        MFP_ADDR(GPIO170, 0x0550),
+        MFP_ADDR(GPIO171, 0x0554),
+        MFP_ADDR(GPIO172, 0x0558),
+        MFP_ADDR(GPIO173, 0x055c),
+
+        MFP_ADDR_END,
+};
+
 static int __init pxa930_init(void)
 {
-        if (cpu_is_pxa930()) {
+        if (cpu_is_pxa930() || cpu_is_pxa935()) {
                 mfp_init_base(io_p2v(MFPR_BASE));
                 mfp_init_addr(pxa930_mfp_addr_map);
         }
 
+        if (cpu_is_pxa935())
+                mfp_init_addr(pxa935_mfp_addr_map);
+
         return 0;
 }
 
diff --git a/arch/arm/plat-pxa/include/plat/mfp.h b/arch/arm/plat-pxa/include/plat/mfp.h
index 08ad665460ba..22086e696e8e 100644
--- a/arch/arm/plat-pxa/include/plat/mfp.h
+++ b/arch/arm/plat-pxa/include/plat/mfp.h
@@ -150,6 +150,74 @@ enum {
         MFP_PIN_GPIO125,
         MFP_PIN_GPIO126,
         MFP_PIN_GPIO127,
+
+        MFP_PIN_GPIO128,
+        MFP_PIN_GPIO129,
+        MFP_PIN_GPIO130,
+        MFP_PIN_GPIO131,
+        MFP_PIN_GPIO132,
+        MFP_PIN_GPIO133,
+        MFP_PIN_GPIO134,
+        MFP_PIN_GPIO135,
+        MFP_PIN_GPIO136,
+        MFP_PIN_GPIO137,
+        MFP_PIN_GPIO138,
+        MFP_PIN_GPIO139,
+        MFP_PIN_GPIO140,
+        MFP_PIN_GPIO141,
+        MFP_PIN_GPIO142,
+        MFP_PIN_GPIO143,
+        MFP_PIN_GPIO144,
+        MFP_PIN_GPIO145,
+        MFP_PIN_GPIO146,
+        MFP_PIN_GPIO147,
+        MFP_PIN_GPIO148,
+        MFP_PIN_GPIO149,
+        MFP_PIN_GPIO150,
+        MFP_PIN_GPIO151,
+        MFP_PIN_GPIO152,
+        MFP_PIN_GPIO153,
+        MFP_PIN_GPIO154,
+        MFP_PIN_GPIO155,
+        MFP_PIN_GPIO156,
+        MFP_PIN_GPIO157,
+        MFP_PIN_GPIO158,
+        MFP_PIN_GPIO159,
+        MFP_PIN_GPIO160,
+        MFP_PIN_GPIO161,
+        MFP_PIN_GPIO162,
+        MFP_PIN_GPIO163,
+        MFP_PIN_GPIO164,
+        MFP_PIN_GPIO165,
+        MFP_PIN_GPIO166,
+        MFP_PIN_GPIO167,
+        MFP_PIN_GPIO168,
+        MFP_PIN_GPIO169,
+        MFP_PIN_GPIO170,
+        MFP_PIN_GPIO171,
+        MFP_PIN_GPIO172,
+        MFP_PIN_GPIO173,
+        MFP_PIN_GPIO174,
+        MFP_PIN_GPIO175,
+        MFP_PIN_GPIO176,
+        MFP_PIN_GPIO177,
+        MFP_PIN_GPIO178,
+        MFP_PIN_GPIO179,
+        MFP_PIN_GPIO180,
+        MFP_PIN_GPIO181,
+        MFP_PIN_GPIO182,
+        MFP_PIN_GPIO183,
+        MFP_PIN_GPIO184,
+        MFP_PIN_GPIO185,
+        MFP_PIN_GPIO186,
+        MFP_PIN_GPIO187,
+        MFP_PIN_GPIO188,
+        MFP_PIN_GPIO189,
+        MFP_PIN_GPIO190,
+        MFP_PIN_GPIO191,
+
+        MFP_PIN_GPIO255 = 255,
+
         MFP_PIN_GPIO0_2,
         MFP_PIN_GPIO1_2,
         MFP_PIN_GPIO2_2,