common: spl_fit: Default to IH_OS_U_BOOT if FIT_IMAGE_TINY enabled
[oweals/u-boot.git] / drivers / gpio / pca953x_gpio.c
index 535b2f12eade9a920357518e6196da3e35ec0edd..341527acc5e8e52abb4800ccca9b34ce08cf361a 100644 (file)
@@ -130,6 +130,25 @@ static int pca953x_read_regs(struct udevice *dev, int reg, u8 *val)
        return ret;
 }
 
+static int pca953x_write_regs(struct udevice *dev, int reg, u8 *val)
+{
+       struct pca953x_info *info = dev_get_platdata(dev);
+       int ret = 0;
+
+       if (info->gpio_count <= 8) {
+               ret = dm_i2c_write(dev, reg, val, 1);
+       } else if (info->gpio_count <= 16) {
+               ret = dm_i2c_write(dev, reg << 1, val, info->bank_count);
+       } else if (info->gpio_count == 40) {
+               /* Auto increment */
+               ret = dm_i2c_write(dev, (reg << 3) | 0x80, val, info->bank_count);
+       } else {
+               return -EINVAL;
+       }
+
+       return ret;
+}
+
 static int pca953x_is_output(struct udevice *dev, int offset)
 {
        struct pca953x_info *info = dev_get_platdata(dev);
@@ -227,7 +246,7 @@ static int pca953x_xlate(struct udevice *dev, struct gpio_desc *desc,
                         struct ofnode_phandle_args *args)
 {
        desc->offset = args->args[0];
-       desc->flags = args->args[1] & (GPIO_ACTIVE_LOW ? GPIOD_ACTIVE_LOW : 0);
+       desc->flags = args->args[1] & GPIO_ACTIVE_LOW ? GPIOD_ACTIVE_LOW : 0;
 
        return 0;
 }
@@ -251,6 +270,7 @@ static int pca953x_probe(struct udevice *dev)
        int ret;
        int size;
        const u8 *tmp;
+       u8 val[MAX_BANK];
 
        addr = dev_read_addr(dev);
        if (addr == 0)
@@ -296,6 +316,14 @@ static int pca953x_probe(struct udevice *dev)
                snprintf(name, sizeof(name), "gpio@%x_", info->addr);
        }
 
+       /* Clear the polarity registers to no invert */
+       memset(val, 0, MAX_BANK);
+       ret = pca953x_write_regs(dev, PCA953X_INVERT, val);
+       if (ret < 0) {
+               dev_err(dev, "Error writing invert register\n");
+               return ret;
+       }
+
        str = strdup(name);
        if (!str)
                return -ENOMEM;