drivers/gpio/bcm6345_gpio.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2017 Álvaro Fernández Rojas <[email protected]>
   4  *
   5  * Derived from linux/arch/mips/bcm63xx/gpio.c:
   6  *      Copyright (C) 2008 Maxime Bizon <[email protected]>
   7  *      Copyright (C) 2008-2011 Florian Fainelli <[email protected]>
   8  */
   9
  10 #include <dm.h>
  11 #include <errno.h>
  12 #include <asm/gpio.h>
  13 #include <asm/io.h>
  14 #include <linux/bitops.h>
  15
  16 struct bcm6345_gpio_priv {
  17         void __iomem *reg_dirout;
  18         void __iomem *reg_data;
  19 };
  20
  21 static int bcm6345_gpio_get_value(struct udevice *dev, unsigned offset)
  22 {
  23         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  24
  25         return !!(readl(priv->reg_data) & BIT(offset));
  26 }
  27
  28 static int bcm6345_gpio_set_value(struct udevice *dev, unsigned offset,
  29                                   int value)
  30 {
  31         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  32
  33         if (value)
  34                 setbits_32(priv->reg_data, BIT(offset));
  35         else
  36                 clrbits_32(priv->reg_data, BIT(offset));
  37
  38         return 0;
  39 }
  40
  41 static int bcm6345_gpio_set_direction(void __iomem *dirout, unsigned offset,
  42                                       bool input)
  43 {
  44         if (input)
  45                 clrbits_32(dirout, BIT(offset));
  46         else
  47                 setbits_32(dirout, BIT(offset));
  48
  49         return 0;
  50 }
  51
  52 static int bcm6345_gpio_direction_input(struct udevice *dev, unsigned offset)
  53 {
  54         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  55
  56         return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 1);
  57 }
  58
  59 static int bcm6345_gpio_direction_output(struct udevice *dev, unsigned offset,
  60                                          int value)
  61 {
  62         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  63
  64         bcm6345_gpio_set_value(dev, offset, value);
  65
  66         return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 0);
  67 }
  68
  69 static int bcm6345_gpio_get_function(struct udevice *dev, unsigned offset)
  70 {
  71         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  72
  73         if (readl(priv->reg_dirout) & BIT(offset))
  74                 return GPIOF_OUTPUT;
  75         else
  76                 return GPIOF_INPUT;
  77 }
  78
  79 static const struct dm_gpio_ops bcm6345_gpio_ops = {
  80         .direction_input = bcm6345_gpio_direction_input,
  81         .direction_output = bcm6345_gpio_direction_output,
  82         .get_value = bcm6345_gpio_get_value,
  83         .set_value = bcm6345_gpio_set_value,
  84         .get_function = bcm6345_gpio_get_function,
  85 };
  86
  87 static int bcm6345_gpio_probe(struct udevice *dev)
  88 {
  89         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
  90         struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
  91
  92         priv->reg_dirout = dev_remap_addr_index(dev, 0);
  93         if (!priv->reg_dirout)
  94                 return -EINVAL;
  95
  96         priv->reg_data = dev_remap_addr_index(dev, 1);
  97         if (!priv->reg_data)
  98                 return -EINVAL;
  99
 100         uc_priv->gpio_count = dev_read_u32_default(dev, "ngpios", 32);
 101         uc_priv->bank_name = dev->name;
 102
 103         return 0;
 104 }
 105
 106 static const struct udevice_id bcm6345_gpio_ids[] = {
 107         { .compatible = "brcm,bcm6345-gpio" },
 108         { /* sentinel */ }
 109 };
 110
 111 U_BOOT_DRIVER(bcm6345_gpio) = {
 112         .name = "bcm6345-gpio",
 113         .id = UCLASS_GPIO,
 114         .of_match = bcm6345_gpio_ids,
 115         .ops = &bcm6345_gpio_ops,
 116         .priv_auto      = sizeof(struct bcm6345_gpio_priv),
 117         .probe = bcm6345_gpio_probe,
 118 };