/* * ROHM BD9571MWV-M GPIO driver * * Copyright (C) 2017 Marek Vasut * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed "as is" WITHOUT ANY WARRANTY of any * kind, whether expressed or implied; without even the implied warranty * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License version 2 for more details. * * Based on the TPS65086 driver * * NOTE: Interrupts are not supported yet. */ #include #include #include #include struct bd9571mwv_gpio { struct gpio_chip chip; struct bd9571mwv *bd; }; static int bd9571mwv_gpio_get_direction(struct gpio_chip *chip, unsigned int offset) { struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip); int ret, val; ret = regmap_read(gpio->bd->regmap, BD9571MWV_GPIO_DIR, &val); if (ret < 0) return ret; return val & BIT(offset); } static int bd9571mwv_gpio_direction_input(struct gpio_chip *chip, unsigned int offset) { struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip); regmap_update_bits(gpio->bd->regmap, BD9571MWV_GPIO_DIR, BIT(offset), 0); return 0; } static int bd9571mwv_gpio_direction_output(struct gpio_chip *chip, unsigned int offset, int value) { struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip); /* Set the initial value */ regmap_update_bits(gpio->bd->regmap, BD9571MWV_GPIO_OUT, BIT(offset), value ? BIT(offset) : 0); regmap_update_bits(gpio->bd->regmap, BD9571MWV_GPIO_DIR, BIT(offset), BIT(offset)); return 0; } static int bd9571mwv_gpio_get(struct gpio_chip *chip, unsigned int offset) { struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip); int ret, val; ret = regmap_read(gpio->bd->regmap, BD9571MWV_GPIO_IN, &val); if (ret < 0) return ret; return val & BIT(offset); } static void bd9571mwv_gpio_set(struct gpio_chip *chip, unsigned int offset, int value) { struct bd9571mwv_gpio *gpio = gpiochip_get_data(chip); regmap_update_bits(gpio->bd->regmap, BD9571MWV_GPIO_OUT, BIT(offset), value ? BIT(offset) : 0); } static const struct gpio_chip template_chip = { .label = "bd9571mwv-gpio", .owner = THIS_MODULE, .get_direction = bd9571mwv_gpio_get_direction, .direction_input = bd9571mwv_gpio_direction_input, .direction_output = bd9571mwv_gpio_direction_output, .get = bd9571mwv_gpio_get, .set = bd9571mwv_gpio_set, .base = -1, .ngpio = 2, .can_sleep = true, }; static int bd9571mwv_gpio_probe(struct platform_device *pdev) { struct bd9571mwv_gpio *gpio; int ret; gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); if (!gpio) return -ENOMEM; platform_set_drvdata(pdev, gpio); gpio->bd = dev_get_drvdata(pdev->dev.parent); gpio->chip = template_chip; gpio->chip.parent = gpio->bd->dev; ret = devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio); if (ret < 0) { dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret); return ret; } return 0; } static const struct platform_device_id bd9571mwv_gpio_id_table[] = { { "bd9571mwv-gpio", }, { /* sentinel */ } }; MODULE_DEVICE_TABLE(platform, bd9571mwv_gpio_id_table); static struct platform_driver bd9571mwv_gpio_driver = { .driver = { .name = "bd9571mwv-gpio", }, .probe = bd9571mwv_gpio_probe, .id_table = bd9571mwv_gpio_id_table, }; module_platform_driver(bd9571mwv_gpio_driver); MODULE_AUTHOR("Marek Vasut "); MODULE_DESCRIPTION("BD9571MWV GPIO driver"); MODULE_LICENSE("GPL v2");