131 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * ROHM BD9571MWV-M and BD9574MWF-M GPIO driver4 *5 * Copyright (C) 2017 Marek Vasut <marek.vasut+renesas@gmail.com>6 *7 * Based on the TPS65086 driver8 *9 * NOTE: Interrupts are not supported yet.10 */11 12#include <linux/gpio/driver.h>13#include <linux/mfd/rohm-generic.h>14#include <linux/module.h>15#include <linux/platform_device.h>16 17#include <linux/mfd/bd9571mwv.h>18 19struct bd9571mwv_gpio {20 struct regmap *regmap;21 struct gpio_chip chip;22};23 24static int bd9571mwv_gpio_get_direction(struct gpio_chip *chip,25 unsigned int offset)26{27 struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip);28 int ret, val;29 30 ret = regmap_read(gpio->regmap, BD9571MWV_GPIO_DIR, &val);31 if (ret < 0)32 return ret;33 if (val & BIT(offset))34 return GPIO_LINE_DIRECTION_IN;35 36 return GPIO_LINE_DIRECTION_OUT;37}38 39static int bd9571mwv_gpio_direction_input(struct gpio_chip *chip,40 unsigned int offset)41{42 struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip);43 44 regmap_update_bits(gpio->regmap, BD9571MWV_GPIO_DIR, BIT(offset), 0);45 46 return 0;47}48 49static int bd9571mwv_gpio_direction_output(struct gpio_chip *chip,50 unsigned int offset, int value)51{52 struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip);53 54 /* Set the initial value */55 regmap_update_bits(gpio->regmap, BD9571MWV_GPIO_OUT,56 BIT(offset), value ? BIT(offset) : 0);57 regmap_update_bits(gpio->regmap, BD9571MWV_GPIO_DIR,58 BIT(offset), BIT(offset));59 60 return 0;61}62 63static int bd9571mwv_gpio_get(struct gpio_chip *chip, unsigned int offset)64{65 struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip);66 int ret, val;67 68 ret = regmap_read(gpio->regmap, BD9571MWV_GPIO_IN, &val);69 if (ret < 0)70 return ret;71 72 return val & BIT(offset);73}74 75static void bd9571mwv_gpio_set(struct gpio_chip *chip, unsigned int offset,76 int value)77{78 struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip);79 80 regmap_update_bits(gpio->regmap, BD9571MWV_GPIO_OUT,81 BIT(offset), value ? BIT(offset) : 0);82}83 84static const struct gpio_chip template_chip = {85 .label = "bd9571mwv-gpio",86 .owner = THIS_MODULE,87 .get_direction = bd9571mwv_gpio_get_direction,88 .direction_input = bd9571mwv_gpio_direction_input,89 .direction_output = bd9571mwv_gpio_direction_output,90 .get = bd9571mwv_gpio_get,91 .set = bd9571mwv_gpio_set,92 .base = -1,93 .ngpio = 2,94 .can_sleep = true,95};96 97static int bd9571mwv_gpio_probe(struct platform_device *pdev)98{99 struct bd9571mwv_gpio *gpio;100 101 gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);102 if (!gpio)103 return -ENOMEM;104 105 gpio->regmap = dev_get_regmap(pdev->dev.parent, NULL);106 gpio->chip = template_chip;107 gpio->chip.parent = pdev->dev.parent;108 109 return devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio);110}111 112static const struct platform_device_id bd9571mwv_gpio_id_table[] = {113 { "bd9571mwv-gpio", ROHM_CHIP_TYPE_BD9571 },114 { "bd9574mwf-gpio", ROHM_CHIP_TYPE_BD9574 },115 { /* sentinel */ }116};117MODULE_DEVICE_TABLE(platform, bd9571mwv_gpio_id_table);118 119static struct platform_driver bd9571mwv_gpio_driver = {120 .driver = {121 .name = "bd9571mwv-gpio",122 },123 .probe = bd9571mwv_gpio_probe,124 .id_table = bd9571mwv_gpio_id_table,125};126module_platform_driver(bd9571mwv_gpio_driver);127 128MODULE_AUTHOR("Marek Vasut <marek.vasut+renesas@gmail.com>");129MODULE_DESCRIPTION("BD9571MWV GPIO driver");130MODULE_LICENSE("GPL v2");131