[mirror_ubuntu-artful-kernel.git] / drivers / gpio / gpio-xgene-sb.c

/*
 * AppliedMicro X-Gene SoC GPIO-Standby Driver
 *
 * Copyright (c) 2014, Applied Micro Circuits Corporation
 * Author: 	Tin Huynh <tnhuynh@apm.com>.
 * 		Y Vo <yvo@apm.com>.
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <linux/module.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/of_gpio.h>
#include <linux/gpio.h>
#include <linux/gpio/driver.h>
#include <linux/acpi.h>
#include <linux/basic_mmio_gpio.h>

#include "gpiolib.h"

#define XGENE_MAX_GPIO_DS		22
#define XGENE_MAX_GPIO_DS_IRQ		6

#define GPIO_MASK(x)			(1U << ((x) % 32))

#define MPA_GPIO_INT_LVL		0x0290
#define MPA_GPIO_OE_ADDR		0x029c
#define MPA_GPIO_OUT_ADDR		0x02a0
#define MPA_GPIO_IN_ADDR 		0x02a4
#define MPA_GPIO_SEL_LO 		0x0294

/**
 * struct xgene_gpio_sb - GPIO-Standby private data structure.
 * @bgc:			memory-mapped GPIO controllers.
 * @irq:			Mapping GPIO pins and interrupt number
 * nirq:			Number of GPIO pins that supports interrupt
 */
struct xgene_gpio_sb {
	struct bgpio_chip	bgc;
	u32 *irq;
	u32 nirq;
};

static inline struct xgene_gpio_sb *to_xgene_gpio_sb(struct gpio_chip *gc)
{
	struct bgpio_chip *bgc = to_bgpio_chip(gc);

	return container_of(bgc, struct xgene_gpio_sb, bgc);
}

static void xgene_gpio_set_bit(struct bgpio_chip *bgc, void __iomem *reg, u32 gpio, int val)
{
	u32 data;

	data = bgc->read_reg(reg);
	if (val)
		data |= GPIO_MASK(gpio);
	else
		data &= ~GPIO_MASK(gpio);
	bgc->write_reg(reg, data);
}

static int apm_gpio_sb_to_irq(struct gpio_chip *gc, u32 gpio)
{
	struct xgene_gpio_sb *priv = to_xgene_gpio_sb(gc);

	if (priv->irq[gpio])
		return priv->irq[gpio];

	return -ENXIO;
}

static int xgene_gpio_sb_probe(struct platform_device *pdev)
{
	struct xgene_gpio_sb *priv;
	u32 ret, i;
	u32 default_lines[] = {0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D};
	struct resource *res;
	void __iomem *regs;

	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	regs = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(regs))
		return PTR_ERR(regs);

	ret = bgpio_init(&priv->bgc, &pdev->dev, 4,
			regs + MPA_GPIO_IN_ADDR,
			regs + MPA_GPIO_OUT_ADDR, NULL,
			regs + MPA_GPIO_OE_ADDR, NULL, 0);
        if (ret)
                return ret;

	priv->bgc.gc.to_irq = apm_gpio_sb_to_irq;
	priv->bgc.gc.ngpio = XGENE_MAX_GPIO_DS;

	priv->nirq = XGENE_MAX_GPIO_DS_IRQ;

	priv->irq = devm_kzalloc(&pdev->dev, sizeof(u32) * XGENE_MAX_GPIO_DS,
				   GFP_KERNEL);
	if (!priv->irq)
		return -ENOMEM;

	for (i = 0; i < priv->nirq; i++) {
		priv->irq[default_lines[i]] = platform_get_irq(pdev, i);
		xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_SEL_LO,
                                   default_lines[i] * 2, 1);
		xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_INT_LVL, i, 1);
	}

	platform_set_drvdata(pdev, priv);

	ret = gpiochip_add(&priv->bgc.gc);
	if (ret)
		dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n");
	else
		dev_info(&pdev->dev, "X-Gene GPIO Standby driver registered\n");

	if (priv->nirq > 0) {
		/* Register interrupt handlers for gpio signaled acpi events */
		acpi_gpiochip_request_interrupts(&priv->bgc.gc);
	}

	return ret;
}

