gpio-ucb1400.c (2297B)
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");