159c32468SSrinivas Kandagatla // SPDX-License-Identifier: GPL-2.0
259c32468SSrinivas Kandagatla // Copyright (c) 2019, Linaro Limited
359c32468SSrinivas Kandagatla
4*e91d0f05SRob Herring #include <linux/mod_devicetable.h>
559c32468SSrinivas Kandagatla #include <linux/module.h>
659c32468SSrinivas Kandagatla #include <linux/gpio/driver.h>
7*e91d0f05SRob Herring #include <linux/platform_device.h>
859c32468SSrinivas Kandagatla #include <linux/regmap.h>
959c32468SSrinivas Kandagatla #include <linux/slab.h>
1059c32468SSrinivas Kandagatla
11dbec64b1SSrinivas Kandagatla #define WCD_PIN_MASK(p) BIT(p)
1259c32468SSrinivas Kandagatla #define WCD_REG_DIR_CTL_OFFSET 0x42
1359c32468SSrinivas Kandagatla #define WCD_REG_VAL_CTL_OFFSET 0x43
1459c32468SSrinivas Kandagatla #define WCD934X_NPINS 5
1559c32468SSrinivas Kandagatla
1659c32468SSrinivas Kandagatla struct wcd_gpio_data {
1759c32468SSrinivas Kandagatla struct regmap *map;
1859c32468SSrinivas Kandagatla struct gpio_chip chip;
1959c32468SSrinivas Kandagatla };
2059c32468SSrinivas Kandagatla
wcd_gpio_get_direction(struct gpio_chip * chip,unsigned int pin)2159c32468SSrinivas Kandagatla static int wcd_gpio_get_direction(struct gpio_chip *chip, unsigned int pin)
2259c32468SSrinivas Kandagatla {
2359c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip);
2459c32468SSrinivas Kandagatla unsigned int value;
2559c32468SSrinivas Kandagatla int ret;
2659c32468SSrinivas Kandagatla
2759c32468SSrinivas Kandagatla ret = regmap_read(data->map, WCD_REG_DIR_CTL_OFFSET, &value);
2859c32468SSrinivas Kandagatla if (ret < 0)
2959c32468SSrinivas Kandagatla return ret;
3059c32468SSrinivas Kandagatla
3159c32468SSrinivas Kandagatla if (value & WCD_PIN_MASK(pin))
3259c32468SSrinivas Kandagatla return GPIO_LINE_DIRECTION_OUT;
3359c32468SSrinivas Kandagatla
3459c32468SSrinivas Kandagatla return GPIO_LINE_DIRECTION_IN;
3559c32468SSrinivas Kandagatla }
3659c32468SSrinivas Kandagatla
wcd_gpio_direction_input(struct gpio_chip * chip,unsigned int pin)3759c32468SSrinivas Kandagatla static int wcd_gpio_direction_input(struct gpio_chip *chip, unsigned int pin)
3859c32468SSrinivas Kandagatla {
3959c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip);
4059c32468SSrinivas Kandagatla
4159c32468SSrinivas Kandagatla return regmap_update_bits(data->map, WCD_REG_DIR_CTL_OFFSET,
4259c32468SSrinivas Kandagatla WCD_PIN_MASK(pin), 0);
4359c32468SSrinivas Kandagatla }
4459c32468SSrinivas Kandagatla
wcd_gpio_direction_output(struct gpio_chip * chip,unsigned int pin,int val)4559c32468SSrinivas Kandagatla static int wcd_gpio_direction_output(struct gpio_chip *chip, unsigned int pin,
4659c32468SSrinivas Kandagatla int val)
4759c32468SSrinivas Kandagatla {
4859c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip);
4959c32468SSrinivas Kandagatla
5059c32468SSrinivas Kandagatla regmap_update_bits(data->map, WCD_REG_DIR_CTL_OFFSET,
5159c32468SSrinivas Kandagatla WCD_PIN_MASK(pin), WCD_PIN_MASK(pin));
5259c32468SSrinivas Kandagatla
5359c32468SSrinivas Kandagatla return regmap_update_bits(data->map, WCD_REG_VAL_CTL_OFFSET,
5459c32468SSrinivas Kandagatla WCD_PIN_MASK(pin),
5559c32468SSrinivas Kandagatla val ? WCD_PIN_MASK(pin) : 0);
5659c32468SSrinivas Kandagatla }
5759c32468SSrinivas Kandagatla
wcd_gpio_get(struct gpio_chip * chip,unsigned int pin)5859c32468SSrinivas Kandagatla static int wcd_gpio_get(struct gpio_chip *chip, unsigned int pin)
5959c32468SSrinivas Kandagatla {
6059c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip);
6147203198SAxel Lin unsigned int value;
6259c32468SSrinivas Kandagatla
6359c32468SSrinivas Kandagatla regmap_read(data->map, WCD_REG_VAL_CTL_OFFSET, &value);
6459c32468SSrinivas Kandagatla
6547203198SAxel Lin return !!(value & WCD_PIN_MASK(pin));
6659c32468SSrinivas Kandagatla }
6759c32468SSrinivas Kandagatla
wcd_gpio_set(struct gpio_chip * chip,unsigned int pin,int val)6859c32468SSrinivas Kandagatla static void wcd_gpio_set(struct gpio_chip *chip, unsigned int pin, int val)
6959c32468SSrinivas Kandagatla {
7047d7d116SAxel Lin struct wcd_gpio_data *data = gpiochip_get_data(chip);
7147d7d116SAxel Lin
7247d7d116SAxel Lin regmap_update_bits(data->map, WCD_REG_VAL_CTL_OFFSET,
7347d7d116SAxel Lin WCD_PIN_MASK(pin), val ? WCD_PIN_MASK(pin) : 0);
7459c32468SSrinivas Kandagatla }
7559c32468SSrinivas Kandagatla
wcd_gpio_probe(struct platform_device * pdev)7659c32468SSrinivas Kandagatla static int wcd_gpio_probe(struct platform_device *pdev)
7759c32468SSrinivas Kandagatla {
7859c32468SSrinivas Kandagatla struct device *dev = &pdev->dev;
7959c32468SSrinivas Kandagatla struct wcd_gpio_data *data;
8059c32468SSrinivas Kandagatla struct gpio_chip *chip;
8159c32468SSrinivas Kandagatla
8259c32468SSrinivas Kandagatla data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
8359c32468SSrinivas Kandagatla if (!data)
8459c32468SSrinivas Kandagatla return -ENOMEM;
8559c32468SSrinivas Kandagatla
8659c32468SSrinivas Kandagatla data->map = dev_get_regmap(dev->parent, NULL);
8759c32468SSrinivas Kandagatla if (!data->map) {
8859c32468SSrinivas Kandagatla dev_err(dev, "%s: failed to get regmap\n", __func__);
8959c32468SSrinivas Kandagatla return -EINVAL;
9059c32468SSrinivas Kandagatla }
9159c32468SSrinivas Kandagatla
9259c32468SSrinivas Kandagatla chip = &data->chip;
9359c32468SSrinivas Kandagatla chip->direction_input = wcd_gpio_direction_input;
9459c32468SSrinivas Kandagatla chip->direction_output = wcd_gpio_direction_output;
9559c32468SSrinivas Kandagatla chip->get_direction = wcd_gpio_get_direction;
9659c32468SSrinivas Kandagatla chip->get = wcd_gpio_get;
9759c32468SSrinivas Kandagatla chip->set = wcd_gpio_set;
9859c32468SSrinivas Kandagatla chip->parent = dev;
9959c32468SSrinivas Kandagatla chip->base = -1;
10059c32468SSrinivas Kandagatla chip->ngpio = WCD934X_NPINS;
10159c32468SSrinivas Kandagatla chip->label = dev_name(dev);
10259c32468SSrinivas Kandagatla chip->can_sleep = false;
10359c32468SSrinivas Kandagatla
10459c32468SSrinivas Kandagatla return devm_gpiochip_add_data(dev, chip, data);
10559c32468SSrinivas Kandagatla }
10659c32468SSrinivas Kandagatla
10759c32468SSrinivas Kandagatla static const struct of_device_id wcd_gpio_of_match[] = {
10859c32468SSrinivas Kandagatla { .compatible = "qcom,wcd9340-gpio" },
10959c32468SSrinivas Kandagatla { .compatible = "qcom,wcd9341-gpio" },
11059c32468SSrinivas Kandagatla { }
11159c32468SSrinivas Kandagatla };
11259c32468SSrinivas Kandagatla MODULE_DEVICE_TABLE(of, wcd_gpio_of_match);
11359c32468SSrinivas Kandagatla
11459c32468SSrinivas Kandagatla static struct platform_driver wcd_gpio_driver = {
11559c32468SSrinivas Kandagatla .driver = {
11659c32468SSrinivas Kandagatla .name = "wcd934x-gpio",
11759c32468SSrinivas Kandagatla .of_match_table = wcd_gpio_of_match,
11859c32468SSrinivas Kandagatla },
11959c32468SSrinivas Kandagatla .probe = wcd_gpio_probe,
12059c32468SSrinivas Kandagatla };
12159c32468SSrinivas Kandagatla
12259c32468SSrinivas Kandagatla module_platform_driver(wcd_gpio_driver);
12359c32468SSrinivas Kandagatla MODULE_DESCRIPTION("Qualcomm Technologies, Inc WCD GPIO control driver");
12459c32468SSrinivas Kandagatla MODULE_LICENSE("GPL v2");
125