1 files changed, 143 insertions, 10 deletions

diff --git a/arch/arm/mach-shmobile/board-g4evm.c b/arch/arm/mach-shmobile/board-g4evm.c
index 10673a90be52..2c3ff6f7f34c 100644
--- a/arch/arm/mach-shmobile/board-g4evm.c
+++ b/arch/arm/mach-shmobile/board-g4evm.c
@@ -30,12 +30,39 @@
 #include <linux/io.h>
 #include <linux/input.h>
 #include <linux/input/sh_keysc.h>
+#include <linux/mfd/sh_mobile_sdhi.h>
 #include <linux/gpio.h>
 #include <mach/sh7377.h>
 #include <mach/common.h>
 #include <asm/mach-types.h>
 #include <asm/mach/arch.h>
 #include <asm/mach/map.h>
+#include <asm/mach/time.h>
+
+/*
+ * SDHI
+ *
+ * SDHI0 : card detection is possible
+ * SDHI1 : card detection is impossible
+ *
+ * [G4-MAIN-BOARD]
+ * JP74 : short         # DBG_2V8A    for SDHI0
+ * JP75 : NC            # DBG_3V3A    for SDHI0
+ * JP76 : NC            # DBG_3V3A_SD for SDHI0
+ * JP77 : NC            # 3V3A_SDIO   for SDHI1
+ * JP78 : short         # DBG_2V8A    for SDHI1
+ * JP79 : NC            # DBG_3V3A    for SDHI1
+ * JP80 : NC            # DBG_3V3A_SD for SDHI1
+ *
+ * [G4-CORE-BOARD]
+ * S32 : all off        # to dissever from G3-CORE_DBG board
+ * S33 : all off        # to dissever from G3-CORE_DBG board
+ *
+ * [G3-CORE_DBG-BOARD]
+ * S1  : all off        # to dissever from G3-CORE_DBG board
+ * S3  : all off        # to dissever from G3-CORE_DBG board
+ * S4  : all off        # to dissever from G3-CORE_DBG board
+ */
 
 static struct mtd_partition nor_flash_partitions[] = {
         {
@@ -90,7 +117,7 @@ static struct platform_device nor_flash_device = {
 };
 
 /* USBHS */
-void usb_host_port_power(int port, int power)
+static void usb_host_port_power(int port, int power)
 {
         if (!power) /* only power-on supported for now */
                 return;
@@ -112,8 +139,7 @@ static struct resource usb_host_resources[] = {
                 .flags  = IORESOURCE_MEM,
         },
         [1] = {
-                .start  = 65,
-                .end    = 65,
+                .start  = evt2irq(0x0a20), /* USBHS_USHI0 */
                 .flags  = IORESOURCE_IRQ,
         },
 };
@@ -154,7 +180,7 @@ static struct resource keysc_resources[] = {
                 .flags  = IORESOURCE_MEM,
         },
         [1] = {
-                .start  = 79,
+                .start  = evt2irq(0x0be0), /* KEYSC_KEY */
                 .flags  = IORESOURCE_IRQ,
         },
 };
@@ -169,10 +195,53 @@ static struct platform_device keysc_device = {
         },
 };
 
