SmartAudio/lichee/linux-4.9/drivers/power/supply/axp/axp22x/axp22x-gpio.c

/*
 * drivers/power/axp/axp22x/axp22x-gpio.c
 * (C) Copyright 2010-2016
 * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
 * Pannan <pannan@allwinnertech.com>
 *
 * gpio driver of axp22x
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 */

#include <linux/io.h>
#include <linux/clk.h>
#include <linux/gpio.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/of_device.h>
#include <linux/pinctrl/consumer.h>
#include <linux/pinctrl/machine.h>
#include <linux/pinctrl/pinctrl.h>
#include <linux/pinctrl/pinconf-generic.h>
#include <linux/pinctrl/pinmux.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/sunxi-gpio.h>
#include <linux/mfd/core.h>
#include <linux/seq_file.h>
#include <linux/i2c.h>
#include "../../../../pinctrl/core.h"
#include "../axp-core.h"
#include "../axp-gpio.h"
#include "axp22x-gpio.h"

static struct axp_gpio_irqchip *axp22x_gpio_irqchip;
static int axp22x_pmu_num;

static int axp22x_gpio_get_data(struct axp_dev *axp_dev, int gpio)
{
	u8 ret;
	struct axp_regmap *map;

	map = axp_dev->regmap;
	if (NULL == map) {
		pr_err("%s: axp regmap is null\n", __func__);
		return -ENXIO;
	}

	switch (gpio) {
	case 0:
		axp_regmap_read(map, AXP_GPIO01_STATE, &ret); ret &= 0x1; break;
	case 1:
		axp_regmap_read(map, AXP_GPIO01_STATE, &ret); ret &= 0x2; break;
	default:
		pr_err("This IO is not an input\n");
		return -ENXIO;
	}

	return ret;
}

static int axp22x_gpio_set_data(struct axp_dev *axp_dev, int gpio, int value)
{
	struct axp_regmap *map;

	if ((0 <= gpio) && (1 >= gpio)) {
		map = axp_dev->regmap;
		if (NULL == map) {
			pr_err("%s: %d axp regmap is null\n",
					__func__, __LINE__);
			return -ENXIO;
		}
	} else {
		return -ENXIO;
	}

	if (value) {
		/* high */
		switch (gpio) {
		case 0:
			return axp_regmap_update_sync(map,
				AXP_GPIO0_CFG, 0x01, 0x07);
		case 1:
			return axp_regmap_update_sync(map,
				AXP_GPIO1_CFG, 0x01, 0x07);
		default:
			break;
		}
	} else {
		/* low */
		switch (gpio) {
		case 0:
			return axp_regmap_update_sync(map,
				AXP_GPIO0_CFG, 0x0, 0x07);
		case 1:
			return axp_regmap_update_sync(map,
				AXP_GPIO1_CFG, 0x0, 0x07);
		default:
			break;
		}
	}

	return -ENXIO;
}

static int axp22x_pmx_set(struct axp_dev *axp_dev, int gpio, int mux)
{
	struct axp_regmap *map;

	map = axp_dev->regmap;
	if (NULL == map) {
		pr_err("%s: %d axp regmap is null\n", __func__, __LINE__);
		return -ENXIO;
	}

	if (mux == 1) {
		/* output */
		switch (gpio) {
		case 0:
			return axp_regmap_clr_bits_sync(map,
				AXP_GPIO0_CFG, 0x06);
		case 1:
			return axp_regmap_clr_bits_sync(map,
				AXP_GPIO1_CFG, 0x06);
		default:
			return -ENXIO;
		}
	} else if (mux == 0) {
		/* input */
		switch (gpio) {
		case 0:
			axp_regmap_clr_bits_sync(map,
				AXP_GPIO0_CFG, 0x05);
			return axp_regmap_set_bits_sync(map,
				AXP_GPIO0_CFG, 0x02);
		case 1:
			axp_regmap_clr_bits_sync(map,
				AXP_GPIO1_CFG, 0x05);
			return axp_regmap_set_bits_sync(map,
				AXP_GPIO1_CFG, 0x02);
		default:
			pr_err("This IO can not config as input!");
			return -ENXIO;
		}
	}

	return -ENXIO;
}

