[mirror_ubuntu-bionic-kernel.git] / drivers / gpio / gpio-74xx-mmio.c

/*
 * 74xx MMIO GPIO driver
 *
 *  Copyright (C) 2014 Alexander Shiyan <shc_work@mail.ru>
 *
 * 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/err.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/gpio/driver.h>
#include <linux/platform_device.h>

#define MMIO_74XX_DIR_IN	(0 << 8)
#define MMIO_74XX_DIR_OUT	(1 << 8)
#define MMIO_74XX_BIT_CNT(x)	((x) & 0xff)

struct mmio_74xx_gpio_priv {
	struct gpio_chip	gc;
	unsigned		flags;
};

static const struct of_device_id mmio_74xx_gpio_ids[] = {
	{
		.compatible	= "ti,741g125",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 1),
	},
	{
		.compatible	= "ti,742g125",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 2),
	},
	{
		.compatible	= "ti,74125",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 4),
	},
	{
		.compatible	= "ti,74365",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 6),
	},
	{
		.compatible	= "ti,74244",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 8),
	},
	{
		.compatible	= "ti,741624",
		.data		= (const void *)(MMIO_74XX_DIR_IN | 16),
	},
	{
		.compatible	= "ti,741g74",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 1),
	},
	{
		.compatible	= "ti,7474",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 2),
	},
	{
		.compatible	= "ti,74175",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 4),
	},
	{
		.compatible	= "ti,74174",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 6),
	},
	{
		.compatible	= "ti,74273",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 8),
	},
	{
		.compatible	= "ti,7416374",
		.data		= (const void *)(MMIO_74XX_DIR_OUT | 16),
	},
	{ }
};
MODULE_DEVICE_TABLE(of, mmio_74xx_gpio_ids);

static int mmio_74xx_get_direction(struct gpio_chip *gc, unsigned offset)
{
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);

	return !(priv->flags & MMIO_74XX_DIR_OUT);
}

static int mmio_74xx_dir_in(struct gpio_chip *gc, unsigned int gpio)
{
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);

	return (priv->flags & MMIO_74XX_DIR_OUT) ? -ENOTSUPP : 0;
}

static int mmio_74xx_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
{
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);

	if (priv->flags & MMIO_74XX_DIR_OUT) {
		gc->set(gc, gpio, val);
		return 0;
	}

	return -ENOTSUPP;
}

static int mmio_74xx_gpio_probe(struct platform_device *pdev)
{
	const struct of_device_id *of_id;
	struct mmio_74xx_gpio_priv *priv;
	struct resource *res;
	void __iomem *dat;
	int err;

	of_id = of_match_device(mmio_74xx_gpio_ids, &pdev->dev);
	if (!of_id)
		return -ENODEV;

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

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

	priv->flags = (uintptr_t) of_id->data;

	err = bgpio_init(&priv->gc, &pdev->dev,
			 DIV_ROUND_UP(MMIO_74XX_BIT_CNT(priv->flags), 8),
			 dat, NULL, NULL, NULL, NULL, 0);
	if (err)
		return err;

	priv->gc.direction_input = mmio_74xx_dir_in;
	priv->gc.direction_output = mmio_74xx_dir_out;
	priv->gc.get_direction = mmio_74xx_get_direction;
	priv->gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags);
	priv->gc.owner = THIS_MODULE;

	platform_set_drvdata(pdev, priv);

	return devm_gpiochip_add_data(&pdev->dev, &priv->gc, priv);
}

static struct platform_driver mmio_74xx_gpio_driver = {
	.driver	= {
		.name		= "74xx-mmio-gpio",
		.of_match_table	= mmio_74xx_gpio_ids,
	},
	.probe	= mmio_74xx_gpio_probe,
};
module_platform_driver(mmio_74xx_gpio_driver);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
MODULE_DESCRIPTION("74xx MMIO GPIO driver");
Commit	Line	Data
af0a33e2 AS	1	/*
	2	* 74xx MMIO GPIO driver
	3	*
	4	* Copyright (C) 2014 Alexander Shiyan <shc_work@mail.ru>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*/
	11
	12	#include <linux/err.h>
