kasan: stop tests being eliminated as dead code with FORTIFY_SOURCE
[linux/fpc-iii.git] / drivers / gpio / gpio-max77620.c
blob313bd02dd89310940cbb1e424bbc6201f14a5e74
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * MAXIM MAX77620 GPIO driver
5 * Copyright (c) 2016, NVIDIA CORPORATION. All rights reserved.
6 */
8 #include <linux/gpio/driver.h>
9 #include <linux/interrupt.h>
10 #include <linux/mfd/max77620.h>
11 #include <linux/module.h>
12 #include <linux/platform_device.h>
13 #include <linux/regmap.h>
15 #define GPIO_REG_ADDR(offset) (MAX77620_REG_GPIO0 + offset)
17 struct max77620_gpio {
18 struct gpio_chip gpio_chip;
19 struct regmap *rmap;
20 struct device *dev;
21 struct mutex buslock; /* irq_bus_lock */
22 unsigned int irq_type[8];
23 bool irq_enabled[8];
26 static irqreturn_t max77620_gpio_irqhandler(int irq, void *data)
28 struct max77620_gpio *gpio = data;
29 unsigned int value, offset;
30 unsigned long pending;
31 int err;
33 err = regmap_read(gpio->rmap, MAX77620_REG_IRQ_LVL2_GPIO, &value);
34 if (err < 0) {
35 dev_err(gpio->dev, "REG_IRQ_LVL2_GPIO read failed: %d\n", err);
36 return IRQ_NONE;
39 pending = value;
41 for_each_set_bit(offset, &pending, 8) {
42 unsigned int virq;
44 virq = irq_find_mapping(gpio->gpio_chip.irq.domain, offset);
45 handle_nested_irq(virq);
48 return IRQ_HANDLED;
51 static void max77620_gpio_irq_mask(struct irq_data *data)
53 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
54 struct max77620_gpio *gpio = gpiochip_get_data(chip);
56 gpio->irq_enabled[data->hwirq] = false;
59 static void max77620_gpio_irq_unmask(struct irq_data *data)
61 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
62 struct max77620_gpio *gpio = gpiochip_get_data(chip);
64 gpio->irq_enabled[data->hwirq] = true;
67 static int max77620_gpio_set_irq_type(struct irq_data *data, unsigned int type)
69 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
70 struct max77620_gpio *gpio = gpiochip_get_data(chip);
71 unsigned int irq_type;
73 switch (type) {
74 case IRQ_TYPE_EDGE_RISING:
75 irq_type = MAX77620_CNFG_GPIO_INT_RISING;
76 break;
78 case IRQ_TYPE_EDGE_FALLING:
79 irq_type = MAX77620_CNFG_GPIO_INT_FALLING;
80 break;
82 case IRQ_TYPE_EDGE_BOTH:
83 irq_type = MAX77620_CNFG_GPIO_INT_RISING |
84 MAX77620_CNFG_GPIO_INT_FALLING;
85 break;
87 default:
88 return -EINVAL;
91 gpio->irq_type[data->hwirq] = irq_type;
93 return 0;
96 static void max77620_gpio_bus_lock(struct irq_data *data)
98 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
99 struct max77620_gpio *gpio = gpiochip_get_data(chip);
101 mutex_lock(&gpio->buslock);
104 static void max77620_gpio_bus_sync_unlock(struct irq_data *data)
106 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
107 struct max77620_gpio *gpio = gpiochip_get_data(chip);
108 unsigned int value, offset = data->hwirq;
109 int err;
111 value = gpio->irq_enabled[offset] ? gpio->irq_type[offset] : 0;
113 err = regmap_update_bits(gpio->rmap, GPIO_REG_ADDR(offset),
114 MAX77620_CNFG_GPIO_INT_MASK, value);
115 if (err < 0)
116 dev_err(chip->parent, "failed to update interrupt mask: %d\n",
117 err);
119 mutex_unlock(&gpio->buslock);
122 static struct irq_chip max77620_gpio_irqchip = {
123 .name = "max77620-gpio",
124 .irq_mask = max77620_gpio_irq_mask,
125 .irq_unmask = max77620_gpio_irq_unmask,
126 .irq_set_type = max77620_gpio_set_irq_type,
127 .irq_bus_lock = max77620_gpio_bus_lock,
128 .irq_bus_sync_unlock = max77620_gpio_bus_sync_unlock,
129 .flags = IRQCHIP_MASK_ON_SUSPEND,
132 static int max77620_gpio_dir_input(struct gpio_chip *gc, unsigned int offset)
134 struct max77620_gpio *mgpio = gpiochip_get_data(gc);
135 int ret;
137 ret = regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
138 MAX77620_CNFG_GPIO_DIR_MASK,
139 MAX77620_CNFG_GPIO_DIR_INPUT);
140 if (ret < 0)
141 dev_err(mgpio->dev, "CNFG_GPIOx dir update failed: %d\n", ret);
143 return ret;
146 static int max77620_gpio_get(struct gpio_chip *gc, unsigned int offset)
148 struct max77620_gpio *mgpio = gpiochip_get_data(gc);
149 unsigned int val;
150 int ret;
152 ret = regmap_read(mgpio->rmap, GPIO_REG_ADDR(offset), &val);
153 if (ret < 0) {
154 dev_err(mgpio->dev, "CNFG_GPIOx read failed: %d\n", ret);
155 return ret;
158 if (val & MAX77620_CNFG_GPIO_DIR_MASK)
159 return !!(val & MAX77620_CNFG_GPIO_INPUT_VAL_MASK);
160 else
161 return !!(val & MAX77620_CNFG_GPIO_OUTPUT_VAL_MASK);
164 static int max77620_gpio_dir_output(struct gpio_chip *gc, unsigned int offset,
165 int value)
167 struct max77620_gpio *mgpio = gpiochip_get_data(gc);
168 u8 val;
169 int ret;
171 val = (value) ? MAX77620_CNFG_GPIO_OUTPUT_VAL_HIGH :
172 MAX77620_CNFG_GPIO_OUTPUT_VAL_LOW;
174 ret = regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
175 MAX77620_CNFG_GPIO_OUTPUT_VAL_MASK, val);
176 if (ret < 0) {
177 dev_err(mgpio->dev, "CNFG_GPIOx val update failed: %d\n", ret);
178 return ret;
181 ret = regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
182 MAX77620_CNFG_GPIO_DIR_MASK,
183 MAX77620_CNFG_GPIO_DIR_OUTPUT);
184 if (ret < 0)
185 dev_err(mgpio->dev, "CNFG_GPIOx dir update failed: %d\n", ret);
187 return ret;
190 static int max77620_gpio_set_debounce(struct max77620_gpio *mgpio,
191 unsigned int offset,
192 unsigned int debounce)
194 u8 val;
195 int ret;
197 switch (debounce) {
198 case 0:
199 val = MAX77620_CNFG_GPIO_DBNC_None;
200 break;
201 case 1 ... 8000:
202 val = MAX77620_CNFG_GPIO_DBNC_8ms;
203 break;
204 case 8001 ... 16000:
205 val = MAX77620_CNFG_GPIO_DBNC_16ms;
206 break;
207 case 16001 ... 32000:
208 val = MAX77620_CNFG_GPIO_DBNC_32ms;
209 break;
210 default:
211 dev_err(mgpio->dev, "Illegal value %u\n", debounce);
212 return -EINVAL;
215 ret = regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
216 MAX77620_CNFG_GPIO_DBNC_MASK, val);
217 if (ret < 0)
218 dev_err(mgpio->dev, "CNFG_GPIOx_DBNC update failed: %d\n", ret);
220 return ret;
223 static void max77620_gpio_set(struct gpio_chip *gc, unsigned int offset,
224 int value)
226 struct max77620_gpio *mgpio = gpiochip_get_data(gc);
227 u8 val;
228 int ret;
230 val = (value) ? MAX77620_CNFG_GPIO_OUTPUT_VAL_HIGH :
231 MAX77620_CNFG_GPIO_OUTPUT_VAL_LOW;
233 ret = regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
234 MAX77620_CNFG_GPIO_OUTPUT_VAL_MASK, val);
235 if (ret < 0)
236 dev_err(mgpio->dev, "CNFG_GPIO_OUT update failed: %d\n", ret);
239 static int max77620_gpio_set_config(struct gpio_chip *gc, unsigned int offset,
240 unsigned long config)
242 struct max77620_gpio *mgpio = gpiochip_get_data(gc);
244 switch (pinconf_to_config_param(config)) {
245 case PIN_CONFIG_DRIVE_OPEN_DRAIN:
246 return regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
247 MAX77620_CNFG_GPIO_DRV_MASK,
248 MAX77620_CNFG_GPIO_DRV_OPENDRAIN);
249 case PIN_CONFIG_DRIVE_PUSH_PULL:
250 return regmap_update_bits(mgpio->rmap, GPIO_REG_ADDR(offset),
251 MAX77620_CNFG_GPIO_DRV_MASK,
252 MAX77620_CNFG_GPIO_DRV_PUSHPULL);
253 case PIN_CONFIG_INPUT_DEBOUNCE:
254 return max77620_gpio_set_debounce(mgpio, offset,
255 pinconf_to_config_argument(config));
256 default:
257 break;
260 return -ENOTSUPP;
263 static int max77620_gpio_probe(struct platform_device *pdev)
265 struct max77620_chip *chip = dev_get_drvdata(pdev->dev.parent);
266 struct max77620_gpio *mgpio;
267 int gpio_irq;
268 int ret;
270 gpio_irq = platform_get_irq(pdev, 0);
271 if (gpio_irq <= 0)
272 return -ENODEV;
274 mgpio = devm_kzalloc(&pdev->dev, sizeof(*mgpio), GFP_KERNEL);
275 if (!mgpio)
276 return -ENOMEM;
278 mgpio->rmap = chip->rmap;
279 mgpio->dev = &pdev->dev;
281 mgpio->gpio_chip.label = pdev->name;
282 mgpio->gpio_chip.parent = &pdev->dev;
283 mgpio->gpio_chip.direction_input = max77620_gpio_dir_input;
284 mgpio->gpio_chip.get = max77620_gpio_get;
285 mgpio->gpio_chip.direction_output = max77620_gpio_dir_output;
286 mgpio->gpio_chip.set = max77620_gpio_set;
287 mgpio->gpio_chip.set_config = max77620_gpio_set_config;
288 mgpio->gpio_chip.ngpio = MAX77620_GPIO_NR;
289 mgpio->gpio_chip.can_sleep = 1;
290 mgpio->gpio_chip.base = -1;
291 #ifdef CONFIG_OF_GPIO
292 mgpio->gpio_chip.of_node = pdev->dev.parent->of_node;
293 #endif
295 platform_set_drvdata(pdev, mgpio);
297 ret = devm_gpiochip_add_data(&pdev->dev, &mgpio->gpio_chip, mgpio);
298 if (ret < 0) {
299 dev_err(&pdev->dev, "gpio_init: Failed to add max77620_gpio\n");
300 return ret;
303 mutex_init(&mgpio->buslock);
305 gpiochip_irqchip_add_nested(&mgpio->gpio_chip, &max77620_gpio_irqchip,
306 0, handle_edge_irq, IRQ_TYPE_NONE);
308 ret = request_threaded_irq(gpio_irq, NULL, max77620_gpio_irqhandler,
309 IRQF_ONESHOT, "max77620-gpio", mgpio);
310 if (ret < 0) {
311 dev_err(&pdev->dev, "failed to request IRQ: %d\n", ret);
312 return ret;
315 gpiochip_set_nested_irqchip(&mgpio->gpio_chip, &max77620_gpio_irqchip,
316 gpio_irq);
318 return 0;
321 static const struct platform_device_id max77620_gpio_devtype[] = {
322 { .name = "max77620-gpio", },
323 { .name = "max20024-gpio", },
326 MODULE_DEVICE_TABLE(platform, max77620_gpio_devtype);
328 static struct platform_driver max77620_gpio_driver = {
329 .driver.name = "max77620-gpio",
330 .probe = max77620_gpio_probe,
331 .id_table = max77620_gpio_devtype,
334 module_platform_driver(max77620_gpio_driver);
336 MODULE_DESCRIPTION("GPIO interface for MAX77620 and MAX20024 PMIC");
337 MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
338 MODULE_AUTHOR("Chaitanya Bandi <bandik@nvidia.com>");
339 MODULE_ALIAS("platform:max77620-gpio");
340 MODULE_LICENSE("GPL v2");