qiurui
/
rv1126-uboot
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

drivers: irq: support convert gpio to irq by gpio fdt phandle 

add funtion: phandle_gpio_to_irq(u32 gpio_phandle, u32 pin)

Change-Id: Iec2d1ed08138c2476bb13deb16ca06960fadd60d
Signed-off-by: Joseph Chen <chenjh@rock-chips.com>
This commit is contained in:
Joseph Chen 2017-10-19 20:33:39 +08:00 committed by Kever Yang
parent 0e508c4fef
commit 5db1153e4b
2 changed files with 69 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

68
drivers/irq/irq-gpio-switch.c
View File

@ -8,6 +8,8 @@
#include <irq-generic.h>
#include "irq-gpio-switch.h"
DECLARE_GLOBAL_DATA_PTR;
static struct gpio_bank gpio_banks[GPIO_BANK_NUM] = {
#if GPIO_BANK_NUM >= 1
GPIO_BANK_REGISTER(0, GPIO_BANK_PINS),
@ -70,6 +72,64 @@ static int _hard_gpio_to_irq(u32 gpio)
return -EINVAL;
}
static int _phandle_gpio_to_irq(u32 gpio_phandle, u32 offset)
{
int irq_gpio, bank, ret = EINVAL_GPIO;
bool found;
const char *name;
char *name_tok;
int node;
node = fdt_node_offset_by_phandle(gd->fdt_blob, gpio_phandle);
if (node < 0) {
printf("can't find node by gpio_phandle %d, ret=%d\n",
gpio_phandle, node);
return EINVAL_GPIO;
}
name = fdt_get_name(gd->fdt_blob, node, NULL);
if (!name) {
printf("can't find device name for the gpio bank\n");
return EINVAL_GPIO;
}
name_tok = strdup(name);
if (!name_tok) {
printf("Error: strdup in %s failed!\n", __func__);
return -ENOMEM;
}
name = strtok(name_tok, "@");
if (!name) {
printf("can't find correct device name for the gpio bank\n");
goto out;
}
for (bank = 0; bank < ARRAY_SIZE(gpio_banks); bank++) {
if (!strcmp(gpio_banks[bank].name, name)) {
found = true;
break;
}
}
if (!found) {
printf("irq gpio framework can't find %s\n", name);
goto out;
}
debug("%s: gpio%d-%d\n", __func__, bank, offset);
irq_gpio = RK_IRQ_GPIO(bank, offset);
if (!gpio_is_valid(irq_gpio))
goto out;
free(name_tok);
return _hard_gpio_to_irq(irq_gpio);
out:
free(name_tok);
return ret;
}
static int _irq_to_gpio(int irq)
{
int bank, pin, idx;
@ -142,6 +202,14 @@ int hard_gpio_to_irq(u32 gpio)
return _hard_gpio_to_irq(gpio);
}
int phandle_gpio_to_irq(u32 gpio_phandle, u32 pin)
{
if (gpio_phandle < 0)
return EINVAL_GPIO;
return _phandle_gpio_to_irq(gpio_phandle, pin);
}
int irq_to_gpio(int irq)
{
return _irq_to_gpio(irq);

1
include/irq-generic.h
View File

@ -76,6 +76,7 @@ int gpio_to_irq(struct gpio_desc *gpio);
#define GPIO_BANK_SHIFT 8
#define RK_IRQ_GPIO(bank, pin) (((bank) << GPIO_BANK_SHIFT) | (pin))
int hard_gpio_to_irq(unsigned gpio);
int phandle_gpio_to_irq(u32 gpio_phandle, u32 pin);
/* only irq-gpio.c can use it */
void _generic_gpio_handle_irq(int irq);