adds gpiodev support to ifxmips

[librecmc/librecmc.git] / target / linux / ifxmips / files / arch / mips / ifxmips / board.c

diff --git a/target/linux/ifxmips/files/arch/mips/ifxmips/board.c b/target/linux/ifxmips/files/arch/mips/ifxmips/board.c
index f048321bdf313df5e9786a07bee7bea09b1162be..d925cf23620821d6413478ec34529220e94c9ce3 100644 (file)
--- a/target/linux/ifxmips/files/arch/mips/ifxmips/board.c
+++ b/target/linux/ifxmips/files/arch/mips/ifxmips/board.c
@@ -27,7 +27,7 @@
 #include <linux/mtd/physmap.h>
 #include <linux/kernel.h>
 #include <linux/reboot.h>
-#include <linux/platform_device.h> 
+#include <linux/platform_device.h>
 #include <asm/bootinfo.h>
 #include <asm/reboot.h>
 #include <asm/time.h>
@@ -35,12 +35,13 @@
 #include <asm/io.h>
 #include <asm/ifxmips/ifxmips.h>
 
-#define MAX_IFXMIPS_DEVS               5
+#define MAX_IFXMIPS_DEVS               6
 
 #define BOARD_DANUBE                   "Danube"
 #define BOARD_DANUBE_CHIPID            0x10129083
 
 #define BOARD_TWINPASS                 "Twinpass"
+#define BOARD_TWINPASS_CHIPID  0x3012D083
 
 #define BOARD_DANUBE                   "Danube"
 
@@ -71,7 +72,7 @@ static struct platform_device ifxmips_mii[] =
                .name = "ifxmips_mii0",
        },
 };
-       
+
 static struct physmap_flash_data ifxmips_mtd_data = {
        .width    = 2,
 };
@@ -95,14 +96,37 @@ static struct platform_device ifxmips_mtd[] =
        },
 };
 
+#ifdef CONFIG_GPIO_DEVICE
+static struct resource ifxmips_gpio_dev_resources[] = {
+       {
+               .name = "gpio",
+               .flags  = 0,
+               .start = (1 << 0) | (1 << 1) | (1 << 2) | (1 << 3) | (1 << 4) | (1 << 5) | (1 << 8) | (1 << 9) | (1 << 12),
+               .end = (1 << 0) | (1 << 1) | (1 << 2) | (1 << 3) | (1 << 4) | (1 << 5) | (1 << 8) | (1 << 9) | (1 << 12),
+       },
+};
+
+static struct platform_device ifxmips_gpio_dev[] = {
+       {
+               .name     = "GPIODEV",
+               .id     = -1,
+               .num_resources    = ARRAY_SIZE(ifxmips_gpio_dev_resources),
+               .resource   = ifxmips_gpio_dev_resources,
+       }
+};
+#endif
+
 const char*
 get_system_type (void)
 {
-       chiprev = readl(IFXMIPS_MPS_CHIPID);
+       chiprev = ifxmips_r32(IFXMIPS_MPS_CHIPID);
        switch(chiprev)
        {
        case BOARD_DANUBE_CHIPID:
                return BOARD_DANUBE;
+
+       case BOARD_TWINPASS_CHIPID:
+               return BOARD_TWINPASS;
        }
 
        return BOARD_SYSTEM_TYPE;
@@ -115,18 +139,18 @@ int __init ifxmips_init_devices(void)
        *       Currently we support 3 chips
        *       1.) Danube
        *       2.) Twinpass (Danube without dsl phy)
-       *       3.) KDbg74 (used for debuging)
        */
 
        int dev = 0;
 
        /* the following devices are generic for all targets */
-
        ifxmips_devs[dev++] = ifxmips_led;
        ifxmips_devs[dev++] = ifxmips_gpio;
        ifxmips_devs[dev++] = ifxmips_mii;
        ifxmips_devs[dev++] = ifxmips_mtd;
-
+#ifdef CONFIG_GPIO_DEVICE
+       ifxmips_devs[dev++] = ifxmips_gpio_dev;
+#endif
        return platform_add_devices(ifxmips_devs, dev);
 }