2 files changed, 62 insertions, 0 deletions

diff --git a/arch/arm/mach-shmobile/board-g3evm.c b/arch/arm/mach-shmobile/board-g3evm.c
index f36c9a94d326..9d326893a212 100644
--- a/arch/arm/mach-shmobile/board-g3evm.c
+++ b/arch/arm/mach-shmobile/board-g3evm.c
@@ -29,6 +29,8 @@
 #include <linux/usb/r8a66597.h>
 #include <linux/io.h>
 #include <linux/gpio.h>
+#include <linux/input.h>
+#include <linux/input/sh_keysc.h>
 #include <mach/sh7367.h>
 #include <mach/common.h>
 #include <asm/mach-types.h>
@@ -127,9 +129,47 @@ static struct platform_device usb_host_device = {
         .resource       = usb_host_resources,
 };
 
+/* KEYSC */
+static struct sh_keysc_info keysc_info = {
+        .mode           = SH_KEYSC_MODE_5,
+        .scan_timing    = 3,
+        .delay          = 100,
+        .keycodes = {
+                KEY_A, KEY_B, KEY_C, KEY_D, KEY_E, KEY_F, KEY_G,
+                KEY_H, KEY_I, KEY_J, KEY_K, KEY_L, KEY_M, KEY_N,
+                KEY_O, KEY_P, KEY_Q, KEY_R, KEY_S, KEY_T, KEY_U,
+                KEY_V, KEY_W, KEY_X, KEY_Y, KEY_Z, KEY_HOME, KEY_SLEEP,
+                KEY_WAKEUP, KEY_COFFEE, KEY_0, KEY_1, KEY_2, KEY_3, KEY_4,
+                KEY_5, KEY_6, KEY_7, KEY_8, KEY_9, KEY_STOP, KEY_COMPUTER,
+        },
+};
+
+static struct resource keysc_resources[] = {
+        [0] = {
+                .name   = "KEYSC",
+                .start  = 0xe61b0000,
+                .end    = 0xe61b000f,
+                .flags  = IORESOURCE_MEM,
+        },
+        [1] = {
+                .start  = 79,
+                .flags  = IORESOURCE_IRQ,
+        },
+};
+
+static struct platform_device keysc_device = {
+        .name           = "sh_keysc",
+        .num_resources  = ARRAY_SIZE(keysc_resources),
+        .resource       = keysc_resources,
+        .dev    = {
+                .platform_data  = &keysc_info,
+        },
+};
+
 static struct platform_device *g3evm_devices[] __initdata = {
         &nor_flash_device,
         &usb_host_device,
+        &keysc_device,
 };
 
 static struct map_desc g3evm_io_desc[] __initdata = {
@@ -196,6 +236,21 @@ static void __init g3evm_init(void)
         __raw_writew(0x6010, 0xe60581c6);       /* CGPOSR */
         __raw_writew(0x8a0a, 0xe605810c);       /* USBCR2 */
 
+        /* KEYSC @ CN7 */
+        gpio_request(GPIO_FN_PORT42_KEYOUT0, NULL);
+        gpio_request(GPIO_FN_PORT43_KEYOUT1, NULL);
+        gpio_request(GPIO_FN_PORT44_KEYOUT2, NULL);
+        gpio_request(GPIO_FN_PORT45_KEYOUT3, NULL);
+        gpio_request(GPIO_FN_PORT46_KEYOUT4, NULL);
+        gpio_request(GPIO_FN_PORT47_KEYOUT5, NULL);
+        gpio_request(GPIO_FN_PORT48_KEYIN0_PU, NULL);
+        gpio_request(GPIO_FN_PORT49_KEYIN1_PU, NULL);
+        gpio_request(GPIO_FN_PORT50_KEYIN2_PU, NULL);
+        gpio_request(GPIO_FN_PORT55_KEYIN3_PU, NULL);
+        gpio_request(GPIO_FN_PORT56_KEYIN4_PU, NULL);
+        gpio_request(GPIO_FN_PORT57_KEYIN5_PU, NULL);
+        gpio_request(GPIO_FN_PORT58_KEYIN6_PU, NULL);
+
         sh7367_add_standard_devices();
 
         platform_add_devices(g3evm_devices, ARRAY_SIZE(g3evm_devices));
diff --git a/arch/arm/mach-shmobile/clock-sh7367.c b/arch/arm/mach-shmobile/clock-sh7367.c
index 58bd54e1113a..bb940c6e4e6c 100644
--- a/arch/arm/mach-shmobile/clock-sh7367.c
+++ b/arch/arm/mach-shmobile/clock-sh7367.c
@@ -75,6 +75,11 @@ static struct clk usb0_clk = {
         .name       = "usb0",
 };
 
+/* a static keysc0 clk for now - enough to get sh_keysc working */
+static struct clk keysc0_clk = {
+        .name       = "keysc0",
+};
+
 static struct clk_lookup lookups[] = {
         {
                 .clk = &peripheral_clk,
@@ -82,6 +87,8 @@ static struct clk_lookup lookups[] = {
                 .clk = &r_clk,
         }, {
                 .clk = &usb0_clk,
+        }, {
+                .clk = &keysc0_clk,
         }
 };