static int axp22x_pmx_get(struct axp_dev *axp_dev, int gpio)
{
	u8 ret;
	struct axp_regmap *map;

	map = axp_dev->regmap;
	if (NULL == map) {
		pr_err("%s: %d axp regmap is null\n",
				__func__, __LINE__);
		return -ENXIO;
	}

	switch (gpio) {
	case 0:
		axp_regmap_read(map, AXP_GPIO0_CFG, &ret); break;
	case 1:
		axp_regmap_read(map, AXP_GPIO1_CFG, &ret); break;
	default:
		return -ENXIO;
	}

	if (0 == (ret & 0x06))
		return 1;
	else if (0x02 == (ret & 0x07))
		return 0;
	else
		return -ENXIO;

	return -ENXIO;
}

static const struct axp_desc_pin axp22x_pins[] = {
	AXP_PIN_DESC(AXP_PINCTRL_GPIO(0),
			 AXP_FUNCTION(0x0, "gpio_in"),
			 AXP_FUNCTION(0x1, "gpio_out"),
			 AXP_FUNCTION_IRQ(1)),
	AXP_PIN_DESC(AXP_PINCTRL_GPIO(1),
			 AXP_FUNCTION(0x0, "gpio_in"),
			 AXP_FUNCTION(0x1, "gpio_out"),
			 AXP_FUNCTION_IRQ(1)),
};

static struct axp_pinctrl_desc axp22x_pinctrl_pins_desc = {
	.pins  = axp22x_pins,
	.npins = ARRAY_SIZE(axp22x_pins),
};

static struct axp_gpio_ops axp22x_gpio_ops = {
	.gpio_get_data = axp22x_gpio_get_data,
	.gpio_set_data = axp22x_gpio_set_data,
	.pmx_set = axp22x_pmx_set,
	.pmx_get = axp22x_pmx_get,
};

static int axp22x_gpio_irq_request(int gpio_no,
				u32 (*handler)(int, void *), void *data)
{
	int gpio = gpio_no - AXP_PIN_BASE;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	axp22x_gpio_irqchip[gpio].gpio_no = gpio;
	axp22x_gpio_irqchip[gpio].handler = handler;
	axp22x_gpio_irqchip[gpio].data = data;

	return 0;
}

static int axp22x_gpio_irq_free(int gpio_no)
{
	int gpio = gpio_no - AXP_PIN_BASE;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	axp22x_gpio_irqchip[gpio].gpio_no = 0;
	axp22x_gpio_irqchip[gpio].handler = NULL;
	axp22x_gpio_irqchip[gpio].data = NULL;

	return 0;
}

static int axp22x_gpio_irq_ack(int gpio_no)
{
	struct axp_dev *cur_axp_dev = get_pmu_cur_dev(axp22x_pmu_num);
	struct axp_regmap *map = cur_axp_dev->regmap;
	int gpio = gpio_no - AXP_PIN_BASE;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	axp_regmap_write(map, AXP_GPIO01_INTSTA, 0x1 << gpio);

	return 0;
}

static int axp22x_gpio_irq_enable(int gpio_no)
{
	struct axp_dev *cur_axp_dev = get_pmu_cur_dev(axp22x_pmu_num);
	struct axp_regmap *map = cur_axp_dev->regmap;
	int gpio = gpio_no - AXP_PIN_BASE;
	u8 regval;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	axp_regmap_read(map, AXP_GPIO01_INTEN, &regval);
	regval |= (0x1 << gpio);
	axp_regmap_write(map, AXP_GPIO01_INTEN, regval);

	return 0;
};

