arm64: versal: Rename versal_pm_request to xilinx_pm_request

[oweals/u-boot.git] / drivers / gpio / da8xx_gpio.c

diff --git a/drivers/gpio/da8xx_gpio.c b/drivers/gpio/da8xx_gpio.c
index 1a1d37ae2a42068b0935e69886b9bea25afbc4ff..bd7944816487d13d06d88ff14c9ad27209d156f3 100644 (file)
--- a/drivers/gpio/da8xx_gpio.c
+++ b/drivers/gpio/da8xx_gpio.c
@@ -11,10 +11,14 @@
 #include <fdtdec.h>
 #include <asm/io.h>
 #include <asm/gpio.h>
+#include <dt-bindings/gpio/gpio.h>
+
+#include "da8xx_gpio.h"
+
+#ifndef CONFIG_DM_GPIO
 #include <asm/arch/hardware.h>
 #include <asm/arch/davinci_misc.h>
 
-#ifndef CONFIG_DM_GPIO
 static struct gpio_registry {
        int is_registered;
        char name[GPIO_NAME_SIZE];
@@ -429,20 +433,27 @@ int gpio_set_value(unsigned int gpio, int value)
 static struct davinci_gpio *davinci_get_gpio_bank(struct udevice *dev, unsigned int offset)
 {
        struct davinci_gpio_bank *bank = dev_get_priv(dev);
+       unsigned int addr;
 
-       /* The device tree is not broken into banks but the infrastructure is
+       /*
+        * The device tree is not broken into banks but the infrastructure is
         * expecting it this way, so we'll first include the 0x10 offset, then
         * calculate the bank manually based on the offset.
+        * Casting 'addr' as Unsigned long is needed to make the math work.
         */
-
-       return ((struct davinci_gpio *)bank->base) + 0x10 + (offset >> 5);
+       addr = ((unsigned long)(struct davinci_gpio *)bank->base) +
+                       0x10 + (0x28 * (offset >> 5));
+       return (struct davinci_gpio *)addr;
 }
 
 static int davinci_gpio_direction_input(struct udevice *dev, unsigned int offset)
 {
        struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
 
-       _gpio_direction_input(base, offset);
+       /*
+        * Fetch the address based on GPIO, but only pass the masked low 32-bits
+        */
+       _gpio_direction_input(base, (offset & 0x1f));
        return 0;
 }
 
@@ -451,7 +462,7 @@ static int davinci_gpio_direction_output(struct udevice *dev, unsigned int offse
 {
        struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
 
-       _gpio_direction_output(base, offset, value);
+       _gpio_direction_output(base, (offset & 0x1f), value);
        return 0;
 }
 
@@ -459,7 +470,7 @@ static int davinci_gpio_get_value(struct udevice *dev, unsigned int offset)
 {
        struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
 
-       return _gpio_get_value(base, offset);
+       return _gpio_get_value(base, (offset & 0x1f));
 }
 
 static int davinci_gpio_set_value(struct udevice *dev, unsigned int offset,
@@ -467,7 +478,7 @@ static int davinci_gpio_set_value(struct udevice *dev, unsigned int offset,
 {
        struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
 
-       _gpio_set_value(base, offset, value);
+       _gpio_set_value(base, (offset & 0x1f), value);
 
        return 0;
 }
@@ -485,12 +496,25 @@ static int davinci_gpio_get_function(struct udevice *dev, unsigned int offset)
        return GPIOF_OUTPUT;
 }
 
+static int davinci_gpio_xlate(struct udevice *dev, struct gpio_desc *desc,
+                             struct ofnode_phandle_args *args)
+{
+       desc->offset = args->args[0];
+
+       if (args->args[1] & GPIO_ACTIVE_LOW)
+               desc->flags = GPIOD_ACTIVE_LOW;
+       else
+               desc->flags = 0;
+       return 0;
+}
+
 static const struct dm_gpio_ops gpio_davinci_ops = {
        .direction_input        = davinci_gpio_direction_input,
        .direction_output       = davinci_gpio_direction_output,
        .get_value              = davinci_gpio_get_value,
        .set_value              = davinci_gpio_set_value,
        .get_function           = davinci_gpio_get_function,
+       .xlate                  = davinci_gpio_xlate,
 };
 
 static int davinci_gpio_probe(struct udevice *dev)
@@ -509,6 +533,7 @@ static int davinci_gpio_probe(struct udevice *dev)
 
 static const struct udevice_id davinci_gpio_ids[] = {
        { .compatible = "ti,dm6441-gpio" },
+       { .compatible = "ti,k2g-gpio" },
        { }
 };