]> git.kernelconcepts.de Git - karo-tx-uboot.git/blobdiff - drivers/gpio/pca953x.c
tegra: Convert tegra GPIO driver to use driver model
[karo-tx-uboot.git] / drivers / gpio / pca953x.c
index 1c5e314d9d51e0d13f3d1fd1895299dcf37c6dab..7371cd4a87fdd7b7a64afbb39ed4fd80e402d6cc 100644 (file)
@@ -17,8 +17,8 @@
  */
 
 /*
- * Driver for NXP's 4 and 8 bit I2C gpio expanders (eg pca9537, pca9557, etc)
- * TODO: support additional devices with more than 8-bits GPIO
+ * Driver for NXP's 4, 8 and 16 bit I2C gpio expanders (eg pca9537, pca9557,
+ * pca9539, etc)
  */
 
 #include <common.h>
@@ -38,20 +38,78 @@ enum {
        PCA953X_CMD_INVERT,
 };
 
+#ifdef CONFIG_SYS_I2C_PCA953X_WIDTH
+struct pca953x_chip_ngpio {
+       uint8_t chip;
+       uint8_t ngpio;
+};
+
+static struct pca953x_chip_ngpio pca953x_chip_ngpios[] =
+    CONFIG_SYS_I2C_PCA953X_WIDTH;
+
+/*
+ * Determine the number of GPIO pins supported. If we don't know we assume
+ * 8 pins.
+ */
+static int pca953x_ngpio(uint8_t chip)
+{
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(pca953x_chip_ngpios); i++)
+               if (pca953x_chip_ngpios[i].chip == chip)
+                       return pca953x_chip_ngpios[i].ngpio;
+
+       return 8;
+}
+#else
+static int pca953x_ngpio(uint8_t chip)
+{
+       return 8;
+}
+#endif
+
 /*
  * Modify masked bits in register
  */
 static int pca953x_reg_write(uint8_t chip, uint addr, uint mask, uint data)
 {
-       uint8_t val;
+       uint8_t valb;
+       uint16_t valw;
 
-       if (i2c_read(chip, addr, 1, &val, 1))
-               return -1;
+       if (pca953x_ngpio(chip) <= 8) {
+               if (i2c_read(chip, addr, 1, &valb, 1))
+                       return -1;
+
+               valb &= ~mask;
+               valb |= data;
+
+               return i2c_write(chip, addr, 1, &valb, 1);
+       } else {
+               if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
+                       return -1;
 
-       val &= ~mask;
-       val |= data;
+               valw &= ~mask;
+               valw |= data;
 
-       return i2c_write(chip, addr, 1, &val, 1);
+               return i2c_write(chip, addr << 1, 1, (u8*)&valw, 2);
+       }
+}
+
+static int pca953x_reg_read(uint8_t chip, uint addr, uint *data)
+{
+       uint8_t valb;
+       uint16_t valw;
+
+       if (pca953x_ngpio(chip) <= 8) {
+               if (i2c_read(chip, addr, 1, &valb, 1))
+                       return -1;
+               *data = (int)valb;
+       } else {
+               if (i2c_read(chip, addr << 1, 1, (u8*)&valw, 2))
+                       return -1;
+               *data = (int)valw;
+       }
+       return 0;
 }
 
 /*
@@ -86,9 +144,9 @@ int pca953x_set_dir(uint8_t chip, uint mask, uint data)
  */
 int pca953x_get_val(uint8_t chip)
 {
-       uint8_t val;
+       uint val;
 
-       if (i2c_read(chip, 0, 1, &val, 1))
+       if (pca953x_reg_read(chip, PCA953X_IN, &val) < 0)
                return -1;
 
        return (int)val;
@@ -102,37 +160,44 @@ int pca953x_get_val(uint8_t chip)
 static int pca953x_info(uint8_t chip)
 {
        int i;
-       uint8_t data;
+       uint data;
+       int nr_gpio = pca953x_ngpio(chip);
+       int msb = nr_gpio - 1;
 
-       printf("pca953x@ 0x%x:\n\n", chip);
-       printf("gpio pins: 76543210\n");
-       printf("-------------------\n");
+       printf("pca953x@ 0x%x (%d pins):\n\n", chip, nr_gpio);
+       printf("gpio pins: ");
+       for (i = msb; i >= 0; i--)
+               printf("%x", i);
+       printf("\n");
+       for (i = 11 + nr_gpio; i > 0; i--)
+               printf("-");
+       printf("\n");
 
-       if (i2c_read(chip, PCA953X_CONF, 1, &data, 1))
+       if (pca953x_reg_read(chip, PCA953X_CONF, &data) < 0)
                return -1;
        printf("conf:      ");
-       for (i = 7; i >= 0; i--)
+       for (i = msb; i >= 0; i--)
                printf("%c", data & (1 << i) ? 'i' : 'o');
        printf("\n");
 
-       if (i2c_read(chip, PCA953X_POL, 1, &data, 1))
+       if (pca953x_reg_read(chip, PCA953X_POL, &data) < 0)
                return -1;
        printf("invert:    ");
-       for (i = 7; i >= 0; i--)
+       for (i = msb; i >= 0; i--)
                printf("%c", data & (1 << i) ? '1' : '0');
        printf("\n");
 
-       if (i2c_read(chip, PCA953X_IN, 1, &data, 1))
+       if (pca953x_reg_read(chip, PCA953X_IN, &data) < 0)
                return -1;
        printf("input:     ");
-       for (i = 7; i >= 0; i--)
+       for (i = msb; i >= 0; i--)
                printf("%c", data & (1 << i) ? '1' : '0');
        printf("\n");
 
-       if (i2c_read(chip, PCA953X_OUT, 1, &data, 1))
+       if (pca953x_reg_read(chip, PCA953X_OUT, &data) < 0)
                return -1;
        printf("output:    ");
-       for (i = 7; i >= 0; i--)
+       for (i = msb; i >= 0; i--)
                printf("%c", data & (1 << i) ? '1' : '0');
        printf("\n");
 
@@ -150,10 +215,10 @@ cmd_tbl_t cmd_pca953x[] = {
 #endif
 };
 
-int do_pca953x(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+int do_pca953x(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
        static uint8_t chip = CONFIG_SYS_I2C_PCA953X_ADDR;
-       int val;
+       int ret = CMD_RET_USAGE, val;
        ulong ul_arg2 = 0;
        ulong ul_arg3 = 0;
        cmd_tbl_t *c;
@@ -164,8 +229,7 @@ int do_pca953x(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
        if (!c || !((argc == (c->maxargs)) ||
                (((int)c->cmd == PCA953X_CMD_DEVICE) &&
                 (argc == (c->maxargs - 1))))) {
-               cmd_usage(cmdtp);
-               return 1;
+               return CMD_RET_USAGE;
        }
 
        /* arg2 used as chip number or pin number */
@@ -179,32 +243,53 @@ int do_pca953x(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
        switch ((int)c->cmd) {
 #ifdef CONFIG_CMD_PCA953X_INFO
        case PCA953X_CMD_INFO:
-               return pca953x_info(chip);
+               ret = pca953x_info(chip);
+               if (ret)
+                       ret = CMD_RET_FAILURE;
+               break;
 #endif
+
        case PCA953X_CMD_DEVICE:
                if (argc == 3)
                        chip = (uint8_t)ul_arg2;
                printf("Current device address: 0x%x\n", chip);
-               return 0;
+               ret = CMD_RET_SUCCESS;
+               break;
+
        case PCA953X_CMD_INPUT:
-               pca953x_set_dir(chip, (1 << ul_arg2),
+               ret = pca953x_set_dir(chip, (1 << ul_arg2),
                                PCA953X_DIR_IN << ul_arg2);
                val = (pca953x_get_val(chip) & (1 << ul_arg2)) != 0;
 
-               printf("chip 0x%02x, pin 0x%lx = %d\n", chip, ul_arg2, val);
-               return val;
+               if (ret)
+                       ret = CMD_RET_FAILURE;
+               else
+                       printf("chip 0x%02x, pin 0x%lx = %d\n", chip, ul_arg2,
+                                                                       val);
+               break;
+
        case PCA953X_CMD_OUTPUT:
-               pca953x_set_dir(chip, (1 << ul_arg2),
+               ret = pca953x_set_dir(chip, (1 << ul_arg2),
                                (PCA953X_DIR_OUT << ul_arg2));
-               return pca953x_set_val(chip, (1 << ul_arg2),
-                                       (ul_arg3 << ul_arg2));
+               if (!ret)
+                       ret = pca953x_set_val(chip, (1 << ul_arg2),
+                                               (ul_arg3 << ul_arg2));
+               if (ret)
+                       ret = CMD_RET_FAILURE;
+               break;
+
        case PCA953X_CMD_INVERT:
-               return pca953x_set_pol(chip, (1 << ul_arg2),
+               ret = pca953x_set_pol(chip, (1 << ul_arg2),
                                        (ul_arg3 << ul_arg2));
-       default:
-               /* We should never get here */
-               return 1;
+               if (ret)
+                       ret = CMD_RET_FAILURE;
+               break;
        }
+
+       if (ret == CMD_RET_FAILURE)
+               eprintf("Error talking to chip at 0x%x\n", chip);
+
+       return ret;
 }
 
 U_BOOT_CMD(
@@ -220,8 +305,8 @@ U_BOOT_CMD(
        "       - set pin as output and drive low or high\n"
        "pca953x invert pin 0|1\n"
        "       - disable/enable polarity inversion for reads\n"
-       "pca953x intput pin\n"
-       "       - set pin as input and read value\n"
+       "pca953x input pin\n"
+       "       - set pin as input and read value"
 );
 
 #endif /* CONFIG_CMD_PCA953X */