2 files changed, 214 insertions, 16 deletions
diff --git a/arch/arm/mach-mmp/include/mach/mfp-mmp2.h b/arch/arm/mach-mmp/include/mach/mfp-mmp2.h
index 9f9f8143e272..761c2dacc079 100644
--- a/arch/arm/mach-mmp/include/mach/mfp-mmp2.h
+++ b/arch/arm/mach-mmp/include/mach/mfp-mmp2.h
@@ -9,6 +9,175 @@
 #define MFP_DRIVE_FAST          (0x8 << 13)
 /* GPIO */
+#define GPIO0_GPIO0             MFP_CFG(GPIO0, AF0)
+#define GPIO1_GPIO1             MFP_CFG(GPIO1, AF0)
+#define GPIO2_GPIO2             MFP_CFG(GPIO2, AF0)
+#define GPIO3_GPIO3             MFP_CFG(GPIO3, AF0)
+#define GPIO4_GPIO4             MFP_CFG(GPIO4, AF0)
+#define GPIO5_GPIO5             MFP_CFG(GPIO5, AF0)
+#define GPIO6_GPIO6             MFP_CFG(GPIO6, AF0)
+#define GPIO7_GPIO7             MFP_CFG(GPIO7, AF0)
+#define GPIO8_GPIO8             MFP_CFG(GPIO8, AF0)
+#define GPIO9_GPIO9             MFP_CFG(GPIO9, AF0)
+#define GPIO10_GPIO10           MFP_CFG(GPIO10, AF0)
+#define GPIO11_GPIO11           MFP_CFG(GPIO11, AF0)
+#define GPIO12_GPIO12           MFP_CFG(GPIO12, AF0)
+#define GPIO13_GPIO13           MFP_CFG(GPIO13, AF0)
+#define GPIO14_GPIO14           MFP_CFG(GPIO14, AF0)
+#define GPIO15_GPIO15           MFP_CFG(GPIO15, AF0)
+#define GPIO16_GPIO16           MFP_CFG(GPIO16, AF0)
+#define GPIO17_GPIO17           MFP_CFG(GPIO17, AF0)
+#define GPIO18_GPIO18           MFP_CFG(GPIO18, AF0)
+#define GPIO19_GPIO19           MFP_CFG(GPIO19, AF0)
+#define GPIO20_GPIO20           MFP_CFG(GPIO20, AF0)
+#define GPIO21_GPIO21           MFP_CFG(GPIO21, AF0)
+#define GPIO22_GPIO22           MFP_CFG(GPIO22, AF0)
+#define GPIO23_GPIO23           MFP_CFG(GPIO23, AF0)
+#define GPIO24_GPIO24           MFP_CFG(GPIO24, AF0)
+#define GPIO25_GPIO25           MFP_CFG(GPIO25, AF0)
+#define GPIO26_GPIO26           MFP_CFG(GPIO26, AF0)
+#define GPIO27_GPIO27           MFP_CFG(GPIO27, AF0)
+#define GPIO28_GPIO28           MFP_CFG(GPIO28, AF0)
+#define GPIO29_GPIO29           MFP_CFG(GPIO29, AF0)
+#define GPIO30_GPIO30           MFP_CFG(GPIO30, AF0)
+#define GPIO31_GPIO31           MFP_CFG(GPIO31, AF0)
+#define GPIO32_GPIO32           MFP_CFG(GPIO32, AF0)
+#define GPIO33_GPIO33           MFP_CFG(GPIO33, AF0)
+#define GPIO34_GPIO34           MFP_CFG(GPIO34, AF0)
+#define GPIO35_GPIO35           MFP_CFG(GPIO35, AF0)
+#define GPIO36_GPIO36           MFP_CFG(GPIO36, AF0)
+#define GPIO37_GPIO37           MFP_CFG(GPIO37, AF0)
+#define GPIO38_GPIO38           MFP_CFG(GPIO38, AF0)
+#define GPIO39_GPIO39           MFP_CFG(GPIO39, AF0)
+#define GPIO40_GPIO40           MFP_CFG(GPIO40, AF0)
+#define GPIO41_GPIO41           MFP_CFG(GPIO41, AF0)
+#define GPIO42_GPIO42           MFP_CFG(GPIO42, AF0)
+#define GPIO43_GPIO43           MFP_CFG(GPIO43, AF0)
+#define GPIO44_GPIO44           MFP_CFG(GPIO44, AF0)
+#define GPIO45_GPIO45           MFP_CFG(GPIO45, AF0)
+#define GPIO46_GPIO46           MFP_CFG(GPIO46, AF0)
+#define GPIO47_GPIO47           MFP_CFG(GPIO47, AF0)
+#define GPIO48_GPIO48           MFP_CFG(GPIO48, AF0)
+#define GPIO49_GPIO49           MFP_CFG(GPIO49, AF0)
+#define GPIO50_GPIO50           MFP_CFG(GPIO50, AF0)
+#define GPIO51_GPIO51           MFP_CFG(GPIO51, AF0)
+#define GPIO52_GPIO52           MFP_CFG(GPIO52, AF0)
+#define GPIO53_GPIO53           MFP_CFG(GPIO53, AF0)
+#define GPIO54_GPIO54           MFP_CFG(GPIO54, AF0)
+#define GPIO55_GPIO55           MFP_CFG(GPIO55, AF0)
+#define GPIO56_GPIO56           MFP_CFG(GPIO56, AF0)
+#define GPIO57_GPIO57           MFP_CFG(GPIO57, AF0)
+#define GPIO58_GPIO58           MFP_CFG(GPIO58, AF0)
+#define GPIO59_GPIO59           MFP_CFG(GPIO59, AF0)
+#define GPIO60_GPIO60           MFP_CFG(GPIO60, AF0)
+#define GPIO61_GPIO61           MFP_CFG(GPIO61, AF0)
+#define GPIO62_GPIO62           MFP_CFG(GPIO62, AF0)
+#define GPIO63_GPIO63           MFP_CFG(GPIO63, AF0)
+#define GPIO64_GPIO64           MFP_CFG(GPIO64, AF0)
+#define GPIO65_GPIO65           MFP_CFG(GPIO65, AF0)
+#define GPIO66_GPIO66           MFP_CFG(GPIO66, AF0)
+#define GPIO67_GPIO67           MFP_CFG(GPIO67, AF0)
+#define GPIO68_GPIO68           MFP_CFG(GPIO68, AF0)
+#define GPIO69_GPIO69           MFP_CFG(GPIO69, AF0)
+#define GPIO70_GPIO70           MFP_CFG(GPIO70, AF0)
+#define GPIO71_GPIO71           MFP_CFG(GPIO71, AF0)
+#define GPIO72_GPIO72           MFP_CFG(GPIO72, AF0)
+#define GPIO73_GPIO73           MFP_CFG(GPIO73, AF0)
+#define GPIO74_GPIO74           MFP_CFG(GPIO74, AF0)
+#define GPIO75_GPIO75           MFP_CFG(GPIO75, AF0)
+#define GPIO76_GPIO76           MFP_CFG(GPIO76, AF0)
+#define GPIO77_GPIO77           MFP_CFG(GPIO77, AF0)
+#define GPIO78_GPIO78           MFP_CFG(GPIO78, AF0)
+#define GPIO79_GPIO79           MFP_CFG(GPIO79, AF0)
+#define GPIO80_GPIO80           MFP_CFG(GPIO80, AF0)
+#define GPIO81_GPIO81           MFP_CFG(GPIO81, AF0)
+#define GPIO82_GPIO82           MFP_CFG(GPIO82, AF0)
+#define GPIO83_GPIO83           MFP_CFG(GPIO83, AF0)
+#define GPIO84_GPIO84           MFP_CFG(GPIO84, AF0)
+#define GPIO85_GPIO85           MFP_CFG(GPIO85, AF0)
+#define GPIO86_GPIO86           MFP_CFG(GPIO86, AF0)
+#define GPIO87_GPIO87           MFP_CFG(GPIO87, AF0)
+#define GPIO88_GPIO88           MFP_CFG(GPIO88, AF0)
+#define GPIO89_GPIO89           MFP_CFG(GPIO89, AF0)
+#define GPIO90_GPIO90           MFP_CFG(GPIO90, AF0)
+#define GPIO91_GPIO91           MFP_CFG(GPIO91, AF0)
+#define GPIO92_GPIO92           MFP_CFG(GPIO92, AF0)
+#define GPIO93_GPIO93           MFP_CFG(GPIO93, AF0)
+#define GPIO94_GPIO94           MFP_CFG(GPIO94, AF0)
+#define GPIO95_GPIO95           MFP_CFG(GPIO95, AF0)
+#define GPIO96_GPIO96           MFP_CFG(GPIO96, AF0)
+#define GPIO97_GPIO97           MFP_CFG(GPIO97, AF0)
+#define GPIO98_GPIO98           MFP_CFG(GPIO98, AF0)
+#define GPIO99_GPIO99           MFP_CFG(GPIO99, AF0)
+#define GPIO100_GPIO100         MFP_CFG(GPIO100, AF0)
+#define GPIO101_GPIO101         MFP_CFG(GPIO101, AF0)
+#define GPIO102_GPIO102         MFP_CFG(GPIO102, AF1)
+#define GPIO103_GPIO103         MFP_CFG(GPIO103, AF1)
+#define GPIO104_GPIO104         MFP_CFG(GPIO104, AF1)
+#define GPIO105_GPIO105         MFP_CFG(GPIO105, AF1)
+#define GPIO106_GPIO106         MFP_CFG(GPIO106, AF1)
+#define GPIO107_GPIO107         MFP_CFG(GPIO107, AF1)
+#define GPIO108_GPIO108         MFP_CFG(GPIO108, AF1)
+#define GPIO109_GPIO109         MFP_CFG(GPIO109, AF1)
+#define GPIO110_GPIO110         MFP_CFG(GPIO110, AF1)
+#define GPIO111_GPIO111         MFP_CFG(GPIO111, AF1)
+#define GPIO112_GPIO112         MFP_CFG(GPIO112, AF1)
+#define GPIO113_GPIO113         MFP_CFG(GPIO113, AF1)
+#define GPIO114_GPIO114         MFP_CFG(GPIO114, AF0)
+#define GPIO115_GPIO115         MFP_CFG(GPIO115, AF0)
+#define GPIO116_GPIO116         MFP_CFG(GPIO116, AF0)
+#define GPIO117_GPIO117         MFP_CFG(GPIO117, AF0)
+#define GPIO118_GPIO118         MFP_CFG(GPIO118, AF0)
+#define GPIO119_GPIO119         MFP_CFG(GPIO119, AF0)
+#define GPIO120_GPIO120         MFP_CFG(GPIO120, AF0)
+#define GPIO121_GPIO121         MFP_CFG(GPIO121, AF0)
+#define GPIO122_GPIO122         MFP_CFG(GPIO122, AF0)
+#define GPIO123_GPIO123         MFP_CFG(GPIO123, AF0)
+#define GPIO124_GPIO124         MFP_CFG(GPIO124, AF0)
+#define GPIO125_GPIO125         MFP_CFG(GPIO125, AF0)
+#define GPIO126_GPIO126         MFP_CFG(GPIO126, AF0)
+#define GPIO127_GPIO127         MFP_CFG(GPIO127, AF0)
+#define GPIO128_GPIO128         MFP_CFG(GPIO128, AF0)
+#define GPIO129_GPIO129         MFP_CFG(GPIO129, AF0)
+#define GPIO130_GPIO130         MFP_CFG(GPIO130, AF0)
+#define GPIO131_GPIO131         MFP_CFG(GPIO131, AF0)
+#define GPIO132_GPIO132         MFP_CFG(GPIO132, AF0)
+#define GPIO133_GPIO133         MFP_CFG(GPIO133, AF0)
+#define GPIO134_GPIO134         MFP_CFG(GPIO134, AF0)
+#define GPIO135_GPIO135         MFP_CFG(GPIO135, AF0)
+#define GPIO136_GPIO136         MFP_CFG(GPIO136, AF0)
+#define GPIO137_GPIO137         MFP_CFG(GPIO137, AF0)
+#define GPIO138_GPIO138         MFP_CFG(GPIO138, AF0)
+#define GPIO139_GPIO139         MFP_CFG(GPIO139, AF0)
+#define GPIO140_GPIO140         MFP_CFG(GPIO140, AF0)
+#define GPIO141_GPIO141         MFP_CFG(GPIO141, AF0)
+#define GPIO142_GPIO142         MFP_CFG(GPIO142, AF1)
+#define GPIO143_GPIO143         MFP_CFG(GPIO143, AF1)
+#define GPIO144_GPIO144         MFP_CFG(GPIO144, AF1)
+#define GPIO145_GPIO145         MFP_CFG(GPIO145, AF1)
+#define GPIO146_GPIO146         MFP_CFG(GPIO146, AF1)
+#define GPIO147_GPIO147         MFP_CFG(GPIO147, AF1)
+#define GPIO148_GPIO148         MFP_CFG(GPIO148, AF1)
+#define GPIO149_GPIO149         MFP_CFG(GPIO149, AF1)
+#define GPIO150_GPIO150         MFP_CFG(GPIO150, AF1)
+#define GPIO151_GPIO151         MFP_CFG(GPIO151, AF1)
+#define GPIO152_GPIO152         MFP_CFG(GPIO152, AF1)
+#define GPIO153_GPIO153         MFP_CFG(GPIO153, AF1)
+#define GPIO154_GPIO154         MFP_CFG(GPIO154, AF1)
+#define GPIO155_GPIO155         MFP_CFG(GPIO155, AF1)
+#define GPIO156_GPIO156         MFP_CFG(GPIO156, AF1)
+#define GPIO157_GPIO157         MFP_CFG(GPIO157, AF1)
+#define GPIO158_GPIO158         MFP_CFG(GPIO158, AF1)
+#define GPIO159_GPIO159         MFP_CFG(GPIO159, AF1)
+#define GPIO160_GPIO160         MFP_CFG(GPIO160, AF1)
+#define GPIO161_GPIO161         MFP_CFG(GPIO161, AF1)
+#define GPIO162_GPIO162         MFP_CFG(GPIO162, AF1)
+#define GPIO163_GPIO163         MFP_CFG(GPIO163, AF1)
+#define GPIO164_GPIO164         MFP_CFG(GPIO164, AF1)
+#define GPIO165_GPIO165         MFP_CFG(GPIO165, AF1)
+#define GPIO166_GPIO166         MFP_CFG(GPIO166, AF1)
+#define GPIO167_GPIO167         MFP_CFG(GPIO167, AF1)
+#define GPIO168_GPIO168         MFP_CFG(GPIO168, AF1)
 /* DFI */
 #define GPIO108_DFI_D15         MFP_CFG(GPIO108, AF0)