static int xgene_gpio_sb_remove(struct platform_device *pdev)
{
	struct xgene_gpio_sb *priv = platform_get_drvdata(pdev);

	if (priv->nirq > 0) {
		acpi_gpiochip_free_interrupts(&priv->bgc.gc);
	}

	return bgpio_remove(&priv->bgc);
}

static const struct of_device_id xgene_gpio_sb_of_match[] = {
	{.compatible = "apm,xgene-gpio-sb", },
	{},
};
MODULE_DEVICE_TABLE(of, xgene_gpio_sb_of_match);

#ifdef CONFIG_ACPI
static const struct acpi_device_id xgene_gpio_sb_acpi_match[] = {
	{"APMC0D15", 0},
	{},
};
MODULE_DEVICE_TABLE(acpi, xgene_gpio_sb_acpi_match);
#endif

static struct platform_driver xgene_gpio_sb_driver = {
	.driver = {
		   .name = "xgene-gpio-sb",
		   .of_match_table = xgene_gpio_sb_of_match,
		   .acpi_match_table = ACPI_PTR(xgene_gpio_sb_acpi_match),
		   },
	.probe = xgene_gpio_sb_probe,
	.remove = xgene_gpio_sb_remove,
};
module_platform_driver(xgene_gpio_sb_driver);

MODULE_AUTHOR("AppliedMicro");
MODULE_DESCRIPTION("APM X-Gene GPIO Standby driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
b2b35e10 V	1	/*
	2	* AppliedMicro X-Gene SoC GPIO-Standby Driver
	3	*
	4	* Copyright (c) 2014, Applied Micro Circuits Corporation
	5	* Author: Tin Huynh <tnhuynh@apm.com>.
	6	* Y Vo <yvo@apm.com>.
	7	*
	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms of the GNU General Public License as published by the
	10	* Free Software Foundation; either version 2 of the License, or (at your
	11	* option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	20	*/
	21
	22	#include <linux/module.h>
	23	#include <linux/io.h>
	24	#include <linux/platform_device.h>
	25	#include <linux/of_gpio.h>
	26	#include <linux/gpio.h>
	27	#include <linux/gpio/driver.h>
733cf014	28	#include <linux/acpi.h>
b2b35e10 V	29	#include <linux/basic_mmio_gpio.h>
b2b35e10 V	30
733cf014 V	31	#include "gpiolib.h"
733cf014 V	32
b2b35e10 V	33	#define XGENE_MAX_GPIO_DS 22
	34	#define XGENE_MAX_GPIO_DS_IRQ 6
	35
	36	#define GPIO_MASK(x) (1U << ((x) % 32))
	37
	38	#define MPA_GPIO_INT_LVL 0x0290
	39	#define MPA_GPIO_OE_ADDR 0x029c
	40	#define MPA_GPIO_OUT_ADDR 0x02a0
	41	#define MPA_GPIO_IN_ADDR 0x02a4
	42	#define MPA_GPIO_SEL_LO 0x0294
	43
	44	/**
	45	* struct xgene_gpio_sb - GPIO-Standby private data structure.
	46	* @bgc: memory-mapped GPIO controllers.
	47	* @irq: Mapping GPIO pins and interrupt number
	48	* nirq: Number of GPIO pins that supports interrupt
	49	*/
	50	struct xgene_gpio_sb {
	51	struct bgpio_chip bgc;
	52	u32 *irq;
	53	u32 nirq;
	54	};
	55
	56	static inline struct xgene_gpio_sb to_xgene_gpio_sb(struct gpio_chip gc)
	57	{
	58	struct bgpio_chip *bgc = to_bgpio_chip(gc);
	59
	60	return container_of(bgc, struct xgene_gpio_sb, bgc);
	61	}
	62
	63	static void xgene_gpio_set_bit(struct bgpio_chip bgc, void __iomem reg, u32 gpio, int val)
	64	{
	65	u32 data;
	66
	67	data = bgc->read_reg(reg);
	68	if (val)
	69	data \|= GPIO_MASK(gpio);
	70	else
	71	data &= ~GPIO_MASK(gpio);
	72	bgc->write_reg(reg, data);
	73	}
	74
	75	static int apm_gpio_sb_to_irq(struct gpio_chip *gc, u32 gpio)
	76	{
	77	struct xgene_gpio_sb *priv = to_xgene_gpio_sb(gc);
	78
	79	if (priv->irq[gpio])
	80	return priv->irq[gpio];
	81
	82	return -ENXIO;
	83	}
	84
	85	static int xgene_gpio_sb_probe(struct platform_device *pdev)
	86	{
	87	struct xgene_gpio_sb *priv;
	88	u32 ret, i;
	89	u32 default_lines[] = {0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D};
	90	struct resource *res;
	91	void __iomem *regs;
	92
	93	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	94	if (!priv)
	95	return -ENOMEM;
	96
97	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
98	regs = devm_ioremap_resource(&pdev->dev, res);
33c07b46	99	if (IS_ERR(regs))
b2b35e10 V	100	return PTR_ERR(regs);
	101
	102	ret = bgpio_init(&priv->bgc, &pdev->dev, 4,
	103	regs + MPA_GPIO_IN_ADDR,
	104	regs + MPA_GPIO_OUT_ADDR, NULL,
	105	regs + MPA_GPIO_OE_ADDR, NULL, 0);
	106	if (ret)
	107	return ret;
	108
	109	priv->bgc.gc.to_irq = apm_gpio_sb_to_irq;
	110	priv->bgc.gc.ngpio = XGENE_MAX_GPIO_DS;
	111
	112	priv->nirq = XGENE_MAX_GPIO_DS_IRQ;
	113
	114	priv->irq = devm_kzalloc(&pdev->dev, sizeof(u32) * XGENE_MAX_GPIO_DS,
	115	GFP_KERNEL);
	116	if (!priv->irq)
	117	return -ENOMEM;
b2b35e10 V	118
	119	for (i = 0; i < priv->nirq; i++) {
	120	priv->irq[default_lines[i]] = platform_get_irq(pdev, i);
	121	xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_SEL_LO,
	122	default_lines[i] * 2, 1);
	123	xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_INT_LVL, i, 1);
	124	}
	125
	126	platform_set_drvdata(pdev, priv);
	127
	128	ret = gpiochip_add(&priv->bgc.gc);
	129	if (ret)
	130	dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n");
	131	else
	132	dev_info(&pdev->dev, "X-Gene GPIO Standby driver registered\n");
	133
