159c32468SSrinivas Kandagatla // SPDX-License-Identifier: GPL-2.0 259c32468SSrinivas Kandagatla // Copyright (c) 2019, Linaro Limited 359c32468SSrinivas Kandagatla 459c32468SSrinivas Kandagatla #include <linux/module.h> 559c32468SSrinivas Kandagatla #include <linux/gpio/driver.h> 659c32468SSrinivas Kandagatla #include <linux/regmap.h> 759c32468SSrinivas Kandagatla #include <linux/slab.h> 859c32468SSrinivas Kandagatla #include <linux/of_device.h> 959c32468SSrinivas Kandagatla 10*dbec64b1SSrinivas Kandagatla #define WCD_PIN_MASK(p) BIT(p) 1159c32468SSrinivas Kandagatla #define WCD_REG_DIR_CTL_OFFSET 0x42 1259c32468SSrinivas Kandagatla #define WCD_REG_VAL_CTL_OFFSET 0x43 1359c32468SSrinivas Kandagatla #define WCD934X_NPINS 5 1459c32468SSrinivas Kandagatla 1559c32468SSrinivas Kandagatla struct wcd_gpio_data { 1659c32468SSrinivas Kandagatla struct regmap *map; 1759c32468SSrinivas Kandagatla struct gpio_chip chip; 1859c32468SSrinivas Kandagatla }; 1959c32468SSrinivas Kandagatla 2059c32468SSrinivas Kandagatla static int wcd_gpio_get_direction(struct gpio_chip *chip, unsigned int pin) 2159c32468SSrinivas Kandagatla { 2259c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip); 2359c32468SSrinivas Kandagatla unsigned int value; 2459c32468SSrinivas Kandagatla int ret; 2559c32468SSrinivas Kandagatla 2659c32468SSrinivas Kandagatla ret = regmap_read(data->map, WCD_REG_DIR_CTL_OFFSET, &value); 2759c32468SSrinivas Kandagatla if (ret < 0) 2859c32468SSrinivas Kandagatla return ret; 2959c32468SSrinivas Kandagatla 3059c32468SSrinivas Kandagatla if (value & WCD_PIN_MASK(pin)) 3159c32468SSrinivas Kandagatla return GPIO_LINE_DIRECTION_OUT; 3259c32468SSrinivas Kandagatla 3359c32468SSrinivas Kandagatla return GPIO_LINE_DIRECTION_IN; 3459c32468SSrinivas Kandagatla } 3559c32468SSrinivas Kandagatla 3659c32468SSrinivas Kandagatla static int wcd_gpio_direction_input(struct gpio_chip *chip, unsigned int pin) 3759c32468SSrinivas Kandagatla { 3859c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip); 3959c32468SSrinivas Kandagatla 4059c32468SSrinivas Kandagatla return regmap_update_bits(data->map, WCD_REG_DIR_CTL_OFFSET, 4159c32468SSrinivas Kandagatla WCD_PIN_MASK(pin), 0); 4259c32468SSrinivas Kandagatla } 4359c32468SSrinivas Kandagatla 4459c32468SSrinivas Kandagatla static int wcd_gpio_direction_output(struct gpio_chip *chip, unsigned int pin, 4559c32468SSrinivas Kandagatla int val) 4659c32468SSrinivas Kandagatla { 4759c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip); 4859c32468SSrinivas Kandagatla 4959c32468SSrinivas Kandagatla regmap_update_bits(data->map, WCD_REG_DIR_CTL_OFFSET, 5059c32468SSrinivas Kandagatla WCD_PIN_MASK(pin), WCD_PIN_MASK(pin)); 5159c32468SSrinivas Kandagatla 5259c32468SSrinivas Kandagatla return regmap_update_bits(data->map, WCD_REG_VAL_CTL_OFFSET, 5359c32468SSrinivas Kandagatla WCD_PIN_MASK(pin), 5459c32468SSrinivas Kandagatla val ? WCD_PIN_MASK(pin) : 0); 5559c32468SSrinivas Kandagatla } 5659c32468SSrinivas Kandagatla 5759c32468SSrinivas Kandagatla static int wcd_gpio_get(struct gpio_chip *chip, unsigned int pin) 5859c32468SSrinivas Kandagatla { 5959c32468SSrinivas Kandagatla struct wcd_gpio_data *data = gpiochip_get_data(chip); 6047203198SAxel Lin unsigned int value; 6159c32468SSrinivas Kandagatla 6259c32468SSrinivas Kandagatla regmap_read(data->map, WCD_REG_VAL_CTL_OFFSET, &value); 6359c32468SSrinivas Kandagatla 6447203198SAxel Lin return !!(value & WCD_PIN_MASK(pin)); 6559c32468SSrinivas Kandagatla } 6659c32468SSrinivas Kandagatla 6759c32468SSrinivas Kandagatla static void wcd_gpio_set(struct gpio_chip *chip, unsigned int pin, int val) 6859c32468SSrinivas Kandagatla { 6947d7d116SAxel Lin struct wcd_gpio_data *data = gpiochip_get_data(chip); 7047d7d116SAxel Lin 7147d7d116SAxel Lin regmap_update_bits(data->map, WCD_REG_VAL_CTL_OFFSET, 7247d7d116SAxel Lin WCD_PIN_MASK(pin), val ? WCD_PIN_MASK(pin) : 0); 7359c32468SSrinivas Kandagatla } 7459c32468SSrinivas Kandagatla 7559c32468SSrinivas Kandagatla static int wcd_gpio_probe(struct platform_device *pdev) 7659c32468SSrinivas Kandagatla { 7759c32468SSrinivas Kandagatla struct device *dev = &pdev->dev; 7859c32468SSrinivas Kandagatla struct wcd_gpio_data *data; 7959c32468SSrinivas Kandagatla struct gpio_chip *chip; 8059c32468SSrinivas Kandagatla 8159c32468SSrinivas Kandagatla data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 8259c32468SSrinivas Kandagatla if (!data) 8359c32468SSrinivas Kandagatla return -ENOMEM; 8459c32468SSrinivas Kandagatla 8559c32468SSrinivas Kandagatla data->map = dev_get_regmap(dev->parent, NULL); 8659c32468SSrinivas Kandagatla if (!data->map) { 8759c32468SSrinivas Kandagatla dev_err(dev, "%s: failed to get regmap\n", __func__); 8859c32468SSrinivas Kandagatla return -EINVAL; 8959c32468SSrinivas Kandagatla } 9059c32468SSrinivas Kandagatla 9159c32468SSrinivas Kandagatla chip = &data->chip; 9259c32468SSrinivas Kandagatla chip->direction_input = wcd_gpio_direction_input; 9359c32468SSrinivas Kandagatla chip->direction_output = wcd_gpio_direction_output; 9459c32468SSrinivas Kandagatla chip->get_direction = wcd_gpio_get_direction; 9559c32468SSrinivas Kandagatla chip->get = wcd_gpio_get; 9659c32468SSrinivas Kandagatla chip->set = wcd_gpio_set; 9759c32468SSrinivas Kandagatla chip->parent = dev; 9859c32468SSrinivas Kandagatla chip->base = -1; 9959c32468SSrinivas Kandagatla chip->ngpio = WCD934X_NPINS; 10059c32468SSrinivas Kandagatla chip->label = dev_name(dev); 10159c32468SSrinivas Kandagatla chip->of_gpio_n_cells = 2; 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