+/* SDHI */
+static struct resource sdhi0_resources[] = {
+        [0] = {
+                .name   = "SDHI0",
+                .start  = 0xe6d50000,
+                .end    = 0xe6d501ff,
+                .flags  = IORESOURCE_MEM,
+        },
+        [1] = {
+                .start  = evt2irq(0x0e00), /* SDHI0 */
+                .flags  = IORESOURCE_IRQ,
+        },
+};
+
+static struct platform_device sdhi0_device = {
+        .name           = "sh_mobile_sdhi",
+        .num_resources  = ARRAY_SIZE(sdhi0_resources),
+        .resource       = sdhi0_resources,
+        .id             = 0,
+};
+
+static struct resource sdhi1_resources[] = {
+        [0] = {
+                .name   = "SDHI1",
+                .start  = 0xe6d60000,
+                .end    = 0xe6d601ff,
+                .flags  = IORESOURCE_MEM,
+        },
+        [1] = {
+                .start  = evt2irq(0x0e80), /* SDHI1 */
+                .flags  = IORESOURCE_IRQ,
+        },
+};
+
+static struct platform_device sdhi1_device = {
+        .name           = "sh_mobile_sdhi",
+        .num_resources  = ARRAY_SIZE(sdhi1_resources),
+        .resource       = sdhi1_resources,
+        .id             = 1,
+};
+
 static struct platform_device *g4evm_devices[] __initdata = {
         &nor_flash_device,
         &usb_host_device,
         &keysc_device,
+        &sdhi0_device,
+        &sdhi1_device,
 };
 
 static struct map_desc g4evm_io_desc[] __initdata = {
@@ -191,12 +260,41 @@ static void __init g4evm_map_io(void)
 {
         iotable_init(g4evm_io_desc, ARRAY_SIZE(g4evm_io_desc));
 
-        /* setup early devices, clocks and console here as well */
+        /* setup early devices and console here as well */
         sh7377_add_early_devices();
-        sh7367_clock_init(); /* use g3 clocks for now */
         shmobile_setup_console();
 }
 
+#define GPIO_SDHID0_D0  0xe60520fc
+#define GPIO_SDHID0_D1  0xe60520fd
+#define GPIO_SDHID0_D2  0xe60520fe
+#define GPIO_SDHID0_D3  0xe60520ff
+#define GPIO_SDHICMD0   0xe6052100
+
+#define GPIO_SDHID1_D0  0xe6052103
+#define GPIO_SDHID1_D1  0xe6052104
+#define GPIO_SDHID1_D2  0xe6052105
+#define GPIO_SDHID1_D3  0xe6052106
+#define GPIO_SDHICMD1   0xe6052107
+
+/*
+ * FIXME !!
+ *
+ * gpio_pull_up is quick_hack.
+ *
+ * current gpio frame work doesn't have
+ * the method to control only pull up/down/free.
+ * this function should be replaced by correct gpio function
+ */
+static void __init gpio_pull_up(u32 addr)
+{
+        u8 data = __raw_readb(addr);
+
+        data &= 0x0F;
+        data |= 0xC0;
+        __raw_writeb(data, addr);
+}
+
 static void __init g4evm_init(void)
 {
         sh7377_pinmux_init();
@@ -229,9 +327,6 @@ static void __init g4evm_init(void)
         gpio_request(GPIO_FN_EXTLP, NULL);
         gpio_request(GPIO_FN_IDIN, NULL);
 
-        /* enable clock in SMSTPCR3 */
-        __raw_writel(__raw_readl(0xe615013c) & ~(1 << 22), 0xe615013c);
-
         /* setup USB phy */
         __raw_writew(0x0200, 0xe605810a);       /* USBCR1 */
         __raw_writew(0x00e0, 0xe60581c0);       /* CPFCH */
@@ -253,16 +348,54 @@ static void __init g4evm_init(void)
         gpio_request(GPIO_FN_PORT71_KEYIN5_PU, NULL);
         gpio_request(GPIO_FN_PORT72_KEYIN6_PU, NULL);
 
+        /* SDHI0 */
+        gpio_request(GPIO_FN_SDHICLK0, NULL);
+        gpio_request(GPIO_FN_SDHICD0, NULL);
+        gpio_request(GPIO_FN_SDHID0_0, NULL);
+        gpio_request(GPIO_FN_SDHID0_1, NULL);
+        gpio_request(GPIO_FN_SDHID0_2, NULL);
+        gpio_request(GPIO_FN_SDHID0_3, NULL);
+        gpio_request(GPIO_FN_SDHICMD0, NULL);
+        gpio_request(GPIO_FN_SDHIWP0, NULL);
+        gpio_pull_up(GPIO_SDHID0_D0);
+        gpio_pull_up(GPIO_SDHID0_D1);
+        gpio_pull_up(GPIO_SDHID0_D2);
+        gpio_pull_up(GPIO_SDHID0_D3);
+        gpio_pull_up(GPIO_SDHICMD0);
+
+        /* SDHI1 */
+        gpio_request(GPIO_FN_SDHICLK1, NULL);
+        gpio_request(GPIO_FN_SDHID1_0, NULL);
+        gpio_request(GPIO_FN_SDHID1_1, NULL);
+        gpio_request(GPIO_FN_SDHID1_2, NULL);
+        gpio_request(GPIO_FN_SDHID1_3, NULL);
+        gpio_request(GPIO_FN_SDHICMD1, NULL);
+        gpio_pull_up(GPIO_SDHID1_D0);
+        gpio_pull_up(GPIO_SDHID1_D1);
+        gpio_pull_up(GPIO_SDHID1_D2);
+        gpio_pull_up(GPIO_SDHID1_D3);
+        gpio_pull_up(GPIO_SDHICMD1);
+
         sh7377_add_standard_devices();
 
         platform_add_devices(g4evm_devices, ARRAY_SIZE(g4evm_devices));
 }
 
+static void __init g4evm_timer_init(void)
+{
+        sh7377_clock_init();
+        shmobile_timer.init();
+}
+
+static struct sys_timer g4evm_timer = {
+        .init           = g4evm_timer_init,
+};
+
 MACHINE_START(G4EVM, "g4evm")
         .phys_io        = 0xe6000000,
         .io_pg_offst    = ((0xe6000000) >> 18) & 0xfffc,
         .map_io         = g4evm_map_io,
         .init_irq       = sh7377_init_irq,
         .init_machine   = g4evm_init,
-        .timer          = &shmobile_timer,
+        .timer          = &g4evm_timer,
 MACHINE_END