@@ -47,7 +216,6 @@
 /* Ethernet */
 #define GPIO155_SM_ADVMUX       MFP_CFG(GPIO155, AF2)
-#define GPIO155_GPIO155         MFP_CFG(GPIO155, AF1)
 /* UART1 */
 #define GPIO45_UART1_RXD        MFP_CFG(GPIO45, AF1)
@@ -159,6 +327,8 @@
 #define GPIO44_TWSI2_SDA        MFP_CFG_DRV(GPIO44, AF1, SLOW)
 #define GPIO71_TWSI3_SCL        MFP_CFG_DRV(GPIO71, AF1, SLOW)
 #define GPIO72_TWSI3_SDA        MFP_CFG_DRV(GPIO72, AF1, SLOW)
+#define TWSI4_SCL               MFP_CFG_DRV(TWSI4_SCL, AF0, SLOW)
+#define TWSI4_SDA               MFP_CFG_DRV(TWSI4_SDA, AF0, SLOW)
 #define GPIO99_TWSI5_SCL        MFP_CFG_DRV(GPIO99, AF4, SLOW)
 #define GPIO100_TWSI5_SDA       MFP_CFG_DRV(GPIO100, AF4, SLOW)
 #define GPIO97_TWSI6_SCL        MFP_CFG_DRV(GPIO97, AF2, SLOW)