af0a33e2 AS	13	#include <linux/module.h>
af0a33e2 AS	14	#include <linux/of_device.h>
0f4630f3	15	#include <linux/gpio/driver.h>
af0a33e2 AS	16	#include <linux/platform_device.h>
	17
	18	#define MMIO_74XX_DIR_IN (0 << 8)
	19	#define MMIO_74XX_DIR_OUT (1 << 8)
	20	#define MMIO_74XX_BIT_CNT(x) ((x) & 0xff)
	21
	22	struct mmio_74xx_gpio_priv {
0f4630f3	23	struct gpio_chip gc;
af0a33e2 AS	24	unsigned flags;
	25	};
	26
	27	static const struct of_device_id mmio_74xx_gpio_ids[] = {
	28	{
	29	.compatible = "ti,741g125",
	30	.data = (const void *)(MMIO_74XX_DIR_IN \| 1),
	31	},
	32	{
	33	.compatible = "ti,742g125",
	34	.data = (const void *)(MMIO_74XX_DIR_IN \| 2),
	35	},
	36	{
	37	.compatible = "ti,74125",
	38	.data = (const void *)(MMIO_74XX_DIR_IN \| 4),
	39	},
	40	{
	41	.compatible = "ti,74365",
	42	.data = (const void *)(MMIO_74XX_DIR_IN \| 6),
	43	},
	44	{
	45	.compatible = "ti,74244",
	46	.data = (const void *)(MMIO_74XX_DIR_IN \| 8),
	47	},
	48	{
	49	.compatible = "ti,741624",
	50	.data = (const void *)(MMIO_74XX_DIR_IN \| 16),
	51	},
	52	{
	53	.compatible = "ti,741g74",
	54	.data = (const void *)(MMIO_74XX_DIR_OUT \| 1),
	55	},
	56	{
	57	.compatible = "ti,7474",
	58	.data = (const void *)(MMIO_74XX_DIR_OUT \| 2),
	59	},
	60	{
	61	.compatible = "ti,74175",
	62	.data = (const void *)(MMIO_74XX_DIR_OUT \| 4),
	63	},
	64	{
	65	.compatible = "ti,74174",
	66	.data = (const void *)(MMIO_74XX_DIR_OUT \| 6),
	67	},
	68	{
	69	.compatible = "ti,74273",
	70	.data = (const void *)(MMIO_74XX_DIR_OUT \| 8),
	71	},
	72	{
	73	.compatible = "ti,7416374",
	74	.data = (const void *)(MMIO_74XX_DIR_OUT \| 16),
	75	},
	76	{ }
	77	};
	78	MODULE_DEVICE_TABLE(of, mmio_74xx_gpio_ids);
	79
af0a33e2 AS	80	static int mmio_74xx_get_direction(struct gpio_chip *gc, unsigned offset)
af0a33e2 AS	81	{
0f4630f3	82	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
af0a33e2	83
0f4630f3	84	return !(priv->flags & MMIO_74XX_DIR_OUT);
af0a33e2 AS	85	}
	86
	87	static int mmio_74xx_dir_in(struct gpio_chip *gc, unsigned int gpio)
	88	{
0f4630f3	89	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
af0a33e2 AS	90
	91	return (priv->flags & MMIO_74XX_DIR_OUT) ? -ENOTSUPP : 0;
	92	}
	93
	94	static int mmio_74xx_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
	95	{
0f4630f3	96	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
af0a33e2 AS	97
	98	if (priv->flags & MMIO_74XX_DIR_OUT) {
	99	gc->set(gc, gpio, val);
	100	return 0;
	101	}
	102
	103	return -ENOTSUPP;
	104	}
	105
	106	static int mmio_74xx_gpio_probe(struct platform_device *pdev)
	107	{
56880a24	108	const struct of_device_id *of_id;
af0a33e2 AS	109	struct mmio_74xx_gpio_priv *priv;
	110	struct resource *res;
	111	void __iomem *dat;
	112	int err;
	113
56880a24 LC	114	of_id = of_match_device(mmio_74xx_gpio_ids, &pdev->dev);
	115	if (!of_id)
	116	return -ENODEV;
	117
af0a33e2 AS	118	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	119	if (!priv)
	120	return -ENOMEM;
	121
	122	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	123	dat = devm_ioremap_resource(&pdev->dev, res);
	124	if (IS_ERR(dat))
	125	return PTR_ERR(dat);
	126
54442658	127	priv->flags = (uintptr_t) of_id->data;
af0a33e2	128
0f4630f3	129	err = bgpio_init(&priv->gc, &pdev->dev,
af0a33e2 AS	130	DIV_ROUND_UP(MMIO_74XX_BIT_CNT(priv->flags), 8),
	131	dat, NULL, NULL, NULL, NULL, 0);
	132	if (err)
	133	return err;
	134
0f4630f3 LW	135	priv->gc.direction_input = mmio_74xx_dir_in;
	136	priv->gc.direction_output = mmio_74xx_dir_out;
	137	priv->gc.get_direction = mmio_74xx_get_direction;
	138	priv->gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags);
	139	priv->gc.owner = THIS_MODULE;
af0a33e2 AS	140
	141	platform_set_drvdata(pdev, priv);
	142
a718ed2c	143	return devm_gpiochip_add_data(&pdev->dev, &priv->gc, priv);
af0a33e2 AS	144	}
	145
	146	static struct platform_driver mmio_74xx_gpio_driver = {
	147	.driver = {
	148	.name = "74xx-mmio-gpio",
	149	.of_match_table = mmio_74xx_gpio_ids,
	150	},
	151	.probe = mmio_74xx_gpio_probe,
af0a33e2 AS	152	};
	153	module_platform_driver(mmio_74xx_gpio_driver);
	154
	155	MODULE_LICENSE("GPL");
	156	MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
	157	MODULE_DESCRIPTION("74xx MMIO GPIO driver");