nvme: catch errors from nvme_configure_metadata()
[platform/kernel/linux-starfive.git] / drivers / gpio / gpio-lp87565.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) 2017 Texas Instruments Incorporated - http://www.ti.com/
4  *      Keerthy <j-keerthy@ti.com>
5  *
6  * Based on the LP873X driver
7  */
8
9 #include <linux/gpio/driver.h>
10 #include <linux/module.h>
11 #include <linux/platform_device.h>
12 #include <linux/regmap.h>
13
14 #include <linux/mfd/lp87565.h>
15
16 struct lp87565_gpio {
17         struct gpio_chip chip;
18         struct regmap *map;
19 };
20
21 static int lp87565_gpio_get(struct gpio_chip *chip, unsigned int offset)
22 {
23         struct lp87565_gpio *gpio = gpiochip_get_data(chip);
24         int ret, val;
25
26         ret = regmap_read(gpio->map, LP87565_REG_GPIO_IN, &val);
27         if (ret < 0)
28                 return ret;
29
30         return !!(val & BIT(offset));
31 }
32
33 static void lp87565_gpio_set(struct gpio_chip *chip, unsigned int offset,
34                              int value)
35 {
36         struct lp87565_gpio *gpio = gpiochip_get_data(chip);
37
38         regmap_update_bits(gpio->map, LP87565_REG_GPIO_OUT,
39                            BIT(offset), value ? BIT(offset) : 0);
40 }
41
42 static int lp87565_gpio_get_direction(struct gpio_chip *chip,
43                                       unsigned int offset)
44 {
45         struct lp87565_gpio *gpio = gpiochip_get_data(chip);
46         int ret, val;
47
48         ret = regmap_read(gpio->map, LP87565_REG_GPIO_CONFIG, &val);
49         if (ret < 0)
50                 return ret;
51
52         if (val & BIT(offset))
53                 return GPIO_LINE_DIRECTION_OUT;
54
55         return GPIO_LINE_DIRECTION_IN;
56 }
57
58 static int lp87565_gpio_direction_input(struct gpio_chip *chip,
59                                         unsigned int offset)
60 {
61         struct lp87565_gpio *gpio = gpiochip_get_data(chip);
62
63         return regmap_update_bits(gpio->map,
64                                   LP87565_REG_GPIO_CONFIG,
65                                   BIT(offset), 0);
66 }
67
68 static int lp87565_gpio_direction_output(struct gpio_chip *chip,
69                                          unsigned int offset, int value)
70 {
71         struct lp87565_gpio *gpio = gpiochip_get_data(chip);
72
73         lp87565_gpio_set(chip, offset, value);
74
75         return regmap_update_bits(gpio->map,
76                                   LP87565_REG_GPIO_CONFIG,
77                                   BIT(offset), BIT(offset));
78 }
79
80 static int lp87565_gpio_request(struct gpio_chip *gc, unsigned int offset)
81 {
82         struct lp87565_gpio *gpio = gpiochip_get_data(gc);
83         int ret;
84
85         switch (offset) {
86         case 0:
87         case 1:
88         case 2:
89                 /*
90                  * MUX can program the pin to be in EN1/2/3 pin mode
91                  * Or GPIO1/2/3 mode.
92                  * Setup the GPIO*_SEL MUX to GPIO mode
93                  */
94                 ret = regmap_update_bits(gpio->map,
95                                          LP87565_REG_PIN_FUNCTION,
96                                          BIT(offset), BIT(offset));
97                 if (ret)
98                         return ret;
99
100                 break;
101         default:
102                 return -EINVAL;
103         }
104
105         return 0;
106 }
107
108 static int lp87565_gpio_set_config(struct gpio_chip *gc, unsigned int offset,
109                                    unsigned long config)
110 {
111         struct lp87565_gpio *gpio = gpiochip_get_data(gc);
112
113         switch (pinconf_to_config_param(config)) {
114         case PIN_CONFIG_DRIVE_OPEN_DRAIN:
115                 return regmap_update_bits(gpio->map,
116                                           LP87565_REG_GPIO_CONFIG,
117                                           BIT(offset +
118                                               __ffs(LP87565_GPIO1_OD)),
119                                           BIT(offset +
120                                               __ffs(LP87565_GPIO1_OD)));
121         case PIN_CONFIG_DRIVE_PUSH_PULL:
122                 return regmap_update_bits(gpio->map,
123                                           LP87565_REG_GPIO_CONFIG,
124                                           BIT(offset +
125                                               __ffs(LP87565_GPIO1_OD)), 0);
126         default:
127                 return -ENOTSUPP;
128         }
129 }
130
131 static const struct gpio_chip template_chip = {
132         .label                  = "lp87565-gpio",
133         .owner                  = THIS_MODULE,
134         .request                = lp87565_gpio_request,
135         .get_direction          = lp87565_gpio_get_direction,
136         .direction_input        = lp87565_gpio_direction_input,
137         .direction_output       = lp87565_gpio_direction_output,
138         .get                    = lp87565_gpio_get,
139         .set                    = lp87565_gpio_set,
140         .set_config             = lp87565_gpio_set_config,
141         .base                   = -1,
142         .ngpio                  = 3,
143         .can_sleep              = true,
144 };
145
146 static int lp87565_gpio_probe(struct platform_device *pdev)
147 {
148         struct lp87565_gpio *gpio;
149         struct lp87565 *lp87565;
150         int ret;
151
152         gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
153         if (!gpio)
154                 return -ENOMEM;
155
156         lp87565 = dev_get_drvdata(pdev->dev.parent);
157         gpio->chip = template_chip;
158         gpio->chip.parent = lp87565->dev;
159         gpio->map = lp87565->regmap;
160
161         ret = devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio);
162         if (ret < 0) {
163                 dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
164                 return ret;
165         }
166
167         return 0;
168 }
169
170 static const struct platform_device_id lp87565_gpio_id_table[] = {
171         { "lp87565-q1-gpio", },
172         { /* sentinel */ }
173 };
174 MODULE_DEVICE_TABLE(platform, lp87565_gpio_id_table);
175
176 static struct platform_driver lp87565_gpio_driver = {
177         .driver = {
178                 .name = "lp87565-gpio",
179         },
180         .probe = lp87565_gpio_probe,
181         .id_table = lp87565_gpio_id_table,
182 };
183 module_platform_driver(lp87565_gpio_driver);
184
185 MODULE_AUTHOR("Keerthy <j-keerthy@ti.com>");
186 MODULE_DESCRIPTION("LP87565 GPIO driver");
187 MODULE_LICENSE("GPL v2");