@@ -218,21 +388,6 @@
 #define GPIO69_CAM_MCLK         MFP_CFG_DRV(GPIO69, AF1, FAST)
 #define GPIO70_CAM_PCLK         MFP_CFG_DRV(GPIO70, AF1, FAST)
-/* Wifi */
-#define GPIO45_GPIO45           MFP_CFG(GPIO45, AF0)
-#define GPIO46_GPIO46           MFP_CFG(GPIO46, AF0)
-#define GPIO21_GPIO21           MFP_CFG(GPIO21, AF0)
-#define GPIO22_GPIO22           MFP_CFG(GPIO22, AF0)
-#define GPIO55_GPIO55           MFP_CFG(GPIO55, AF0)
-#define GPIO56_GPIO56           MFP_CFG(GPIO56, AF0)
-#define GPIO57_GPIO57           MFP_CFG(GPIO57, AF0)
-#define GPIO58_GPIO58           MFP_CFG(GPIO58, AF0)
-/* Codec*/
-#define GPIO23_GPIO23           MFP_CFG(GPIO23, AF0)
-#define GPIO101_GPIO101         MFP_CFG(GPIO101, AF0)
 /* PMIC */
 #define PMIC_PMIC_INT           MFP_CFG(PMIC_INT, AF0)
diff --git a/arch/arm/mach-mmp/mmp2.c b/arch/arm/mach-mmp/mmp2.c
index e236ec0c54f6..da5cd9d10807 100644
--- a/arch/arm/mach-mmp/mmp2.c
+++ b/arch/arm/mach-mmp/mmp2.c
@@ -34,7 +34,50 @@
 #define APMASK(i)       (GPIO_REGS_VIRT + BANK_OFF(i) + 0x9c)
 static struct mfp_addr_map mmp2_addr_map[] __initdata = {
+        MFP_ADDR_X(GPIO0, GPIO58, 0x54),
+        MFP_ADDR_X(GPIO59, GPIO73, 0x280),
+        MFP_ADDR_X(GPIO74, GPIO101, 0x170),
+        MFP_ADDR(GPIO102, 0x0),
+        MFP_ADDR(GPIO103, 0x4),
+        MFP_ADDR(GPIO104, 0x1fc),
+        MFP_ADDR(GPIO105, 0x1f8),
+        MFP_ADDR(GPIO106, 0x1f4),
+        MFP_ADDR(GPIO107, 0x1f0),
+        MFP_ADDR(GPIO108, 0x21c),
+        MFP_ADDR(GPIO109, 0x218),
+        MFP_ADDR(GPIO110, 0x214),
+        MFP_ADDR(GPIO111, 0x200),
+        MFP_ADDR(GPIO112, 0x244),
+        MFP_ADDR(GPIO113, 0x25c),
+        MFP_ADDR(GPIO114, 0x164),
+        MFP_ADDR_X(GPIO115, GPIO122, 0x260),
+        MFP_ADDR(GPIO123, 0x148),
+        MFP_ADDR_X(GPIO124, GPIO141, 0xc),
+        MFP_ADDR(GPIO142, 0x8),
+        MFP_ADDR_X(GPIO143, GPIO151, 0x220),
+        MFP_ADDR_X(GPIO152, GPIO153, 0x248),
+        MFP_ADDR_X(GPIO154, GPIO155, 0x254),
+        MFP_ADDR_X(GPIO156, GPIO159, 0x14c),
+        MFP_ADDR(GPIO160, 0x250),
+        MFP_ADDR(GPIO161, 0x210),
+        MFP_ADDR(GPIO162, 0x20c),
+        MFP_ADDR(GPIO163, 0x208),
+        MFP_ADDR(GPIO164, 0x204),
+        MFP_ADDR(GPIO165, 0x1ec),
+        MFP_ADDR(GPIO166, 0x1e8),
+        MFP_ADDR(GPIO167, 0x1e4),
+        MFP_ADDR(GPIO168, 0x1e0),
+        MFP_ADDR_X(TWSI1_SCL, TWSI1_SDA, 0x140),
+        MFP_ADDR_X(TWSI4_SCL, TWSI4_SDA, 0x2bc),
        MFP_ADDR(PMIC_INT, 0x2c4),
+        MFP_ADDR(CLK_REQ, 0x160),
        MFP_ADDR_END,
 };

