162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * TI Palma series PMIC's GPIO driver.
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (c) 2012, NVIDIA CORPORATION.  All rights reserved.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Author: Laxman Dewangan <ldewangan@nvidia.com>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include <linux/gpio/driver.h>
1162306a36Sopenharmony_ci#include <linux/kernel.h>
1262306a36Sopenharmony_ci#include <linux/init.h>
1362306a36Sopenharmony_ci#include <linux/mfd/palmas.h>
1462306a36Sopenharmony_ci#include <linux/of.h>
1562306a36Sopenharmony_ci#include <linux/platform_device.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_cistruct palmas_gpio {
1862306a36Sopenharmony_ci	struct gpio_chip gpio_chip;
1962306a36Sopenharmony_ci	struct palmas *palmas;
2062306a36Sopenharmony_ci};
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_cistruct palmas_device_data {
2362306a36Sopenharmony_ci	int ngpio;
2462306a36Sopenharmony_ci};
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_cistatic int palmas_gpio_get(struct gpio_chip *gc, unsigned offset)
2762306a36Sopenharmony_ci{
2862306a36Sopenharmony_ci	struct palmas_gpio *pg = gpiochip_get_data(gc);
2962306a36Sopenharmony_ci	struct palmas *palmas = pg->palmas;
3062306a36Sopenharmony_ci	unsigned int val;
3162306a36Sopenharmony_ci	int ret;
3262306a36Sopenharmony_ci	unsigned int reg;
3362306a36Sopenharmony_ci	int gpio16 = (offset/8);
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	offset %= 8;
3662306a36Sopenharmony_ci	reg = (gpio16) ? PALMAS_GPIO_DATA_DIR2 : PALMAS_GPIO_DATA_DIR;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	ret = palmas_read(palmas, PALMAS_GPIO_BASE, reg, &val);
3962306a36Sopenharmony_ci	if (ret < 0) {
4062306a36Sopenharmony_ci		dev_err(gc->parent, "Reg 0x%02x read failed, %d\n", reg, ret);
4162306a36Sopenharmony_ci		return ret;
4262306a36Sopenharmony_ci	}
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	if (val & BIT(offset))
4562306a36Sopenharmony_ci		reg = (gpio16) ? PALMAS_GPIO_DATA_OUT2 : PALMAS_GPIO_DATA_OUT;
4662306a36Sopenharmony_ci	else
4762306a36Sopenharmony_ci		reg = (gpio16) ? PALMAS_GPIO_DATA_IN2 : PALMAS_GPIO_DATA_IN;
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci	ret = palmas_read(palmas, PALMAS_GPIO_BASE, reg, &val);
5062306a36Sopenharmony_ci	if (ret < 0) {
5162306a36Sopenharmony_ci		dev_err(gc->parent, "Reg 0x%02x read failed, %d\n", reg, ret);
5262306a36Sopenharmony_ci		return ret;
5362306a36Sopenharmony_ci	}
5462306a36Sopenharmony_ci	return !!(val & BIT(offset));
5562306a36Sopenharmony_ci}
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_cistatic void palmas_gpio_set(struct gpio_chip *gc, unsigned offset,
5862306a36Sopenharmony_ci			int value)
5962306a36Sopenharmony_ci{
6062306a36Sopenharmony_ci	struct palmas_gpio *pg = gpiochip_get_data(gc);
6162306a36Sopenharmony_ci	struct palmas *palmas = pg->palmas;
6262306a36Sopenharmony_ci	int ret;
6362306a36Sopenharmony_ci	unsigned int reg;
6462306a36Sopenharmony_ci	int gpio16 = (offset/8);
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	offset %= 8;
6762306a36Sopenharmony_ci	if (gpio16)
6862306a36Sopenharmony_ci		reg = (value) ?
6962306a36Sopenharmony_ci			PALMAS_GPIO_SET_DATA_OUT2 : PALMAS_GPIO_CLEAR_DATA_OUT2;
7062306a36Sopenharmony_ci	else
7162306a36Sopenharmony_ci		reg = (value) ?
7262306a36Sopenharmony_ci			PALMAS_GPIO_SET_DATA_OUT : PALMAS_GPIO_CLEAR_DATA_OUT;
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	ret = palmas_write(palmas, PALMAS_GPIO_BASE, reg, BIT(offset));
7562306a36Sopenharmony_ci	if (ret < 0)
7662306a36Sopenharmony_ci		dev_err(gc->parent, "Reg 0x%02x write failed, %d\n", reg, ret);
7762306a36Sopenharmony_ci}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_cistatic int palmas_gpio_output(struct gpio_chip *gc, unsigned offset,
8062306a36Sopenharmony_ci				int value)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	struct palmas_gpio *pg = gpiochip_get_data(gc);
8362306a36Sopenharmony_ci	struct palmas *palmas = pg->palmas;
8462306a36Sopenharmony_ci	int ret;
8562306a36Sopenharmony_ci	unsigned int reg;
8662306a36Sopenharmony_ci	int gpio16 = (offset/8);
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	offset %= 8;
8962306a36Sopenharmony_ci	reg = (gpio16) ? PALMAS_GPIO_DATA_DIR2 : PALMAS_GPIO_DATA_DIR;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	/* Set the initial value */
9262306a36Sopenharmony_ci	palmas_gpio_set(gc, offset, value);
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	ret = palmas_update_bits(palmas, PALMAS_GPIO_BASE, reg,
9562306a36Sopenharmony_ci				BIT(offset), BIT(offset));
9662306a36Sopenharmony_ci	if (ret < 0)
9762306a36Sopenharmony_ci		dev_err(gc->parent, "Reg 0x%02x update failed, %d\n", reg,
9862306a36Sopenharmony_ci			ret);
9962306a36Sopenharmony_ci	return ret;
10062306a36Sopenharmony_ci}
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_cistatic int palmas_gpio_input(struct gpio_chip *gc, unsigned offset)
10362306a36Sopenharmony_ci{
10462306a36Sopenharmony_ci	struct palmas_gpio *pg = gpiochip_get_data(gc);
10562306a36Sopenharmony_ci	struct palmas *palmas = pg->palmas;
10662306a36Sopenharmony_ci	int ret;
10762306a36Sopenharmony_ci	unsigned int reg;
10862306a36Sopenharmony_ci	int gpio16 = (offset/8);
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	offset %= 8;
11162306a36Sopenharmony_ci	reg = (gpio16) ? PALMAS_GPIO_DATA_DIR2 : PALMAS_GPIO_DATA_DIR;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	ret = palmas_update_bits(palmas, PALMAS_GPIO_BASE, reg, BIT(offset), 0);
11462306a36Sopenharmony_ci	if (ret < 0)
11562306a36Sopenharmony_ci		dev_err(gc->parent, "Reg 0x%02x update failed, %d\n", reg,
11662306a36Sopenharmony_ci			ret);
11762306a36Sopenharmony_ci	return ret;
11862306a36Sopenharmony_ci}
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_cistatic int palmas_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
12162306a36Sopenharmony_ci{
12262306a36Sopenharmony_ci	struct palmas_gpio *pg = gpiochip_get_data(gc);
12362306a36Sopenharmony_ci	struct palmas *palmas = pg->palmas;
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci	return palmas_irq_get_virq(palmas, PALMAS_GPIO_0_IRQ + offset);
12662306a36Sopenharmony_ci}
12762306a36Sopenharmony_ci
12862306a36Sopenharmony_cistatic const struct palmas_device_data palmas_dev_data = {
12962306a36Sopenharmony_ci	.ngpio = 8,
13062306a36Sopenharmony_ci};
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_cistatic const struct palmas_device_data tps80036_dev_data = {
13362306a36Sopenharmony_ci	.ngpio = 16,
13462306a36Sopenharmony_ci};
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_cistatic const struct of_device_id of_palmas_gpio_match[] = {
13762306a36Sopenharmony_ci	{ .compatible = "ti,palmas-gpio", .data = &palmas_dev_data,},
13862306a36Sopenharmony_ci	{ .compatible = "ti,tps65913-gpio", .data = &palmas_dev_data,},
13962306a36Sopenharmony_ci	{ .compatible = "ti,tps65914-gpio", .data = &palmas_dev_data,},
14062306a36Sopenharmony_ci	{ .compatible = "ti,tps80036-gpio", .data = &tps80036_dev_data,},
14162306a36Sopenharmony_ci	{ },
14262306a36Sopenharmony_ci};
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_cistatic int palmas_gpio_probe(struct platform_device *pdev)
14562306a36Sopenharmony_ci{
14662306a36Sopenharmony_ci	struct palmas *palmas = dev_get_drvdata(pdev->dev.parent);
14762306a36Sopenharmony_ci	struct palmas_platform_data *palmas_pdata;
14862306a36Sopenharmony_ci	struct palmas_gpio *palmas_gpio;
14962306a36Sopenharmony_ci	int ret;
15062306a36Sopenharmony_ci	const struct palmas_device_data *dev_data;
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	dev_data = of_device_get_match_data(&pdev->dev);
15362306a36Sopenharmony_ci	if (!dev_data)
15462306a36Sopenharmony_ci		dev_data = &palmas_dev_data;
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	palmas_gpio = devm_kzalloc(&pdev->dev,
15762306a36Sopenharmony_ci				sizeof(*palmas_gpio), GFP_KERNEL);
15862306a36Sopenharmony_ci	if (!palmas_gpio)
15962306a36Sopenharmony_ci		return -ENOMEM;
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_ci	palmas_gpio->palmas = palmas;
16262306a36Sopenharmony_ci	palmas_gpio->gpio_chip.owner = THIS_MODULE;
16362306a36Sopenharmony_ci	palmas_gpio->gpio_chip.label = dev_name(&pdev->dev);
16462306a36Sopenharmony_ci	palmas_gpio->gpio_chip.ngpio = dev_data->ngpio;
16562306a36Sopenharmony_ci	palmas_gpio->gpio_chip.can_sleep = true;
16662306a36Sopenharmony_ci	palmas_gpio->gpio_chip.direction_input = palmas_gpio_input;
16762306a36Sopenharmony_ci	palmas_gpio->gpio_chip.direction_output = palmas_gpio_output;
16862306a36Sopenharmony_ci	palmas_gpio->gpio_chip.to_irq = palmas_gpio_to_irq;
16962306a36Sopenharmony_ci	palmas_gpio->gpio_chip.set	= palmas_gpio_set;
17062306a36Sopenharmony_ci	palmas_gpio->gpio_chip.get	= palmas_gpio_get;
17162306a36Sopenharmony_ci	palmas_gpio->gpio_chip.parent = &pdev->dev;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	palmas_pdata = dev_get_platdata(palmas->dev);
17462306a36Sopenharmony_ci	if (palmas_pdata && palmas_pdata->gpio_base)
17562306a36Sopenharmony_ci		palmas_gpio->gpio_chip.base = palmas_pdata->gpio_base;
17662306a36Sopenharmony_ci	else
17762306a36Sopenharmony_ci		palmas_gpio->gpio_chip.base = -1;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	ret = devm_gpiochip_add_data(&pdev->dev, &palmas_gpio->gpio_chip,
18062306a36Sopenharmony_ci				     palmas_gpio);
18162306a36Sopenharmony_ci	if (ret < 0) {
18262306a36Sopenharmony_ci		dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
18362306a36Sopenharmony_ci		return ret;
18462306a36Sopenharmony_ci	}
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	return ret;
18762306a36Sopenharmony_ci}
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_cistatic struct platform_driver palmas_gpio_driver = {
19062306a36Sopenharmony_ci	.driver.name	= "palmas-gpio",
19162306a36Sopenharmony_ci	.driver.of_match_table = of_palmas_gpio_match,
19262306a36Sopenharmony_ci	.probe		= palmas_gpio_probe,
19362306a36Sopenharmony_ci};
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_cistatic int __init palmas_gpio_init(void)
19662306a36Sopenharmony_ci{
19762306a36Sopenharmony_ci	return platform_driver_register(&palmas_gpio_driver);
19862306a36Sopenharmony_ci}
19962306a36Sopenharmony_cisubsys_initcall(palmas_gpio_init);
200