1 files changed, 50 insertions, 0 deletions

diff --git a/arch/arm/mach-davinci/devices-tnetv107x.c b/arch/arm/mach-davinci/devices-tnetv107x.c
index 2718a3a90dff..c9a86d8130d1 100644
--- a/arch/arm/mach-davinci/devices-tnetv107x.c
+++ b/arch/arm/mach-davinci/devices-tnetv107x.c
@@ -31,8 +31,10 @@
 #define TNETV107X_TPTC0_BASE                    0x01c10000
 #define TNETV107X_TPTC1_BASE                    0x01c10400
 #define TNETV107X_WDOG_BASE                     0x08086700
+#define TNETV107X_TSC_BASE                      0x08088500
 #define TNETV107X_SDIO0_BASE                    0x08088700
 #define TNETV107X_SDIO1_BASE                    0x08088800
+#define TNETV107X_KEYPAD_BASE                   0x08088a00
 #define TNETV107X_ASYNC_EMIF_CNTRL_BASE         0x08200000
 #define TNETV107X_ASYNC_EMIF_DATA_CE0_BASE      0x30000000
 #define TNETV107X_ASYNC_EMIF_DATA_CE1_BASE      0x40000000
@@ -298,12 +300,55 @@ static int __init nand_init(int chipsel, struct davinci_nand_pdata *data)
         return platform_device_register(pdev);
 }
 
+static struct resource keypad_resources[] = {
+        {
+                .start  = TNETV107X_KEYPAD_BASE,
+                .end    = TNETV107X_KEYPAD_BASE + 0xff,
+                .flags  = IORESOURCE_MEM,
+        },
+        {
+                .start  = IRQ_TNETV107X_KEYPAD,
+                .flags  = IORESOURCE_IRQ,
+                .name   = "press",
+        },
+        {
+                .start  = IRQ_TNETV107X_KEYPAD_FREE,
+                .flags  = IORESOURCE_IRQ,
+                .name   = "release",
+        },
+};
+
+static struct platform_device keypad_device = {
+        .name           = "tnetv107x-keypad",
+        .num_resources  = ARRAY_SIZE(keypad_resources),
+        .resource       = keypad_resources,
+};
+
+static struct resource tsc_resources[] = {
+        {
+                .start  = TNETV107X_TSC_BASE,
+                .end    = TNETV107X_TSC_BASE + 0xff,
+                .flags  = IORESOURCE_MEM,
+        },
+        {
+                .start  = IRQ_TNETV107X_TSC,
+                .flags  = IORESOURCE_IRQ,
+        },
+};
+
+static struct platform_device tsc_device = {
+        .name           = "tnetv107x-ts",
+        .num_resources  = ARRAY_SIZE(tsc_resources),
+        .resource       = tsc_resources,
+};
+
 void __init tnetv107x_devices_init(struct tnetv107x_device_info *info)
 {
         int i;
 
         platform_device_register(&edma_device);
         platform_device_register(&tnetv107x_wdt_device);
+        platform_device_register(&tsc_device);
 
         if (info->serial_config)
                 davinci_serial_init(info->serial_config);
@@ -317,4 +362,9 @@ void __init tnetv107x_devices_init(struct tnetv107x_device_info *info)
         for (i = 0; i < 4; i++)
                 if (info->nand_config[i])
                         nand_init(i, info->nand_config[i]);
+
+        if (info->keypad_config) {
+                keypad_device.dev.platform_data = info->keypad_config;
+                platform_device_register(&keypad_device);
+        }
 }