diff --git a/arch/arm/mach-mmp/include/mach/mfp-mmp2.h b/arch/arm/mach-mmp/include/mach/mfp-mmp2.h index 9f9f8143e272..761c2dacc079 100644 --- a/arch/arm/mach-mmp/include/mach/mfp-mmp2.h +++ b/arch/arm/mach-mmp/include/mach/mfp-mmp2.h
@@ -9,6 +9,175 @@
9	#define MFP_DRIVE_FAST (0x8 << 13)	9	#define MFP_DRIVE_FAST (0x8 << 13)
10		10
11	/* GPIO */	11	/* GPIO */
		12	#define GPIO0_GPIO0 MFP_CFG(GPIO0, AF0)
		13	#define GPIO1_GPIO1 MFP_CFG(GPIO1, AF0)
		14	#define GPIO2_GPIO2 MFP_CFG(GPIO2, AF0)
		15	#define GPIO3_GPIO3 MFP_CFG(GPIO3, AF0)
		16	#define GPIO4_GPIO4 MFP_CFG(GPIO4, AF0)
		17	#define GPIO5_GPIO5 MFP_CFG(GPIO5, AF0)
		18	#define GPIO6_GPIO6 MFP_CFG(GPIO6, AF0)
		19	#define GPIO7_GPIO7 MFP_CFG(GPIO7, AF0)
		20	#define GPIO8_GPIO8 MFP_CFG(GPIO8, AF0)
		21	#define GPIO9_GPIO9 MFP_CFG(GPIO9, AF0)
		22	#define GPIO10_GPIO10 MFP_CFG(GPIO10, AF0)
		23	#define GPIO11_GPIO11 MFP_CFG(GPIO11, AF0)
		24	#define GPIO12_GPIO12 MFP_CFG(GPIO12, AF0)
		25	#define GPIO13_GPIO13 MFP_CFG(GPIO13, AF0)
		26	#define GPIO14_GPIO14 MFP_CFG(GPIO14, AF0)
		27	#define GPIO15_GPIO15 MFP_CFG(GPIO15, AF0)
		28	#define GPIO16_GPIO16 MFP_CFG(GPIO16, AF0)
		29	#define GPIO17_GPIO17 MFP_CFG(GPIO17, AF0)
		30	#define GPIO18_GPIO18 MFP_CFG(GPIO18, AF0)
		31	#define GPIO19_GPIO19 MFP_CFG(GPIO19, AF0)
		32	#define GPIO20_GPIO20 MFP_CFG(GPIO20, AF0)
		33	#define GPIO21_GPIO21 MFP_CFG(GPIO21, AF0)
		34	#define GPIO22_GPIO22 MFP_CFG(GPIO22, AF0)
		35	#define GPIO23_GPIO23 MFP_CFG(GPIO23, AF0)
		36	#define GPIO24_GPIO24 MFP_CFG(GPIO24, AF0)
		37	#define GPIO25_GPIO25 MFP_CFG(GPIO25, AF0)
		38	#define GPIO26_GPIO26 MFP_CFG(GPIO26, AF0)
		39	#define GPIO27_GPIO27 MFP_CFG(GPIO27, AF0)
		40	#define GPIO28_GPIO28 MFP_CFG(GPIO28, AF0)
		41	#define GPIO29_GPIO29 MFP_CFG(GPIO29, AF0)
		42	#define GPIO30_GPIO30 MFP_CFG(GPIO30, AF0)
		43	#define GPIO31_GPIO31 MFP_CFG(GPIO31, AF0)
		44	#define GPIO32_GPIO32 MFP_CFG(GPIO32, AF0)
		45	#define GPIO33_GPIO33 MFP_CFG(GPIO33, AF0)
		46	#define GPIO34_GPIO34 MFP_CFG(GPIO34, AF0)
		47	#define GPIO35_GPIO35 MFP_CFG(GPIO35, AF0)
		48	#define GPIO36_GPIO36 MFP_CFG(GPIO36, AF0)
		49	#define GPIO37_GPIO37 MFP_CFG(GPIO37, AF0)
		50	#define GPIO38_GPIO38 MFP_CFG(GPIO38, AF0)
		51	#define GPIO39_GPIO39 MFP_CFG(GPIO39, AF0)
		52	#define GPIO40_GPIO40 MFP_CFG(GPIO40, AF0)
		53	#define GPIO41_GPIO41 MFP_CFG(GPIO41, AF0)
		54	#define GPIO42_GPIO42 MFP_CFG(GPIO42, AF0)
		55	#define GPIO43_GPIO43 MFP_CFG(GPIO43, AF0)
		56	#define GPIO44_GPIO44 MFP_CFG(GPIO44, AF0)
		57	#define GPIO45_GPIO45 MFP_CFG(GPIO45, AF0)
		58	#define GPIO46_GPIO46 MFP_CFG(GPIO46, AF0)
		59	#define GPIO47_GPIO47 MFP_CFG(GPIO47, AF0)
		60	#define GPIO48_GPIO48 MFP_CFG(GPIO48, AF0)
		61	#define GPIO49_GPIO49 MFP_CFG(GPIO49, AF0)
		62	#define GPIO50_GPIO50 MFP_CFG(GPIO50, AF0)
		63	#define GPIO51_GPIO51 MFP_CFG(GPIO51, AF0)
		64	#define GPIO52_GPIO52 MFP_CFG(GPIO52, AF0)
		65	#define GPIO53_GPIO53 MFP_CFG(GPIO53, AF0)
		66	#define GPIO54_GPIO54 MFP_CFG(GPIO54, AF0)
		67	#define GPIO55_GPIO55 MFP_CFG(GPIO55, AF0)
		68	#define GPIO56_GPIO56 MFP_CFG(GPIO56, AF0)
		69	#define GPIO57_GPIO57 MFP_CFG(GPIO57, AF0)
		70	#define GPIO58_GPIO58 MFP_CFG(GPIO58, AF0)
		71	#define GPIO59_GPIO59 MFP_CFG(GPIO59, AF0)
		72	#define GPIO60_GPIO60 MFP_CFG(GPIO60, AF0)
		73	#define GPIO61_GPIO61 MFP_CFG(GPIO61, AF0)
		74	#define GPIO62_GPIO62 MFP_CFG(GPIO62, AF0)
		75	#define GPIO63_GPIO63 MFP_CFG(GPIO63, AF0)
		76	#define GPIO64_GPIO64 MFP_CFG(GPIO64, AF0)
		77	#define GPIO65_GPIO65 MFP_CFG(GPIO65, AF0)
		78	#define GPIO66_GPIO66 MFP_CFG(GPIO66, AF0)
		79	#define GPIO67_GPIO67 MFP_CFG(GPIO67, AF0)
		80	#define GPIO68_GPIO68 MFP_CFG(GPIO68, AF0)
		81	#define GPIO69_GPIO69 MFP_CFG(GPIO69, AF0)
		82	#define GPIO70_GPIO70 MFP_CFG(GPIO70, AF0)
		83	#define GPIO71_GPIO71 MFP_CFG(GPIO71, AF0)
		84	#define GPIO72_GPIO72 MFP_CFG(GPIO72, AF0)
		85	#define GPIO73_GPIO73 MFP_CFG(GPIO73, AF0)
		86	#define GPIO74_GPIO74 MFP_CFG(GPIO74, AF0)
		87	#define GPIO75_GPIO75 MFP_CFG(GPIO75, AF0)
		88	#define GPIO76_GPIO76 MFP_CFG(GPIO76, AF0)
		89	#define GPIO77_GPIO77 MFP_CFG(GPIO77, AF0)
		90	#define GPIO78_GPIO78 MFP_CFG(GPIO78, AF0)
		91	#define GPIO79_GPIO79 MFP_CFG(GPIO79, AF0)
		92	#define GPIO80_GPIO80 MFP_CFG(GPIO80, AF0)
		93	#define GPIO81_GPIO81 MFP_CFG(GPIO81, AF0)
		94	#define GPIO82_GPIO82 MFP_CFG(GPIO82, AF0)
		95	#define GPIO83_GPIO83 MFP_CFG(GPIO83, AF0)
		96	#define GPIO84_GPIO84 MFP_CFG(GPIO84, AF0)
		97	#define GPIO85_GPIO85 MFP_CFG(GPIO85, AF0)
		98	#define GPIO86_GPIO86 MFP_CFG(GPIO86, AF0)
		99	#define GPIO87_GPIO87 MFP_CFG(GPIO87, AF0)
		100	#define GPIO88_GPIO88 MFP_CFG(GPIO88, AF0)
		101	#define GPIO89_GPIO89 MFP_CFG(GPIO89, AF0)
		102	#define GPIO90_GPIO90 MFP_CFG(GPIO90, AF0)
		103	#define GPIO91_GPIO91 MFP_CFG(GPIO91, AF0)
		104	#define GPIO92_GPIO92 MFP_CFG(GPIO92, AF0)
		105	#define GPIO93_GPIO93 MFP_CFG(GPIO93, AF0)
		106	#define GPIO94_GPIO94 MFP_CFG(GPIO94, AF0)
		107	#define GPIO95_GPIO95 MFP_CFG(GPIO95, AF0)
		108	#define GPIO96_GPIO96 MFP_CFG(GPIO96, AF0)
		109	#define GPIO97_GPIO97 MFP_CFG(GPIO97, AF0)
		110	#define GPIO98_GPIO98 MFP_CFG(GPIO98, AF0)
		111	#define GPIO99_GPIO99 MFP_CFG(GPIO99, AF0)
		112	#define GPIO100_GPIO100 MFP_CFG(GPIO100, AF0)
		113	#define GPIO101_GPIO101 MFP_CFG(GPIO101, AF0)
		114	#define GPIO102_GPIO102 MFP_CFG(GPIO102, AF1)
		115	#define GPIO103_GPIO103 MFP_CFG(GPIO103, AF1)
		116	#define GPIO104_GPIO104 MFP_CFG(GPIO104, AF1)
		117	#define GPIO105_GPIO105 MFP_CFG(GPIO105, AF1)
		118	#define GPIO106_GPIO106 MFP_CFG(GPIO106, AF1)
		119	#define GPIO107_GPIO107 MFP_CFG(GPIO107, AF1)
		120	#define GPIO108_GPIO108 MFP_CFG(GPIO108, AF1)
		121	#define GPIO109_GPIO109 MFP_CFG(GPIO109, AF1)
		122	#define GPIO110_GPIO110 MFP_CFG(GPIO110, AF1)
		123	#define GPIO111_GPIO111 MFP_CFG(GPIO111, AF1)
		124	#define GPIO112_GPIO112 MFP_CFG(GPIO112, AF1)
		125	#define GPIO113_GPIO113 MFP_CFG(GPIO113, AF1)
		126	#define GPIO114_GPIO114 MFP_CFG(GPIO114, AF0)
		127	#define GPIO115_GPIO115 MFP_CFG(GPIO115, AF0)
		128	#define GPIO116_GPIO116 MFP_CFG(GPIO116, AF0)
		129	#define GPIO117_GPIO117 MFP_CFG(GPIO117, AF0)
		130	#define GPIO118_GPIO118 MFP_CFG(GPIO118, AF0)
		131	#define GPIO119_GPIO119 MFP_CFG(GPIO119, AF0)
		132	#define GPIO120_GPIO120 MFP_CFG(GPIO120, AF0)
		133	#define GPIO121_GPIO121 MFP_CFG(GPIO121, AF0)
		134	#define GPIO122_GPIO122 MFP_CFG(GPIO122, AF0)
		135	#define GPIO123_GPIO123 MFP_CFG(GPIO123, AF0)
		136	#define GPIO124_GPIO124 MFP_CFG(GPIO124, AF0)
		137	#define GPIO125_GPIO125 MFP_CFG(GPIO125, AF0)
		138	#define GPIO126_GPIO126 MFP_CFG(GPIO126, AF0)
		139	#define GPIO127_GPIO127 MFP_CFG(GPIO127, AF0)
		140	#define GPIO128_GPIO128 MFP_CFG(GPIO128, AF0)
		141	#define GPIO129_GPIO129 MFP_CFG(GPIO129, AF0)
		142	#define GPIO130_GPIO130 MFP_CFG(GPIO130, AF0)
		143	#define GPIO131_GPIO131 MFP_CFG(GPIO131, AF0)
		144	#define GPIO132_GPIO132 MFP_CFG(GPIO132, AF0)
		145	#define GPIO133_GPIO133 MFP_CFG(GPIO133, AF0)
		146	#define GPIO134_GPIO134 MFP_CFG(GPIO134, AF0)
		147	#define GPIO135_GPIO135 MFP_CFG(GPIO135, AF0)
		148	#define GPIO136_GPIO136 MFP_CFG(GPIO136, AF0)
		149	#define GPIO137_GPIO137 MFP_CFG(GPIO137, AF0)
		150	#define GPIO138_GPIO138 MFP_CFG(GPIO138, AF0)
		151	#define GPIO139_GPIO139 MFP_CFG(GPIO139, AF0)
		152	#define GPIO140_GPIO140 MFP_CFG(GPIO140, AF0)
		153	#define GPIO141_GPIO141 MFP_CFG(GPIO141, AF0)
		154	#define GPIO142_GPIO142 MFP_CFG(GPIO142, AF1)
		155	#define GPIO143_GPIO143 MFP_CFG(GPIO143, AF1)
		156	#define GPIO144_GPIO144 MFP_CFG(GPIO144, AF1)
		157	#define GPIO145_GPIO145 MFP_CFG(GPIO145, AF1)
		158	#define GPIO146_GPIO146 MFP_CFG(GPIO146, AF1)
		159	#define GPIO147_GPIO147 MFP_CFG(GPIO147, AF1)
		160	#define GPIO148_GPIO148 MFP_CFG(GPIO148, AF1)
		161	#define GPIO149_GPIO149 MFP_CFG(GPIO149, AF1)
		162	#define GPIO150_GPIO150 MFP_CFG(GPIO150, AF1)
		163	#define GPIO151_GPIO151 MFP_CFG(GPIO151, AF1)
		164	#define GPIO152_GPIO152 MFP_CFG(GPIO152, AF1)
		165	#define GPIO153_GPIO153 MFP_CFG(GPIO153, AF1)
		166	#define GPIO154_GPIO154 MFP_CFG(GPIO154, AF1)
		167	#define GPIO155_GPIO155 MFP_CFG(GPIO155, AF1)
		168	#define GPIO156_GPIO156 MFP_CFG(GPIO156, AF1)
		169	#define GPIO157_GPIO157 MFP_CFG(GPIO157, AF1)
		170	#define GPIO158_GPIO158 MFP_CFG(GPIO158, AF1)
		171	#define GPIO159_GPIO159 MFP_CFG(GPIO159, AF1)
		172	#define GPIO160_GPIO160 MFP_CFG(GPIO160, AF1)
		173	#define GPIO161_GPIO161 MFP_CFG(GPIO161, AF1)
		174	#define GPIO162_GPIO162 MFP_CFG(GPIO162, AF1)
		175	#define GPIO163_GPIO163 MFP_CFG(GPIO163, AF1)
		176	#define GPIO164_GPIO164 MFP_CFG(GPIO164, AF1)
		177	#define GPIO165_GPIO165 MFP_CFG(GPIO165, AF1)
		178	#define GPIO166_GPIO166 MFP_CFG(GPIO166, AF1)
		179	#define GPIO167_GPIO167 MFP_CFG(GPIO167, AF1)
		180	#define GPIO168_GPIO168 MFP_CFG(GPIO168, AF1)
