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 | |
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; |
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) { |
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"); |