gpio-f7188x: Add GPIO support for F81865

[linux-2.6-microblaze.git] / drivers / gpio / gpio-f7188x.c

diff --git a/drivers/gpio/gpio-f7188x.c b/drivers/gpio/gpio-f7188x.c
index cadd029..18a3147 100644 (file)
--- a/drivers/gpio/gpio-f7188x.c
+++ b/drivers/gpio/gpio-f7188x.c
@@ -36,9 +36,19 @@
 #define SIO_F71889A_ID         0x1005  /* F71889A chipset ID */
 #define SIO_F81866_ID          0x1010  /* F81866 chipset ID */
 #define SIO_F81804_ID          0x1502  /* F81804 chipset ID, same for f81966 */
-
-
-enum chips { f71869, f71869a, f71882fg, f71889a, f71889f, f81866, f81804 };
+#define SIO_F81865_ID          0x0704  /* F81865 chipset ID */
+
+
+enum chips {
+       f71869,
+       f71869a,
+       f71882fg,
+       f71889a,
+       f71889f,
+       f81866,
+       f81804,
+       f81865,
+};
 
 static const char * const f7188x_names[] = {
        "f71869",
@@ -48,6 +58,7 @@ static const char * const f7188x_names[] = {
        "f71889f",
        "f81866",
        "f81804",
+       "f81865",
 };
 
 struct f7188x_sio {
@@ -233,6 +244,15 @@ static struct f7188x_gpio_bank f81804_gpio_bank[] = {
        F7188X_GPIO_BANK(90, 8, 0x98),
 };
 
+static struct f7188x_gpio_bank f81865_gpio_bank[] = {
+       F7188X_GPIO_BANK(0, 8, 0xF0),
+       F7188X_GPIO_BANK(10, 8, 0xE0),
+       F7188X_GPIO_BANK(20, 8, 0xD0),
+       F7188X_GPIO_BANK(30, 8, 0xC0),
+       F7188X_GPIO_BANK(40, 8, 0xB0),
+       F7188X_GPIO_BANK(50, 8, 0xA0),
+       F7188X_GPIO_BANK(60, 5, 0x90),
+};
 
 static int f7188x_gpio_get_direction(struct gpio_chip *chip, unsigned offset)
 {
@@ -425,6 +445,10 @@ static int f7188x_gpio_probe(struct platform_device *pdev)
                data->nr_bank = ARRAY_SIZE(f81804_gpio_bank);
                data->bank = f81804_gpio_bank;
                break;
+       case f81865:
+               data->nr_bank = ARRAY_SIZE(f81865_gpio_bank);
+               data->bank = f81865_gpio_bank;
+               break;
        default:
                return -ENODEV;
        }
@@ -490,6 +514,9 @@ static int __init f7188x_find(int addr, struct f7188x_sio *sio)
        case SIO_F81804_ID:
                sio->type = f81804;
                break;
+       case SIO_F81865_ID:
+               sio->type = f81865;
+               break;
        default:
                pr_info(DRVNAME ": Unsupported Fintek device 0x%04x\n", devid);
                goto err;