12		181
13	/* DFI */	182	/* DFI */
14	#define GPIO108_DFI_D15 MFP_CFG(GPIO108, AF0)	183	#define GPIO108_DFI_D15 MFP_CFG(GPIO108, AF0)
@@ -47,7 +216,6 @@
47		216
48	/* Ethernet */	217	/* Ethernet */
49	#define GPIO155_SM_ADVMUX MFP_CFG(GPIO155, AF2)	218	#define GPIO155_SM_ADVMUX MFP_CFG(GPIO155, AF2)
50	#define GPIO155_GPIO155 MFP_CFG(GPIO155, AF1)
51		219
52	/* UART1 */	220	/* UART1 */
53	#define GPIO45_UART1_RXD MFP_CFG(GPIO45, AF1)	221	#define GPIO45_UART1_RXD MFP_CFG(GPIO45, AF1)
@@ -159,6 +327,8 @@
159	#define GPIO44_TWSI2_SDA MFP_CFG_DRV(GPIO44, AF1, SLOW)	327	#define GPIO44_TWSI2_SDA MFP_CFG_DRV(GPIO44, AF1, SLOW)
160	#define GPIO71_TWSI3_SCL MFP_CFG_DRV(GPIO71, AF1, SLOW)	328	#define GPIO71_TWSI3_SCL MFP_CFG_DRV(GPIO71, AF1, SLOW)
161	#define GPIO72_TWSI3_SDA MFP_CFG_DRV(GPIO72, AF1, SLOW)	329	#define GPIO72_TWSI3_SDA MFP_CFG_DRV(GPIO72, AF1, SLOW)
		330	#define TWSI4_SCL MFP_CFG_DRV(TWSI4_SCL, AF0, SLOW)
		331	#define TWSI4_SDA MFP_CFG_DRV(TWSI4_SDA, AF0, SLOW)
