[linux-2.6-block.git] / drivers / gpio / gpio-ucb1400.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Philips UCB1400 GPIO driver
 *
 * Author: Marek Vasut <marek.vasut@gmail.com>
 */

#include <linux/module.h>
#include <linux/ucb1400.h>

static int ucb1400_gpio_dir_in(struct gpio_chip *gc, unsigned off)
{
	struct ucb1400_gpio *gpio;
	gpio = gpiochip_get_data(gc);
	ucb1400_gpio_set_direction(gpio->ac97, off, 0);
	return 0;
}

static int ucb1400_gpio_dir_out(struct gpio_chip *gc, unsigned off, int val)
{
	struct ucb1400_gpio *gpio;
	gpio = gpiochip_get_data(gc);
	ucb1400_gpio_set_direction(gpio->ac97, off, 1);
	ucb1400_gpio_set_value(gpio->ac97, off, val);
	return 0;
}

static int ucb1400_gpio_get(struct gpio_chip *gc, unsigned off)
{
	struct ucb1400_gpio *gpio;

	gpio = gpiochip_get_data(gc);
	return !!ucb1400_gpio_get_value(gpio->ac97, off);
}

static void ucb1400_gpio_set(struct gpio_chip *gc, unsigned off, int val)
{
	struct ucb1400_gpio *gpio;
	gpio = gpiochip_get_data(gc);
	ucb1400_gpio_set_value(gpio->ac97, off, val);
}

static int ucb1400_gpio_probe(struct platform_device *dev)
{
	struct ucb1400_gpio *ucb = dev_get_platdata(&dev->dev);
	int err = 0;

	if (!(ucb && ucb->gpio_offset)) {
		err = -EINVAL;
		goto err;
	}

	platform_set_drvdata(dev, ucb);

	ucb->gc.label = "ucb1400_gpio";
	ucb->gc.base = ucb->gpio_offset;
	ucb->gc.ngpio = 10;
	ucb->gc.owner = THIS_MODULE;

	ucb->gc.direction_input = ucb1400_gpio_dir_in;
	ucb->gc.direction_output = ucb1400_gpio_dir_out;
	ucb->gc.get = ucb1400_gpio_get;
	ucb->gc.set = ucb1400_gpio_set;
	ucb->gc.can_sleep = true;

	err = devm_gpiochip_add_data(&dev->dev, &ucb->gc, ucb);
	if (err)
		goto err;

	if (ucb->gpio_setup)
		err = ucb->gpio_setup(&dev->dev, ucb->gc.ngpio);

err:
	return err;

}

static int ucb1400_gpio_remove(struct platform_device *dev)
{
	int err = 0;
	struct ucb1400_gpio *ucb = platform_get_drvdata(dev);

	if (ucb && ucb->gpio_teardown) {
		err = ucb->gpio_teardown(&dev->dev, ucb->gc.ngpio);
		if (err)
			return err;
	}

	return err;
}

static struct platform_driver ucb1400_gpio_driver = {
	.probe	= ucb1400_gpio_probe,
	.remove	= ucb1400_gpio_remove,
	.driver	= {
		.name	= "ucb1400_gpio"
	},
};

module_platform_driver(ucb1400_gpio_driver);

MODULE_DESCRIPTION("Philips UCB1400 GPIO driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:ucb1400_gpio");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
4cf8e53b MV	2	/*
	3	* Philips UCB1400 GPIO driver
	4	*
	5	* Author: Marek Vasut <marek.vasut@gmail.com>
4cf8e53b MV	6	*/
	7
	8	#include <linux/module.h>
	9	#include <linux/ucb1400.h>
	10