static int axp22x_gpio_irq_disable(int gpio_no)
{
	struct axp_dev *cur_axp_dev = get_pmu_cur_dev(axp22x_pmu_num);
	struct axp_regmap *map = cur_axp_dev->regmap;
	int gpio = gpio_no - AXP_PIN_BASE;
	u8 regval;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	axp_regmap_read(map, AXP_GPIO01_INTEN, &regval);
	regval &= ~(0x1 << gpio);
	axp_regmap_write(map, AXP_GPIO01_INTEN, regval);

	return 0;
};

static int axp22x_gpio_set_type(int gpio_no, unsigned long type)
{
	struct axp_dev *cur_axp_dev = get_pmu_cur_dev(axp22x_pmu_num);
	struct axp_regmap *map = cur_axp_dev->regmap;
	int gpio = gpio_no - AXP_PIN_BASE;
	int reg = 0;
	u8 regval, mode = 0;

	if (!axp_gpio_irq_valid(&axp22x_pinctrl_pins_desc, gpio)) {
		pr_err("axp gpio%d irq is not valid\n", gpio);
		return -1;
	}

	switch (type) {
	case AXP_GPIO_IRQF_TRIGGER_RISING:
		mode = AXP_GPIO_IRQ_EDGE_RISING;
		break;
	case AXP_GPIO_IRQF_TRIGGER_FALLING:
		mode = AXP_GPIO_IRQ_EDGE_FALLING;
		break;
	case AXP_GPIO_IRQF_TRIGGER_RISING | AXP_GPIO_IRQF_TRIGGER_FALLING:
		mode = AXP_GPIO_IRQ_EDGE_RISING | AXP_GPIO_IRQ_EDGE_FALLING;
		break;
	default:
		return -EINVAL;
	}

	if (gpio == 0)
		reg = AXP_GPIO0_CFG;
	else if (gpio == 1)
		reg = AXP_GPIO1_CFG;

	axp_regmap_read(map, reg, &regval);
	regval &= ~AXP_GPIO_EDGE_TRIG_MASK;
	regval |= mode;
	regval &= ~AXP_GPIO_INPUT_TRIG_MASK;
	regval |= 0x2; /* digital input */
	axp_regmap_write(map, reg, regval);

	return 0;
};

struct axp_gpio_irq_ops axp22x_gpio_irq_ops = {
	.irq_request  = axp22x_gpio_irq_request,
	.irq_free     = axp22x_gpio_irq_free,
	.irq_ack      = axp22x_gpio_irq_ack,
	.irq_enable   = axp22x_gpio_irq_enable,
	.irq_disable  = axp22x_gpio_irq_disable,
	.irq_set_type = axp22x_gpio_set_type,
};

static irqreturn_t axp22x_gpio_isr(int irq, void *data)
{
	int gpio = 0;

	switch (irq) {
	case AXP22X_IRQ_GPIO0:
		gpio = 0;
		break;
	case AXP22X_IRQ_GPIO1:
		gpio = 1;
		break;
	default:
		return IRQ_NONE;
	}

	AXP_DEBUG(AXP_INT, axp22x_pmu_num, "gpio%d input edge\n", gpio);

	if (axp22x_gpio_irqchip[gpio].handler != NULL) {
		axp22x_gpio_irqchip[gpio].handler(gpio + AXP_PIN_BASE,
				axp22x_gpio_irqchip[gpio].data);
		axp22x_gpio_irq_ack(gpio + AXP_PIN_BASE);
	}

	return IRQ_HANDLED;
}

static struct axp_interrupts axp22x_gpio_irq[] = {
	{"gpio0",        axp22x_gpio_isr},
	{"gpio1",        axp22x_gpio_isr},
};