162	#define GPIO99_TWSI5_SCL MFP_CFG_DRV(GPIO99, AF4, SLOW)	332	#define GPIO99_TWSI5_SCL MFP_CFG_DRV(GPIO99, AF4, SLOW)
163	#define GPIO100_TWSI5_SDA MFP_CFG_DRV(GPIO100, AF4, SLOW)	333	#define GPIO100_TWSI5_SDA MFP_CFG_DRV(GPIO100, AF4, SLOW)
164	#define GPIO97_TWSI6_SCL MFP_CFG_DRV(GPIO97, AF2, SLOW)	334	#define GPIO97_TWSI6_SCL MFP_CFG_DRV(GPIO97, AF2, SLOW)
@@ -218,21 +388,6 @@
218	#define GPIO69_CAM_MCLK MFP_CFG_DRV(GPIO69, AF1, FAST)	388	#define GPIO69_CAM_MCLK MFP_CFG_DRV(GPIO69, AF1, FAST)
219	#define GPIO70_CAM_PCLK MFP_CFG_DRV(GPIO70, AF1, FAST)	389	#define GPIO70_CAM_PCLK MFP_CFG_DRV(GPIO70, AF1, FAST)
220		390
221	/* Wifi */
222	#define GPIO45_GPIO45 MFP_CFG(GPIO45, AF0)
223	#define GPIO46_GPIO46 MFP_CFG(GPIO46, AF0)
224	#define GPIO21_GPIO21 MFP_CFG(GPIO21, AF0)
225	#define GPIO22_GPIO22 MFP_CFG(GPIO22, AF0)
226	#define GPIO55_GPIO55 MFP_CFG(GPIO55, AF0)
227	#define GPIO56_GPIO56 MFP_CFG(GPIO56, AF0)
228	#define GPIO57_GPIO57 MFP_CFG(GPIO57, AF0)
229	#define GPIO58_GPIO58 MFP_CFG(GPIO58, AF0)
230
231	/* Codec*/
232	#define GPIO23_GPIO23 MFP_CFG(GPIO23, AF0)
233
234	#define GPIO101_GPIO101 MFP_CFG(GPIO101, AF0)
235
236	/* PMIC */	391	/* PMIC */
237	#define PMIC_PMIC_INT MFP_CFG(PMIC_INT, AF0)	392	#define PMIC_PMIC_INT MFP_CFG(PMIC_INT, AF0)
238		393


