forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
235 lines
5.8 KiB
235 lines
5.8 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* GPIO Driver for Dialog DA9052 PMICs. |
|
* |
|
* Copyright(c) 2011 Dialog Semiconductor Ltd. |
|
* |
|
* Author: David Dajun Chen <[email protected]> |
|
*/ |
|
#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; |
|
int ret; |
|
|
|
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; |
|
|
|
ret = devm_gpiochip_add_data(&pdev->dev, &gpio->gp, gpio); |
|
if (ret < 0) { |
|
dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret); |
|
return ret; |
|
} |
|
|
|
platform_set_drvdata(pdev, gpio); |
|
|
|
return 0; |
|
} |
|
|
|
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 <[email protected]>"); |
|
MODULE_DESCRIPTION("DA9052 GPIO Device Driver"); |
|
MODULE_LICENSE("GPL"); |
|
MODULE_ALIAS("platform:da9052-gpio");
|
|
|