static int axp22x_gpio_probe(struct platform_device *pdev)
{
	struct axp_dev *axp_dev = dev_get_drvdata(pdev->dev.parent);
	struct axp_pinctrl *axp22x_pin;
	int ret, i, irq;

	axp22x_pin = axp_pinctrl_register(&pdev->dev,
			axp_dev, &axp22x_pinctrl_pins_desc, &axp22x_gpio_ops);
	if (IS_ERR_OR_NULL(axp22x_pin))
		goto fail;

	for (i = 0; i < ARRAY_SIZE(axp22x_gpio_irq); i++) {
		irq = platform_get_irq_byname(pdev, axp22x_gpio_irq[i].name);
		if (irq < 0)
			continue;

		ret = axp_gpio_irq_register(axp_dev, irq,
				axp22x_gpio_irq[i].isr, axp22x_pin);
		if (ret != 0) {
			dev_err(&pdev->dev, "failed to request %s IRQ %d: %d\n",
					axp22x_gpio_irq[i].name, irq, ret);
			goto out_irq;
		}

		dev_dbg(&pdev->dev, "Requested %s IRQ %d: %d\n",
			axp22x_gpio_irq[i].name, irq, ret);
	}

	axp22x_gpio_irqchip = kzalloc(ARRAY_SIZE(axp22x_gpio_irq)
				* sizeof(struct axp_gpio_irqchip), GFP_KERNEL);
	if (IS_ERR_OR_NULL(axp22x_gpio_irqchip)) {
		dev_err(&pdev->dev, "axp22x_gpio_irqchip: not enough memory\n");
		i = ARRAY_SIZE(axp22x_gpio_irq);
		goto out_irq;
	}

	axp22x_pmu_num = axp_dev->pmu_num;
	axp_gpio_irq_ops_set(axp_dev->pmu_num, &axp22x_gpio_irq_ops);

	platform_set_drvdata(pdev, axp22x_pin);

	return 0;

out_irq:
	for (i = i - 1; i >= 0; i--) {
		irq = platform_get_irq_byname(pdev, axp22x_gpio_irq[i].name);
		if (irq < 0)
			continue;
		axp_free_irq(axp_dev, irq);
	}
fail:
	return -1;
}

static int axp22x_gpio_remove(struct platform_device *pdev)
{
	struct axp_dev *axp_dev = dev_get_drvdata(pdev->dev.parent);
	struct axp_pinctrl *axp22x_pin = platform_get_drvdata(pdev);
	int i, irq;

	kfree(axp22x_gpio_irqchip);
	axp22x_gpio_irqchip = NULL;

	for (i = 0; i < ARRAY_SIZE(axp22x_gpio_irq); i++) {
		irq = platform_get_irq_byname(pdev, axp22x_gpio_irq[i].name);
		if (irq < 0)
			continue;
		axp_free_irq(axp_dev, irq);
	}

	return axp_pinctrl_unregister(axp22x_pin);
}

static const struct of_device_id axp22x_gpio_dt_ids[] = {
	{ .compatible = "axp221s-gpio", },
	{ .compatible = "axp223-gpio",  },
	{ .compatible = "axp227-gpio",  },
	{ .compatible = "axp233-gpio",  },
	{},
};
MODULE_DEVICE_TABLE(of, axp22x_gpio_dt_ids);

static struct platform_driver axp22x_gpio_driver = {
	.driver = {
		.name = "axp22x-gpio",
		.of_match_table = axp22x_gpio_dt_ids,
	},
	.probe  = axp22x_gpio_probe,
	.remove = axp22x_gpio_remove,
};

static int __init axp22x_gpio_initcall(void)
{
	int ret;

	ret = platform_driver_register(&axp22x_gpio_driver);
	if (IS_ERR_VALUE(ret)) {
		pr_err("%s: failed, errno %d\n", __func__, ret);
		return -EINVAL;
	}

	return 0;
}
fs_initcall(axp22x_gpio_initcall);

MODULE_DESCRIPTION("Gpio driver of axp22x");
MODULE_AUTHOR("pannan");
MODULE_LICENSE("GPL");