diff --git a/arch/arm/mach-mmp/mmp2.c b/arch/arm/mach-mmp/mmp2.c index e236ec0c54f6..da5cd9d10807 100644 --- a/arch/arm/mach-mmp/mmp2.c +++ b/arch/arm/mach-mmp/mmp2.c
@@ -34,7 +34,50 @@
34	#define APMASK(i) (GPIO_REGS_VIRT + BANK_OFF(i) + 0x9c)	34	#define APMASK(i) (GPIO_REGS_VIRT + BANK_OFF(i) + 0x9c)
35		35
36	static struct mfp_addr_map mmp2_addr_map[] __initdata = {	36	static struct mfp_addr_map mmp2_addr_map[] __initdata = {
		37
		38	MFP_ADDR_X(GPIO0, GPIO58, 0x54),
		39	MFP_ADDR_X(GPIO59, GPIO73, 0x280),
		40	MFP_ADDR_X(GPIO74, GPIO101, 0x170),
		41
		42	MFP_ADDR(GPIO102, 0x0),
		43	MFP_ADDR(GPIO103, 0x4),
		44	MFP_ADDR(GPIO104, 0x1fc),
		45	MFP_ADDR(GPIO105, 0x1f8),
		46	MFP_ADDR(GPIO106, 0x1f4),
		47	MFP_ADDR(GPIO107, 0x1f0),
		48	MFP_ADDR(GPIO108, 0x21c),
		49	MFP_ADDR(GPIO109, 0x218),
		50	MFP_ADDR(GPIO110, 0x214),
		51	MFP_ADDR(GPIO111, 0x200),
		52	MFP_ADDR(GPIO112, 0x244),
		53	MFP_ADDR(GPIO113, 0x25c),
		54	MFP_ADDR(GPIO114, 0x164),
		55	MFP_ADDR_X(GPIO115, GPIO122, 0x260),
		56
		57	MFP_ADDR(GPIO123, 0x148),
		58	MFP_ADDR_X(GPIO124, GPIO141, 0xc),
		59
		60	MFP_ADDR(GPIO142, 0x8),
		61	MFP_ADDR_X(GPIO143, GPIO151, 0x220),
		62	MFP_ADDR_X(GPIO152, GPIO153, 0x248),
		63	MFP_ADDR_X(GPIO154, GPIO155, 0x254),
		64	MFP_ADDR_X(GPIO156, GPIO159, 0x14c),
		65
		66	MFP_ADDR(GPIO160, 0x250),
		67	MFP_ADDR(GPIO161, 0x210),
		68	MFP_ADDR(GPIO162, 0x20c),
		69	MFP_ADDR(GPIO163, 0x208),
		70	MFP_ADDR(GPIO164, 0x204),
		71	MFP_ADDR(GPIO165, 0x1ec),
		72	MFP_ADDR(GPIO166, 0x1e8),
		73	MFP_ADDR(GPIO167, 0x1e4),
		74	MFP_ADDR(GPIO168, 0x1e0),
		75
		76	MFP_ADDR_X(TWSI1_SCL, TWSI1_SDA, 0x140),
		77	MFP_ADDR_X(TWSI4_SCL, TWSI4_SDA, 0x2bc),
		78
37	MFP_ADDR(PMIC_INT, 0x2c4),	79	MFP_ADDR(PMIC_INT, 0x2c4),
		80	MFP_ADDR(CLK_REQ, 0x160),
38		81
39	MFP_ADDR_END,	82	MFP_ADDR_END,
40	};	83	};