733cf014 V	134	if (priv->nirq > 0) {
	135	/* Register interrupt handlers for gpio signaled acpi events */
	136	acpi_gpiochip_request_interrupts(&priv->bgc.gc);
	137	}
	138
b2b35e10 V	139	return ret;
	140	}
	141
	142	static int xgene_gpio_sb_remove(struct platform_device *pdev)
	143	{
	144	struct xgene_gpio_sb *priv = platform_get_drvdata(pdev);
	145
733cf014 V	146	if (priv->nirq > 0) {
	147	acpi_gpiochip_free_interrupts(&priv->bgc.gc);
	148	}
	149
b2b35e10 V	150	return bgpio_remove(&priv->bgc);
	151	}
	152
	153	static const struct of_device_id xgene_gpio_sb_of_match[] = {
	154	{.compatible = "apm,xgene-gpio-sb", },
	155	{},
	156	};
	157	MODULE_DEVICE_TABLE(of, xgene_gpio_sb_of_match);
	158
733cf014 V	159	#ifdef CONFIG_ACPI
	160	static const struct acpi_device_id xgene_gpio_sb_acpi_match[] = {
	161	{"APMC0D15", 0},
	162	{},
	163	};
	164	MODULE_DEVICE_TABLE(acpi, xgene_gpio_sb_acpi_match);
	165	#endif
	166
b2b35e10 V	167	static struct platform_driver xgene_gpio_sb_driver = {
	168	.driver = {
	169	.name = "xgene-gpio-sb",
	170	.of_match_table = xgene_gpio_sb_of_match,
733cf014	171	.acpi_match_table = ACPI_PTR(xgene_gpio_sb_acpi_match),
b2b35e10 V	172	},
	173	.probe = xgene_gpio_sb_probe,
	174	.remove = xgene_gpio_sb_remove,
	175	};
	176	module_platform_driver(xgene_gpio_sb_driver);
	177
	178	MODULE_AUTHOR("AppliedMicro");
	179	MODULE_DESCRIPTION("APM X-Gene GPIO Standby driver");
	180	MODULE_LICENSE("GPL");