LXR linux/drivers/gpio/gpio-ucb1400.c

   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Philips UCB1400 GPIO driver
   4 *
   5 * Author: Marek Vasut <marek.vasut@gmail.com>
   6 */
   7
   8#include <linux/module.h>
   9#include <linux/ucb1400.h>
  10
  11static int ucb1400_gpio_dir_in(struct gpio_chip *gc, unsigned off)
  12{
  13        struct ucb1400_gpio *gpio;
  14        gpio = gpiochip_get_data(gc);
  15        ucb1400_gpio_set_direction(gpio->ac97, off, 0);
  16        return 0;
  17}
  18
  19static int ucb1400_gpio_dir_out(struct gpio_chip *gc, unsigned off, int val)
  20{
  21        struct ucb1400_gpio *gpio;
  22        gpio = gpiochip_get_data(gc);
  23        ucb1400_gpio_set_direction(gpio->ac97, off, 1);
  24        ucb1400_gpio_set_value(gpio->ac97, off, val);
  25        return 0;
  26}
  27
  28static int ucb1400_gpio_get(struct gpio_chip *gc, unsigned off)
  29{
  30        struct ucb1400_gpio *gpio;
  31
  32        gpio = gpiochip_get_data(gc);
  33        return !!ucb1400_gpio_get_value(gpio->ac97, off);
  34}
  35
  36static void ucb1400_gpio_set(struct gpio_chip *gc, unsigned off, int val)
  37{
  38        struct ucb1400_gpio *gpio;
  39        gpio = gpiochip_get_data(gc);
  40        ucb1400_gpio_set_value(gpio->ac97, off, val);
  41}
  42
  43static int ucb1400_gpio_probe(struct platform_device *dev)
  44{
  45        struct ucb1400_gpio *ucb = dev_get_platdata(&dev->dev);
  46        int err = 0;
  47
  48        if (!(ucb && ucb->gpio_offset)) {
  49                err = -EINVAL;
  50                goto err;
  51        }
  52
  53        platform_set_drvdata(dev, ucb);
  54
  55        ucb->gc.label = "ucb1400_gpio";
  56        ucb->gc.base = ucb->gpio_offset;
  57        ucb->gc.ngpio = 10;
  58        ucb->gc.owner = THIS_MODULE;
  59
  60        ucb->gc.direction_input = ucb1400_gpio_dir_in;
  61        ucb->gc.direction_output = ucb1400_gpio_dir_out;
  62        ucb->gc.get = ucb1400_gpio_get;
  63        ucb->gc.set = ucb1400_gpio_set;
  64        ucb->gc.can_sleep = true;
  65
  66        err = devm_gpiochip_add_data(&dev->dev, &ucb->gc, ucb);
  67        if (err)
  68                goto err;
  69
  70        if (ucb->gpio_setup)
  71                err = ucb->gpio_setup(&dev->dev, ucb->gc.ngpio);
  72
  73err:
  74        return err;
  75
  76}
  77
  78static int ucb1400_gpio_remove(struct platform_device *dev)
  79{
  80        int err = 0;
  81        struct ucb1400_gpio *ucb = platform_get_drvdata(dev);
  82
  83        if (ucb && ucb->gpio_teardown) {
  84                err = ucb->gpio_teardown(&dev->dev, ucb->gc.ngpio);
  85                if (err)
  86                        return err;
  87        }
  88
  89        return err;
  90}
  91
  92static struct platform_driver ucb1400_gpio_driver = {
  93        .probe  = ucb1400_gpio_probe,
  94        .remove = ucb1400_gpio_remove,
  95        .driver = {
  96                .name   = "ucb1400_gpio"
  97        },
  98};
  99
 100module_platform_driver(ucb1400_gpio_driver);
 101
 102MODULE_DESCRIPTION("Philips UCB1400 GPIO driver");
 103MODULE_LICENSE("GPL");
 104MODULE_ALIAS("platform:ucb1400_gpio");
 105