android13/u-boot/drivers/irq/irq-gpio-switch.c

/*
 * (C) Copyright 2017 Rockchip Electronics Co., Ltd
 *
 * SPDX-License-Identifier:     GPL-2.0+
 */

#include <dm.h>
#include "irq-internal.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),
#endif
#if GPIO_BANK_NUM >= 2
	GPIO_BANK_REGISTER(1, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 3
	GPIO_BANK_REGISTER(2, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 4
	GPIO_BANK_REGISTER(3, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 5
	GPIO_BANK_REGISTER(4, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 6
	GPIO_BANK_REGISTER(5, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 7
	GPIO_BANK_REGISTER(6, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 8
	GPIO_BANK_REGISTER(7, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 9
	GPIO_BANK_REGISTER(8, GPIO_BANK_PINS),
#endif
#if GPIO_BANK_NUM >= 10
	GPIO_BANK_REGISTER(9, GPIO_BANK_PINS),
#endif
};

static const char *aliases_gpios[GPIO_BANK_NUM];
static const char *order_gpios[GPIO_BANK_NUM];

static int gpio_is_valid(u32 gpio)
{
	if ((gpio == EINVAL_GPIO) ||
	    !GPIO_BANK_VALID(gpio) ||
	    !GPIO_PIN_VALID(gpio)) {
		IRQ_E("gpio-%d(bank-%d, pin-%d) is invalid!\n",
		      gpio, GPIO_BANK(gpio), GPIO_PIN(gpio));
		return 0;
	}

	return 1;
}

static int __hard_gpio_to_irq(u32 gpio)
{
	int idx, bank = 0, pin = 0;
	int irq;

	if (!gpio_is_valid(gpio))
		return -EINVAL;

	bank = (gpio & GPIO_BANK_MASK) >> GPIO_BANK_OFFSET;
	pin = (gpio & GPIO_PIN_MASK) >> GPIO_PIN_OFFSET;

	for (idx = 0; idx < ARRAY_SIZE(gpio_banks); idx++) {
		if (gpio_banks[idx].id == bank) {
			irq = (gpio_banks[idx].irq_base + pin);
			if (irq_is_busy(irq))
				return -EBUSY;
			return irq;
		}
	}

	return -EINVAL;
}

static int init_order_gpios(void)
{
	const void *fdt = gd->fdt_blob;
	static int initialized;
	int node, offset;
	int i = 0;

	if (initialized)
		return 0;

	node = fdt_path_offset(fdt, "/pinctrl");
	if (node < 0)
		return -EINVAL;

	for (offset = fdt_first_subnode(fdt, node);
	     offset >= 0 && i < GPIO_BANK_NUM;
	     offset = fdt_next_subnode(fdt, offset)) {
		if (i >= GPIO_BANK_NUM)
			break;

		order_gpios[i++] = fdt_get_name(fdt, offset, NULL);
		IRQ_D("order gpio: %s\n", order_gpios[i - 1]);
	}

	initialized = 1;

	return 0;
}

static int init_aliases_gpios(void)
{
	static int initialized;
	char alias_name[6];
	int i;

	if (initialized)
		return 0;

	for (i = 0; i < GPIO_BANK_NUM; i++) {
		snprintf(alias_name, 6, "gpio%d", i);
		aliases_gpios[i] = fdt_get_alias(gd->fdt_blob, alias_name);
		if (!aliases_gpios[i])
			return -EINVAL;

		IRQ_D("aliases gpio: %s\n", aliases_gpios[i]);
	}

	initialized = 1;

	return 0;
}

static int lookup_gpio_bank(const char *name)
{
	int bank, ret;

	for (bank = 0; bank < GPIO_BANK_NUM; bank++) {
		if (strstr(name, gpio_banks[bank].name))
			return bank;
	}

	ret = init_aliases_gpios();
	for (bank = 0; !ret && bank < GPIO_BANK_NUM; bank++) {
		/*
		 * @name pattern can be:
		 *	/pinctrl/gpio@fd8a0000 or gpio@fd8a0000
		 */
		if (strstr(aliases_gpios[bank], name))
			return bank;
	}

	ret = init_order_gpios();
	for (bank = 0; !ret && bank < GPIO_BANK_NUM; bank++) {
		if (!strcmp(name, order_gpios[bank]))
			return bank;
	}

	return -ENOENT;
}

static int __phandle_gpio_to_irq(u32 gpio_phandle, u32 offset)
{
	const void *blob = gd->fdt_blob;
	const char *gpio_name;
	int irq, node;
	int bank;

	node = fdt_node_offset_by_phandle(blob, gpio_phandle);
	if (node < 0) {
		IRQ_E("No gpio node by phandle(0x%x), ret=%d\n", gpio_phandle, node);
		return EINVAL_GPIO;
	}

	gpio_name = fdt_get_name(blob, node, NULL);
	if (!gpio_name)
		return EINVAL_GPIO;

	bank = lookup_gpio_bank(gpio_name);
	if (bank < 0) {
		IRQ_E("IRQ Framework can't find: %s\n", gpio_name);
		return EINVAL_GPIO;
	}

	IRQ_D("%s: gpio%d-%d\n", __func__, bank, offset);

	irq = RK_IRQ_GPIO(bank, offset);
	if (!gpio_is_valid(irq))
		return EINVAL_GPIO;

	return __hard_gpio_to_irq(irq);
}

static int __irq_to_gpio(int irq)
{
	int bank, pin, idx;

	bank = (irq - PIN_BASE) / GPIO_BANK_PINS;
	pin = (irq - PIN_BASE) % GPIO_BANK_PINS;

	for (idx = 0; idx < ARRAY_SIZE(gpio_banks); idx++) {
		if (gpio_banks[idx].id == bank) {
			return (bank << GPIO_BANK_OFFSET) |
				(pin << GPIO_PIN_OFFSET);
		}
	}

	return -EINVAL;
}

int gpio_to_irq(struct gpio_desc *gpio)
{
	int irq_gpio, bank, ret = EINVAL_GPIO;
	char *name, *name_tok;
	bool found;

	if (!gpio->dev->name) {
		IRQ_E("Can't find dev name for gpio bank\n");
		return EINVAL_GPIO;
	}

	name_tok = strdup(gpio->dev->name);
	if (!name_tok) {
		IRQ_E("Strdup '%s' failed!\n", gpio->dev->name);
		return -ENOMEM;
	}

	name = strtok(name_tok, "@");
	if (!name) {
		IRQ_E("Can't strtok '@' for '%s'\n", name_tok);
		goto out;
	}

	for (bank = 0; bank < ARRAY_SIZE(gpio_banks); bank++) {
		if (!strcmp(gpio_banks[bank].name, name)) {
			found = true;
			break;
		}
	}

	if (!found) {
		IRQ_E("GPIO irq framework can't find '%s'\n", name);
		goto out;
	}

	irq_gpio = RK_IRQ_GPIO(bank, gpio->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;
}

int hard_gpio_to_irq(u32 gpio)
{
	if (!gpio_is_valid(gpio))
		return EINVAL_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);
}

struct gpio_bank *gpio_id_to_bank(u32 id)
{
	int idx;

	for (idx = 0; idx < ARRAY_SIZE(gpio_banks); idx++) {
		if (gpio_banks[idx].id == id)
			return &gpio_banks[idx];
	}

	return NULL;
}

struct gpio_bank *gpio_to_bank(u32 gpio)
{
	int id;

	if (!gpio_is_valid(gpio))
		return NULL;

	id = (gpio & GPIO_BANK_MASK) >> GPIO_BANK_OFFSET;

	return gpio_id_to_bank(id);
}