gpio-lp87565.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (C) 2017 Texas Instruments Incorporated - http://www.ti.com/
  4 *	Keerthy <j-keerthy@ti.com>
  5 *
  6 * Based on the LP873X driver
  7 */
  8
  9#include <linux/gpio/driver.h>
 10#include <linux/module.h>
 11#include <linux/platform_device.h>
 12#include <linux/regmap.h>
 13
 14#include <linux/mfd/lp87565.h>
 15
 16struct lp87565_gpio {
 17	struct gpio_chip chip;
 18	struct regmap *map;
 19};
 20
 21static int lp87565_gpio_get(struct gpio_chip *chip, unsigned int offset)
 22{
 23	struct lp87565_gpio *gpio = gpiochip_get_data(chip);
 24	int ret, val;
 25
 26	ret = regmap_read(gpio->map, LP87565_REG_GPIO_IN, &val);
 27	if (ret < 0)
 28		return ret;
 29
 30	return !!(val & BIT(offset));
 31}
 32
 33static int lp87565_gpio_set(struct gpio_chip *chip, unsigned int offset,
 34			    int value)
 35{
 36	struct lp87565_gpio *gpio = gpiochip_get_data(chip);
 37
 38	return regmap_update_bits(gpio->map, LP87565_REG_GPIO_OUT,
 39				  BIT(offset), value ? BIT(offset) : 0);
 40}
 41
 42static int lp87565_gpio_get_direction(struct gpio_chip *chip,
 43				      unsigned int offset)
 44{
 45	struct lp87565_gpio *gpio = gpiochip_get_data(chip);
 46	int ret, val;
 47
 48	ret = regmap_read(gpio->map, LP87565_REG_GPIO_CONFIG, &val);
 49	if (ret < 0)
 50		return ret;
 51
 52	if (val & BIT(offset))
 53		return GPIO_LINE_DIRECTION_OUT;
 54
 55	return GPIO_LINE_DIRECTION_IN;
 56}
 57
 58static int lp87565_gpio_direction_input(struct gpio_chip *chip,
 59					unsigned int offset)
 60{
 61	struct lp87565_gpio *gpio = gpiochip_get_data(chip);
 62
 63	return regmap_update_bits(gpio->map,
 64				  LP87565_REG_GPIO_CONFIG,
 65				  BIT(offset), 0);
 66}
 67
 68static int lp87565_gpio_direction_output(struct gpio_chip *chip,
 69					 unsigned int offset, int value)
 70{
 71	struct lp87565_gpio *gpio = gpiochip_get_data(chip);
 72	int ret;
 73
 74	ret = lp87565_gpio_set(chip, offset, value);
 75	if (ret)
 76		return ret;
 77
 78	return regmap_update_bits(gpio->map,
 79				  LP87565_REG_GPIO_CONFIG,
 80				  BIT(offset), BIT(offset));
 81}
 82
 83static int lp87565_gpio_request(struct gpio_chip *gc, unsigned int offset)
 84{
 85	struct lp87565_gpio *gpio = gpiochip_get_data(gc);
 86	int ret;
 87
 88	switch (offset) {
 89	case 0:
 90	case 1:
 91	case 2:
 92		/*
 93		 * MUX can program the pin to be in EN1/2/3 pin mode
 94		 * Or GPIO1/2/3 mode.
 95		 * Setup the GPIO*_SEL MUX to GPIO mode
 96		 */
 97		ret = regmap_update_bits(gpio->map,
 98					 LP87565_REG_PIN_FUNCTION,
 99					 BIT(offset), BIT(offset));
100		if (ret)
101			return ret;
102
103		break;
104	default:
105		return -EINVAL;
106	}
107
108	return 0;
109}
110
111static int lp87565_gpio_set_config(struct gpio_chip *gc, unsigned int offset,
112				   unsigned long config)
113{
114	struct lp87565_gpio *gpio = gpiochip_get_data(gc);
115
116	switch (pinconf_to_config_param(config)) {
117	case PIN_CONFIG_DRIVE_OPEN_DRAIN:
118		return regmap_update_bits(gpio->map,
119					  LP87565_REG_GPIO_CONFIG,
120					  BIT(offset +
121					      __ffs(LP87565_GPIO1_OD)),
122					  BIT(offset +
123					      __ffs(LP87565_GPIO1_OD)));
124	case PIN_CONFIG_DRIVE_PUSH_PULL:
125		return regmap_update_bits(gpio->map,
126					  LP87565_REG_GPIO_CONFIG,
127					  BIT(offset +
128					      __ffs(LP87565_GPIO1_OD)), 0);
129	default:
130		return -ENOTSUPP;
131	}
132}
133
134static const struct gpio_chip template_chip = {
135	.label			= "lp87565-gpio",
136	.owner			= THIS_MODULE,
137	.request		= lp87565_gpio_request,
138	.get_direction		= lp87565_gpio_get_direction,
139	.direction_input	= lp87565_gpio_direction_input,
140	.direction_output	= lp87565_gpio_direction_output,
141	.get			= lp87565_gpio_get,
142	.set			= lp87565_gpio_set,
143	.set_config		= lp87565_gpio_set_config,
144	.base			= -1,
145	.ngpio			= 3,
146	.can_sleep		= true,
147};
148
149static int lp87565_gpio_probe(struct platform_device *pdev)
150{
151	struct lp87565_gpio *gpio;
152	struct lp87565 *lp87565;
153	int ret;
154
155	gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
156	if (!gpio)
157		return -ENOMEM;
158
159	lp87565 = dev_get_drvdata(pdev->dev.parent);
160	gpio->chip = template_chip;
161	gpio->chip.parent = lp87565->dev;
162	gpio->map = lp87565->regmap;
163
164	ret = devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio);
165	if (ret < 0) {
166		dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
167		return ret;
168	}
169
170	return 0;
171}
172
173static const struct platform_device_id lp87565_gpio_id_table[] = {
174	{ "lp87565-q1-gpio", },
175	{ /* sentinel */ }
176};
177MODULE_DEVICE_TABLE(platform, lp87565_gpio_id_table);
178
179static struct platform_driver lp87565_gpio_driver = {
180	.driver = {
181		.name = "lp87565-gpio",
182	},
183	.probe = lp87565_gpio_probe,
184	.id_table = lp87565_gpio_id_table,
185};
186module_platform_driver(lp87565_gpio_driver);
187
188MODULE_AUTHOR("Keerthy <j-keerthy@ti.com>");
189MODULE_DESCRIPTION("LP87565 GPIO driver");
190MODULE_LICENSE("GPL v2");