drivers/gpio/gpio-tps65910.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * TI TPS6591x GPIO driver
   4  *
   5  * Copyright 2010 Texas Instruments Inc.
   6  *
   7  * Author: Graeme Gregory <gg@slimlogic.co.uk>
   8  * Author: Jorge Eduardo Candelaria <jedu@slimlogic.co.uk>
   9  */
  10
  11 #include <linux/kernel.h>
  12 #include <linux/init.h>
  13 #include <linux/errno.h>
  14 #include <linux/gpio/driver.h>
  15 #include <linux/i2c.h>
  16 #include <linux/platform_device.h>
  17 #include <linux/mfd/tps65910.h>
  18 #include <linux/of_device.h>
  19
  20 struct tps65910_gpio {
  21         struct gpio_chip gpio_chip;
  22         struct tps65910 *tps65910;
  23 };
  24
  25 static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset)
  26 {
  27         struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
  28         struct tps65910 *tps65910 = tps65910_gpio->tps65910;
  29         unsigned int val;
  30
  31         tps65910_reg_read(tps65910, TPS65910_GPIO0 + offset, &val);
  32
  33         if (val & GPIO_STS_MASK)
  34                 return 1;
  35
  36         return 0;
  37 }
  38
  39 static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset,
  40                               int value)
  41 {
  42         struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
  43         struct tps65910 *tps65910 = tps65910_gpio->tps65910;
  44
  45         if (value)
  46                 tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
  47                                                 GPIO_SET_MASK);
  48         else
  49                 tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
  50                                                 GPIO_SET_MASK);
  51 }
  52
  53 static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset,
  54                                 int value)
  55 {
  56         struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
  57         struct tps65910 *tps65910 = tps65910_gpio->tps65910;
  58
  59         /* Set the initial value */
  60         tps65910_gpio_set(gc, offset, value);
  61
  62         return tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
  63                                                 GPIO_CFG_MASK);
  64 }
  65
  66 static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset)
  67 {
  68         struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
  69         struct tps65910 *tps65910 = tps65910_gpio->tps65910;
  70
  71         return tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
  72                                                 GPIO_CFG_MASK);
  73 }
  74
  75 #ifdef CONFIG_OF
  76 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
  77                 struct tps65910 *tps65910, int chip_ngpio)
  78 {
  79         struct tps65910_board *tps65910_board = tps65910->of_plat_data;
  80         unsigned int prop_array[TPS6591X_MAX_NUM_GPIO];
  81         int ngpio = min(chip_ngpio, TPS6591X_MAX_NUM_GPIO);
  82         int ret;
  83         int idx;
  84
  85         tps65910_board->gpio_base = -1;
  86         ret = of_property_read_u32_array(tps65910->dev->of_node,
  87                         "ti,en-gpio-sleep", prop_array, ngpio);
  88         if (ret < 0) {
  89                 dev_dbg(dev, "ti,en-gpio-sleep not specified\n");
  90                 return tps65910_board;
  91         }
  92
  93         for (idx = 0; idx < ngpio; idx++)
  94                 tps65910_board->en_gpio_sleep[idx] = (prop_array[idx] != 0);
  95
  96         return tps65910_board;
  97 }
  98 #else
  99 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
 100                 struct tps65910 *tps65910, int chip_ngpio)
 101 {
 102         return NULL;
 103 }
 104 #endif
 105
 106 static int tps65910_gpio_probe(struct platform_device *pdev)
 107 {
 108         struct tps65910 *tps65910 = dev_get_drvdata(pdev->dev.parent);
 109         struct tps65910_board *pdata = dev_get_platdata(tps65910->dev);
 110         struct tps65910_gpio *tps65910_gpio;
 111         int ret;
 112         int i;
 113
 114         tps65910_gpio = devm_kzalloc(&pdev->dev,
 115                                 sizeof(*tps65910_gpio), GFP_KERNEL);
 116         if (!tps65910_gpio)
 117                 return -ENOMEM;
 118
 119         tps65910_gpio->tps65910 = tps65910;
 120
 121         tps65910_gpio->gpio_chip.owner = THIS_MODULE;
 122         tps65910_gpio->gpio_chip.label = tps65910->i2c_client->name;
 123
 124         switch (tps65910_chip_id(tps65910)) {
 125         case TPS65910:
 126                 tps65910_gpio->gpio_chip.ngpio = TPS65910_NUM_GPIO;
 127                 break;
 128         case TPS65911:
 129                 tps65910_gpio->gpio_chip.ngpio = TPS65911_NUM_GPIO;
 130                 break;
 131         default:
 132                 return -EINVAL;
 133         }
 134         tps65910_gpio->gpio_chip.can_sleep = true;
 135         tps65910_gpio->gpio_chip.direction_input = tps65910_gpio_input;
 136         tps65910_gpio->gpio_chip.direction_output = tps65910_gpio_output;
 137         tps65910_gpio->gpio_chip.set    = tps65910_gpio_set;
 138         tps65910_gpio->gpio_chip.get    = tps65910_gpio_get;
 139         tps65910_gpio->gpio_chip.parent = &pdev->dev;
 140 #ifdef CONFIG_OF_GPIO
 141         tps65910_gpio->gpio_chip.of_node = tps65910->dev->of_node;
 142 #endif
 143         if (pdata && pdata->gpio_base)
 144                 tps65910_gpio->gpio_chip.base = pdata->gpio_base;
 145         else
 146                 tps65910_gpio->gpio_chip.base = -1;
 147
 148         if (!pdata && tps65910->dev->of_node)
 149                 pdata = tps65910_parse_dt_for_gpio(&pdev->dev, tps65910,
 150                         tps65910_gpio->gpio_chip.ngpio);
 151
 152         if (!pdata)
 153                 goto skip_init;
 154
 155         /* Configure sleep control for gpios if provided */
 156         for (i = 0; i < tps65910_gpio->gpio_chip.ngpio; ++i) {
 157                 if (!pdata->en_gpio_sleep[i])
 158                         continue;
 159
 160                 ret = tps65910_reg_set_bits(tps65910,
 161                         TPS65910_GPIO0 + i, GPIO_SLEEP_MASK);
 162                 if (ret < 0)
 163                         dev_warn(tps65910->dev,
 164                                 "GPIO Sleep setting failed with err %d\n", ret);
 165         }
 166
 167 skip_init:
 168         ret = devm_gpiochip_add_data(&pdev->dev, &tps65910_gpio->gpio_chip,
 169                                      tps65910_gpio);
 170         if (ret < 0) {
 171                 dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
 172                 return ret;
 173         }
 174
 175         platform_set_drvdata(pdev, tps65910_gpio);
 176
 177         return ret;
 178 }
 179
 180 static struct platform_driver tps65910_gpio_driver = {
 181         .driver.name    = "tps65910-gpio",
 182         .probe          = tps65910_gpio_probe,
 183 };
 184
 185 static int __init tps65910_gpio_init(void)
 186 {
 187         return platform_driver_register(&tps65910_gpio_driver);
 188 }
 189 subsys_initcall(tps65910_gpio_init);