4cf8e53b MV	11	static int ucb1400_gpio_dir_in(struct gpio_chip *gc, unsigned off)
	12	{
	13	struct ucb1400_gpio *gpio;
9af4f0ab	14	gpio = gpiochip_get_data(gc);
4cf8e53b MV	15	ucb1400_gpio_set_direction(gpio->ac97, off, 0);
	16	return 0;
	17	}
	18
	19	static int ucb1400_gpio_dir_out(struct gpio_chip *gc, unsigned off, int val)
	20	{
	21	struct ucb1400_gpio *gpio;
9af4f0ab	22	gpio = gpiochip_get_data(gc);
4cf8e53b MV	23	ucb1400_gpio_set_direction(gpio->ac97, off, 1);
	24	ucb1400_gpio_set_value(gpio->ac97, off, val);
	25	return 0;
	26	}
	27
	28	static int ucb1400_gpio_get(struct gpio_chip *gc, unsigned off)
	29	{
	30	struct ucb1400_gpio *gpio;
9af4f0ab LW	31
9af4f0ab LW	32	gpio = gpiochip_get_data(gc);
c9d4ab03	33	return !!ucb1400_gpio_get_value(gpio->ac97, off);
4cf8e53b MV	34	}
	35
	36	static void ucb1400_gpio_set(struct gpio_chip *gc, unsigned off, int val)
	37	{
	38	struct ucb1400_gpio *gpio;
9af4f0ab	39	gpio = gpiochip_get_data(gc);
4cf8e53b MV	40	ucb1400_gpio_set_value(gpio->ac97, off, val);
	41	}
	42
	43	static int ucb1400_gpio_probe(struct platform_device *dev)
	44	{
e56aee18	45	struct ucb1400_gpio *ucb = dev_get_platdata(&dev->dev);
4cf8e53b MV	46	int err = 0;
4cf8e53b MV	47
360e64d8	48	if (!(ucb && ucb->gpio_offset)) {
4cf8e53b MV	49	err = -EINVAL;
	50	goto err;
	51	}
	52
	53	platform_set_drvdata(dev, ucb);
	54
	55	ucb->gc.label = "ucb1400_gpio";
360e64d8	56	ucb->gc.base = ucb->gpio_offset;
4cf8e53b MV	57	ucb->gc.ngpio = 10;
	58	ucb->gc.owner = THIS_MODULE;
	59
	60	ucb->gc.direction_input = ucb1400_gpio_dir_in;
	61	ucb->gc.direction_output = ucb1400_gpio_dir_out;
	62	ucb->gc.get = ucb1400_gpio_get;
	63	ucb->gc.set = ucb1400_gpio_set;
9fb1f39e	64	ucb->gc.can_sleep = true;
4cf8e53b	65
5d61a9e0	66	err = devm_gpiochip_add_data(&dev->dev, &ucb->gc, ucb);
4cf8e53b MV	67	if (err)
	68	goto err;
	69
31a3f9da	70	if (ucb->gpio_setup)
360e64d8	71	err = ucb->gpio_setup(&dev->dev, ucb->gc.ngpio);
4cf8e53b MV	72
	73	err:
	74	return err;
	75
	76	}
	77
	78	static int ucb1400_gpio_remove(struct platform_device *dev)
	79	{
	80	int err = 0;
	81	struct ucb1400_gpio *ucb = platform_get_drvdata(dev);
	82
360e64d8 MV	83	if (ucb && ucb->gpio_teardown) {
360e64d8 MV	84	err = ucb->gpio_teardown(&dev->dev, ucb->gc.ngpio);
4cf8e53b MV	85	if (err)
	86	return err;
	87	}
	88
4cf8e53b MV	89	return err;
	90	}
	91
	92	static struct platform_driver ucb1400_gpio_driver = {
	93	.probe = ucb1400_gpio_probe,
	94	.remove = ucb1400_gpio_remove,
	95	.driver = {
	96	.name = "ucb1400_gpio"
	97	},
	98	};
	99
6f61415e	100	module_platform_driver(ucb1400_gpio_driver);
4cf8e53b MV	101
	102	MODULE_DESCRIPTION("Philips UCB1400 GPIO driver");
	103	MODULE_LICENSE("GPL");
41ad730e	104	MODULE_ALIAS("platform:ucb1400_gpio");