mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-21 08:19:28 +00:00
![Alexandru Ardelean](/assets/img/avatar_default.png)
The platform_set_drvdata() call is only useful if we need to retrieve back the private information. Since the driver doesn't do that, it's not useful to have it. If this is removed, we can also just do a direct return on devm_gpiochip_add_data(). We don't need to print that this call failed as there are other ways to log/see this during probe Signed-off-by: Alexandru Ardelean <aardelean@deviqon.com> Signed-off-by: Bartosz Golaszewski <bgolaszewski@baylibre.com>
226 lines
5.7 KiB
C
226 lines
5.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* GPIO Driver for Dialog DA9052 PMICs.
|
|
*
|
|
* Copyright(c) 2011 Dialog Semiconductor Ltd.
|
|
*
|
|
* Author: David Dajun Chen <dchen@diasemi.com>
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/gpio/driver.h>
|
|
#include <linux/syscalls.h>
|
|
#include <linux/seq_file.h>
|
|
|
|
#include <linux/mfd/da9052/da9052.h>
|
|
#include <linux/mfd/da9052/reg.h>
|
|
#include <linux/mfd/da9052/pdata.h>
|
|
|
|
#define DA9052_INPUT 1
|
|
#define DA9052_OUTPUT_OPENDRAIN 2
|
|
#define DA9052_OUTPUT_PUSHPULL 3
|
|
|
|
#define DA9052_SUPPLY_VDD_IO1 0
|
|
|
|
#define DA9052_DEBOUNCING_OFF 0
|
|
#define DA9052_DEBOUNCING_ON 1
|
|
|
|
#define DA9052_OUTPUT_LOWLEVEL 0
|
|
|
|
#define DA9052_ACTIVE_LOW 0
|
|
#define DA9052_ACTIVE_HIGH 1
|
|
|
|
#define DA9052_GPIO_MAX_PORTS_PER_REGISTER 8
|
|
#define DA9052_GPIO_SHIFT_COUNT(no) (no%8)
|
|
#define DA9052_GPIO_MASK_UPPER_NIBBLE 0xF0
|
|
#define DA9052_GPIO_MASK_LOWER_NIBBLE 0x0F
|
|
#define DA9052_GPIO_NIBBLE_SHIFT 4
|
|
#define DA9052_IRQ_GPI0 16
|
|
#define DA9052_GPIO_ODD_SHIFT 7
|
|
#define DA9052_GPIO_EVEN_SHIFT 3
|
|
|
|
struct da9052_gpio {
|
|
struct da9052 *da9052;
|
|
struct gpio_chip gp;
|
|
};
|
|
|
|
static unsigned char da9052_gpio_port_odd(unsigned offset)
|
|
{
|
|
return offset % 2;
|
|
}
|
|
|
|
static int da9052_gpio_get(struct gpio_chip *gc, unsigned offset)
|
|
{
|
|
struct da9052_gpio *gpio = gpiochip_get_data(gc);
|
|
int da9052_port_direction = 0;
|
|
int ret;
|
|
|
|
ret = da9052_reg_read(gpio->da9052,
|
|
DA9052_GPIO_0_1_REG + (offset >> 1));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (da9052_gpio_port_odd(offset)) {
|
|
da9052_port_direction = ret & DA9052_GPIO_ODD_PORT_PIN;
|
|
da9052_port_direction >>= 4;
|
|
} else {
|
|
da9052_port_direction = ret & DA9052_GPIO_EVEN_PORT_PIN;
|
|
}
|
|
|
|
switch (da9052_port_direction) {
|
|
case DA9052_INPUT:
|
|
if (offset < DA9052_GPIO_MAX_PORTS_PER_REGISTER)
|
|
ret = da9052_reg_read(gpio->da9052,
|
|
DA9052_STATUS_C_REG);
|
|
else
|
|
ret = da9052_reg_read(gpio->da9052,
|
|
DA9052_STATUS_D_REG);
|
|
if (ret < 0)
|
|
return ret;
|
|
return !!(ret & (1 << DA9052_GPIO_SHIFT_COUNT(offset)));
|
|
case DA9052_OUTPUT_PUSHPULL:
|
|
if (da9052_gpio_port_odd(offset))
|
|
return !!(ret & DA9052_GPIO_ODD_PORT_MODE);
|
|
else
|
|
return !!(ret & DA9052_GPIO_EVEN_PORT_MODE);
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static void da9052_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
|
|
{
|
|
struct da9052_gpio *gpio = gpiochip_get_data(gc);
|
|
int ret;
|
|
|
|
if (da9052_gpio_port_odd(offset)) {
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_ODD_PORT_MODE,
|
|
value << DA9052_GPIO_ODD_SHIFT);
|
|
if (ret != 0)
|
|
dev_err(gpio->da9052->dev,
|
|
"Failed to updated gpio odd reg,%d",
|
|
ret);
|
|
} else {
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_EVEN_PORT_MODE,
|
|
value << DA9052_GPIO_EVEN_SHIFT);
|
|
if (ret != 0)
|
|
dev_err(gpio->da9052->dev,
|
|
"Failed to updated gpio even reg,%d",
|
|
ret);
|
|
}
|
|
}
|
|
|
|
static int da9052_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
|
|
{
|
|
struct da9052_gpio *gpio = gpiochip_get_data(gc);
|
|
unsigned char register_value;
|
|
int ret;
|
|
|
|
/* Format: function - 2 bits type - 1 bit mode - 1 bit */
|
|
register_value = DA9052_INPUT | DA9052_ACTIVE_LOW << 2 |
|
|
DA9052_DEBOUNCING_ON << 3;
|
|
|
|
if (da9052_gpio_port_odd(offset))
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_MASK_UPPER_NIBBLE,
|
|
(register_value <<
|
|
DA9052_GPIO_NIBBLE_SHIFT));
|
|
else
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_MASK_LOWER_NIBBLE,
|
|
register_value);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int da9052_gpio_direction_output(struct gpio_chip *gc,
|
|
unsigned offset, int value)
|
|
{
|
|
struct da9052_gpio *gpio = gpiochip_get_data(gc);
|
|
unsigned char register_value;
|
|
int ret;
|
|
|
|
/* Format: Function - 2 bits Type - 1 bit Mode - 1 bit */
|
|
register_value = DA9052_OUTPUT_PUSHPULL | DA9052_SUPPLY_VDD_IO1 << 2 |
|
|
value << 3;
|
|
|
|
if (da9052_gpio_port_odd(offset))
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_MASK_UPPER_NIBBLE,
|
|
(register_value <<
|
|
DA9052_GPIO_NIBBLE_SHIFT));
|
|
else
|
|
ret = da9052_reg_update(gpio->da9052, (offset >> 1) +
|
|
DA9052_GPIO_0_1_REG,
|
|
DA9052_GPIO_MASK_LOWER_NIBBLE,
|
|
register_value);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int da9052_gpio_to_irq(struct gpio_chip *gc, u32 offset)
|
|
{
|
|
struct da9052_gpio *gpio = gpiochip_get_data(gc);
|
|
struct da9052 *da9052 = gpio->da9052;
|
|
|
|
int irq;
|
|
|
|
irq = regmap_irq_get_virq(da9052->irq_data, DA9052_IRQ_GPI0 + offset);
|
|
|
|
return irq;
|
|
}
|
|
|
|
static const struct gpio_chip reference_gp = {
|
|
.label = "da9052-gpio",
|
|
.owner = THIS_MODULE,
|
|
.get = da9052_gpio_get,
|
|
.set = da9052_gpio_set,
|
|
.direction_input = da9052_gpio_direction_input,
|
|
.direction_output = da9052_gpio_direction_output,
|
|
.to_irq = da9052_gpio_to_irq,
|
|
.can_sleep = true,
|
|
.ngpio = 16,
|
|
.base = -1,
|
|
};
|
|
|
|
static int da9052_gpio_probe(struct platform_device *pdev)
|
|
{
|
|
struct da9052_gpio *gpio;
|
|
struct da9052_pdata *pdata;
|
|
|
|
gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
|
|
if (!gpio)
|
|
return -ENOMEM;
|
|
|
|
gpio->da9052 = dev_get_drvdata(pdev->dev.parent);
|
|
pdata = dev_get_platdata(gpio->da9052->dev);
|
|
|
|
gpio->gp = reference_gp;
|
|
if (pdata && pdata->gpio_base)
|
|
gpio->gp.base = pdata->gpio_base;
|
|
|
|
return devm_gpiochip_add_data(&pdev->dev, &gpio->gp, gpio);
|
|
}
|
|
|
|
static struct platform_driver da9052_gpio_driver = {
|
|
.probe = da9052_gpio_probe,
|
|
.driver = {
|
|
.name = "da9052-gpio",
|
|
},
|
|
};
|
|
|
|
module_platform_driver(da9052_gpio_driver);
|
|
|
|
MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
|
|
MODULE_DESCRIPTION("DA9052 GPIO Device Driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:da9052-gpio");
|