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

/*
 *  CLPS711X GPIO driver
 *
 *  Copyright (C) 2012,2013 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/gpio.h>
#include <linux/module.h>
#include <linux/basic_mmio_gpio.h>
#include <linux/platform_device.h>

static int clps711x_gpio_probe(struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
	void __iomem *dat, *dir;
	struct bgpio_chip *bgc;
	struct resource *res;
	int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id;

	if ((id < 0) || (id > 4))
		return -ENODEV;

	bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
	if (!bgc)
		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);

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

	switch (id) {
	case 3:
		/* PORTD is inverted logic for direction register */
		err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
				 NULL, dir, 0);
		break;
	default:
		err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
				 dir, NULL, 0);
		break;
	}

	if (err)
		return err;

	switch (id) {
	case 4:
		/* PORTE is 3 lines only */
		bgc->gc.ngpio = 3;
		break;
	default:
		break;
	}

	bgc->gc.base = id * 8;
	bgc->gc.owner = THIS_MODULE;
	platform_set_drvdata(pdev, bgc);

	return gpiochip_add(&bgc->gc);
}

static int clps711x_gpio_remove(struct platform_device *pdev)
{
	struct bgpio_chip *bgc = platform_get_drvdata(pdev);

	return bgpio_remove(bgc);
}

static const struct of_device_id __maybe_unused clps711x_gpio_ids[] = {
	{ .compatible = "cirrus,clps711x-gpio" },
	{ }
};
MODULE_DEVICE_TABLE(of, clps711x_gpio_ids);

static struct platform_driver clps711x_gpio_driver = {
	.driver	= {
		.name		= "clps711x-gpio",
		.of_match_table	= of_match_ptr(clps711x_gpio_ids),
	},
	.probe	= clps711x_gpio_probe,
	.remove	= clps711x_gpio_remove,
};
module_platform_driver(clps711x_gpio_driver);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
MODULE_DESCRIPTION("CLPS711X GPIO driver");
MODULE_ALIAS("platform:clps711x-gpio");
Commit	Line	Data
a3b8d4a5 AS	1	/*
	2	* CLPS711X GPIO driver
	3	*
55fe14ab	4	* Copyright (C) 2012,2013 Alexander Shiyan <shc_work@mail.ru>
a3b8d4a5 AS	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
55fe14ab	12	#include <linux/err.h>
a3b8d4a5 AS	13	#include <linux/gpio.h>
a3b8d4a5 AS	14	#include <linux/module.h>
55fe14ab	15	#include <linux/basic_mmio_gpio.h>
a3b8d4a5 AS	16	#include <linux/platform_device.h>
a3b8d4a5 AS	17
55fe14ab	18	static int clps711x_gpio_probe(struct platform_device *pdev)
a3b8d4a5	19	{
a180132f	20	struct device_node *np = pdev->dev.of_node;
55fe14ab AS	21	void __iomem dat, dir;
	22	struct bgpio_chip *bgc;
	23	struct resource *res;
a180132f	24	int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id;
a3b8d4a5	25
55fe14ab AS	26	if ((id < 0) \|\| (id > 4))
55fe14ab AS	27	return -ENODEV;
a3b8d4a5	28
55fe14ab AS	29	bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
	30	if (!bgc)
	31	return -ENOMEM;
a3b8d4a5	32
55fe14ab AS	33	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	34	dat = devm_ioremap_resource(&pdev->dev, res);
	35	if (IS_ERR(dat))
	36	return PTR_ERR(dat);
	37
	38	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	39	dir = devm_ioremap_resource(&pdev->dev, res);
	40	if (IS_ERR(dir))
	41	return PTR_ERR(dir);
	42
	43	switch (id) {
	44	case 3:
	45	/* PORTD is inverted logic for direction register */
	46	err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
	47	NULL, dir, 0);
	48	break;
	49	default:
	50	err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
	51	dir, NULL, 0);
	52	break;
	53	}
a3b8d4a5	54
55fe14ab AS	55	if (err)
55fe14ab AS	56	return err;
a3b8d4a5	57
55fe14ab AS	58	switch (id) {
	59	case 4:
	60	/* PORTE is 3 lines only */
	61	bgc->gc.ngpio = 3;
	62	break;
	63	default:
	64	break;
	65	}
d6a2fa04	66
55fe14ab	67	bgc->gc.base = id * 8;
f86b7c70	68	bgc->gc.owner = THIS_MODULE;
55fe14ab	69	platform_set_drvdata(pdev, bgc);
d6a2fa04	70
55fe14ab	71	return gpiochip_add(&bgc->gc);
d6a2fa04 AS	72	}
d6a2fa04 AS	73
55fe14ab	74	static int clps711x_gpio_remove(struct platform_device *pdev)
d6a2fa04	75	{
55fe14ab	76	struct bgpio_chip *bgc = platform_get_drvdata(pdev);
d6a2fa04	77
55fe14ab	78	return bgpio_remove(bgc);
d6a2fa04 AS	79	}
d6a2fa04 AS	80
e8b49e07	81	static const struct of_device_id __maybe_unused clps711x_gpio_ids[] = {
a180132f AS	82	{ .compatible = "cirrus,clps711x-gpio" },
	83	{ }
	84	};
	85	MODULE_DEVICE_TABLE(of, clps711x_gpio_ids);
	86
55fe14ab AS	87	static struct platform_driver clps711x_gpio_driver = {
55fe14ab AS	88	.driver = {
a180132f	89	.name = "clps711x-gpio",
e8b49e07	90	.of_match_table = of_match_ptr(clps711x_gpio_ids),
55fe14ab AS	91	},
	92	.probe = clps711x_gpio_probe,
	93	.remove = clps711x_gpio_remove,
a3b8d4a5	94	};
55fe14ab	95	module_platform_driver(clps711x_gpio_driver);
a3b8d4a5	96
55fe14ab	97	MODULE_LICENSE("GPL");
a3b8d4a5 AS	98	MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
a3b8d4a5 AS	99	MODULE_DESCRIPTION("CLPS711X GPIO driver");
21708c99	100	MODULE_ALIAS("platform:clps711x-gpio");