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