blob: 00526fdd7691f2adba8798b082ca36b67f8f0fbb [file] [log] [blame]
David Brazdil0f672f62019-12-10 10:32:29 +00001// SPDX-License-Identifier: GPL-2.0
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002#include <linux/bitmap.h>
3#include <linux/kernel.h>
4#include <linux/module.h>
5#include <linux/interrupt.h>
6#include <linux/irq.h>
7#include <linux/spinlock.h>
8#include <linux/list.h>
9#include <linux/device.h>
10#include <linux/err.h>
11#include <linux/debugfs.h>
12#include <linux/seq_file.h>
13#include <linux/gpio.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000014#include <linux/idr.h>
15#include <linux/slab.h>
16#include <linux/acpi.h>
17#include <linux/gpio/driver.h>
18#include <linux/gpio/machine.h>
19#include <linux/pinctrl/consumer.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000020#include <linux/fs.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000021#include <linux/compat.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000022#include <linux/file.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000023#include <uapi/linux/gpio.h>
24
25#include "gpiolib.h"
David Brazdil0f672f62019-12-10 10:32:29 +000026#include "gpiolib-of.h"
27#include "gpiolib-acpi.h"
Olivier Deprez157378f2022-04-04 15:47:50 +020028#include "gpiolib-cdev.h"
29#include "gpiolib-sysfs.h"
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000030
31#define CREATE_TRACE_POINTS
32#include <trace/events/gpio.h>
33
34/* Implementation infrastructure for GPIO interfaces.
35 *
36 * The GPIO programming interface allows for inlining speed-critical
37 * get/set operations for common cases, so that access to SOC-integrated
38 * GPIOs can sometimes cost only an instruction or two per bit.
39 */
40
41
42/* When debugging, extend minimal trust to callers and platform code.
43 * Also emit diagnostic messages that may help initial bringup, when
44 * board setup or driver bugs are most common.
45 *
46 * Otherwise, minimize overhead in what may be bitbanging codepaths.
47 */
48#ifdef DEBUG
49#define extra_checks 1
50#else
51#define extra_checks 0
52#endif
53
54/* Device and char device-related information */
55static DEFINE_IDA(gpio_ida);
56static dev_t gpio_devt;
57#define GPIO_DEV_MAX 256 /* 256 GPIO chip devices supported */
58static struct bus_type gpio_bus_type = {
59 .name = "gpio",
60};
61
62/*
63 * Number of GPIOs to use for the fast path in set array
64 */
65#define FASTPATH_NGPIO CONFIG_GPIOLIB_FASTPATH_LIMIT
66
67/* gpio_lock prevents conflicts during gpio_desc[] table updates.
68 * While any GPIO is requested, its gpio_chip is not removable;
69 * each GPIO's "requested" flag serves as a lock and refcount.
70 */
71DEFINE_SPINLOCK(gpio_lock);
72
73static DEFINE_MUTEX(gpio_lookup_lock);
74static LIST_HEAD(gpio_lookup_list);
75LIST_HEAD(gpio_devices);
76
77static DEFINE_MUTEX(gpio_machine_hogs_mutex);
78static LIST_HEAD(gpio_machine_hogs);
79
Olivier Deprez157378f2022-04-04 15:47:50 +020080static void gpiochip_free_hogs(struct gpio_chip *gc);
81static int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000082 struct lock_class_key *lock_key,
83 struct lock_class_key *request_key);
Olivier Deprez157378f2022-04-04 15:47:50 +020084static void gpiochip_irqchip_remove(struct gpio_chip *gc);
85static int gpiochip_irqchip_init_hw(struct gpio_chip *gc);
86static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc);
87static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000088
89static bool gpiolib_initialized;
90
91static inline void desc_set_label(struct gpio_desc *d, const char *label)
92{
93 d->label = label;
94}
95
96/**
97 * gpio_to_desc - Convert a GPIO number to its descriptor
98 * @gpio: global GPIO number
99 *
100 * Returns:
101 * The GPIO descriptor associated with the given GPIO, or %NULL if no GPIO
102 * with the given number exists in the system.
103 */
104struct gpio_desc *gpio_to_desc(unsigned gpio)
105{
106 struct gpio_device *gdev;
107 unsigned long flags;
108
109 spin_lock_irqsave(&gpio_lock, flags);
110
111 list_for_each_entry(gdev, &gpio_devices, list) {
112 if (gdev->base <= gpio &&
113 gdev->base + gdev->ngpio > gpio) {
114 spin_unlock_irqrestore(&gpio_lock, flags);
115 return &gdev->descs[gpio - gdev->base];
116 }
117 }
118
119 spin_unlock_irqrestore(&gpio_lock, flags);
120
121 if (!gpio_is_valid(gpio))
122 WARN(1, "invalid GPIO %d\n", gpio);
123
124 return NULL;
125}
126EXPORT_SYMBOL_GPL(gpio_to_desc);
127
128/**
129 * gpiochip_get_desc - get the GPIO descriptor corresponding to the given
130 * hardware number for this chip
Olivier Deprez157378f2022-04-04 15:47:50 +0200131 * @gc: GPIO chip
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000132 * @hwnum: hardware number of the GPIO for this chip
133 *
134 * Returns:
Olivier Deprez157378f2022-04-04 15:47:50 +0200135 * A pointer to the GPIO descriptor or ``ERR_PTR(-EINVAL)`` if no GPIO exists
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000136 * in the given chip for the specified hardware number.
137 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200138struct gpio_desc *gpiochip_get_desc(struct gpio_chip *gc,
139 unsigned int hwnum)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000140{
Olivier Deprez157378f2022-04-04 15:47:50 +0200141 struct gpio_device *gdev = gc->gpiodev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000142
143 if (hwnum >= gdev->ngpio)
144 return ERR_PTR(-EINVAL);
145
146 return &gdev->descs[hwnum];
147}
Olivier Deprez157378f2022-04-04 15:47:50 +0200148EXPORT_SYMBOL_GPL(gpiochip_get_desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000149
150/**
151 * desc_to_gpio - convert a GPIO descriptor to the integer namespace
152 * @desc: GPIO descriptor
153 *
154 * This should disappear in the future but is needed since we still
155 * use GPIO numbers for error messages and sysfs nodes.
156 *
157 * Returns:
158 * The global GPIO number for the GPIO specified by its descriptor.
159 */
160int desc_to_gpio(const struct gpio_desc *desc)
161{
162 return desc->gdev->base + (desc - &desc->gdev->descs[0]);
163}
164EXPORT_SYMBOL_GPL(desc_to_gpio);
165
166
167/**
168 * gpiod_to_chip - Return the GPIO chip to which a GPIO descriptor belongs
169 * @desc: descriptor to return the chip of
170 */
171struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
172{
173 if (!desc || !desc->gdev)
174 return NULL;
175 return desc->gdev->chip;
176}
177EXPORT_SYMBOL_GPL(gpiod_to_chip);
178
179/* dynamic allocation of GPIOs, e.g. on a hotplugged device */
180static int gpiochip_find_base(int ngpio)
181{
182 struct gpio_device *gdev;
183 int base = ARCH_NR_GPIOS - ngpio;
184
185 list_for_each_entry_reverse(gdev, &gpio_devices, list) {
186 /* found a free space? */
187 if (gdev->base + gdev->ngpio <= base)
188 break;
189 else
190 /* nope, check the space right before the chip */
191 base = gdev->base - ngpio;
192 }
193
194 if (gpio_is_valid(base)) {
195 pr_debug("%s: found new base at %d\n", __func__, base);
196 return base;
197 } else {
198 pr_err("%s: cannot find free range\n", __func__);
199 return -ENOSPC;
200 }
201}
202
203/**
204 * gpiod_get_direction - return the current direction of a GPIO
205 * @desc: GPIO to get the direction of
206 *
207 * Returns 0 for output, 1 for input, or an error code in case of error.
208 *
209 * This function may sleep if gpiod_cansleep() is true.
210 */
211int gpiod_get_direction(struct gpio_desc *desc)
212{
Olivier Deprez157378f2022-04-04 15:47:50 +0200213 struct gpio_chip *gc;
David Brazdil0f672f62019-12-10 10:32:29 +0000214 unsigned offset;
215 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000216
Olivier Deprez157378f2022-04-04 15:47:50 +0200217 gc = gpiod_to_chip(desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000218 offset = gpio_chip_hwgpio(desc);
219
Olivier Deprez0e641232021-09-23 10:07:05 +0200220 /*
221 * Open drain emulation using input mode may incorrectly report
222 * input here, fix that up.
223 */
224 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) &&
225 test_bit(FLAG_IS_OUT, &desc->flags))
226 return 0;
227
Olivier Deprez157378f2022-04-04 15:47:50 +0200228 if (!gc->get_direction)
David Brazdil0f672f62019-12-10 10:32:29 +0000229 return -ENOTSUPP;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000230
Olivier Deprez157378f2022-04-04 15:47:50 +0200231 ret = gc->get_direction(gc, offset);
232 if (ret < 0)
233 return ret;
234
235 /* GPIOF_DIR_IN or other positive, otherwise GPIOF_DIR_OUT */
236 if (ret > 0)
David Brazdil0f672f62019-12-10 10:32:29 +0000237 ret = 1;
Olivier Deprez157378f2022-04-04 15:47:50 +0200238
239 assign_bit(FLAG_IS_OUT, &desc->flags, !ret);
240
David Brazdil0f672f62019-12-10 10:32:29 +0000241 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000242}
243EXPORT_SYMBOL_GPL(gpiod_get_direction);
244
245/*
246 * Add a new chip to the global chips list, keeping the list of chips sorted
247 * by range(means [base, base + ngpio - 1]) order.
248 *
249 * Return -EBUSY if the new chip overlaps with some other chip's integer
250 * space.
251 */
252static int gpiodev_add_to_list(struct gpio_device *gdev)
253{
254 struct gpio_device *prev, *next;
255
256 if (list_empty(&gpio_devices)) {
257 /* initial entry in list */
258 list_add_tail(&gdev->list, &gpio_devices);
259 return 0;
260 }
261
262 next = list_entry(gpio_devices.next, struct gpio_device, list);
263 if (gdev->base + gdev->ngpio <= next->base) {
264 /* add before first entry */
265 list_add(&gdev->list, &gpio_devices);
266 return 0;
267 }
268
269 prev = list_entry(gpio_devices.prev, struct gpio_device, list);
270 if (prev->base + prev->ngpio <= gdev->base) {
271 /* add behind last entry */
272 list_add_tail(&gdev->list, &gpio_devices);
273 return 0;
274 }
275
276 list_for_each_entry_safe(prev, next, &gpio_devices, list) {
277 /* at the end of the list */
278 if (&next->list == &gpio_devices)
279 break;
280
281 /* add between prev and next */
282 if (prev->base + prev->ngpio <= gdev->base
283 && gdev->base + gdev->ngpio <= next->base) {
284 list_add(&gdev->list, &prev->list);
285 return 0;
286 }
287 }
288
289 dev_err(&gdev->dev, "GPIO integer space overlap, cannot add chip\n");
290 return -EBUSY;
291}
292
293/*
294 * Convert a GPIO name to its descriptor
Olivier Deprez157378f2022-04-04 15:47:50 +0200295 * Note that there is no guarantee that GPIO names are globally unique!
296 * Hence this function will return, if it exists, a reference to the first GPIO
297 * line found that matches the given name.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000298 */
299static struct gpio_desc *gpio_name_to_desc(const char * const name)
300{
301 struct gpio_device *gdev;
302 unsigned long flags;
303
Olivier Deprez157378f2022-04-04 15:47:50 +0200304 if (!name)
305 return NULL;
306
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000307 spin_lock_irqsave(&gpio_lock, flags);
308
309 list_for_each_entry(gdev, &gpio_devices, list) {
310 int i;
311
312 for (i = 0; i != gdev->ngpio; ++i) {
313 struct gpio_desc *desc = &gdev->descs[i];
314
Olivier Deprez157378f2022-04-04 15:47:50 +0200315 if (!desc->name)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000316 continue;
317
318 if (!strcmp(desc->name, name)) {
319 spin_unlock_irqrestore(&gpio_lock, flags);
320 return desc;
321 }
322 }
323 }
324
325 spin_unlock_irqrestore(&gpio_lock, flags);
326
327 return NULL;
328}
329
330/*
Olivier Deprez157378f2022-04-04 15:47:50 +0200331 * Take the names from gc->names and assign them to their GPIO descriptors.
332 * Warn if a name is already used for a GPIO line on a different GPIO chip.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000333 *
Olivier Deprez157378f2022-04-04 15:47:50 +0200334 * Note that:
335 * 1. Non-unique names are still accepted,
336 * 2. Name collisions within the same GPIO chip are not reported.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000337 */
338static int gpiochip_set_desc_names(struct gpio_chip *gc)
339{
340 struct gpio_device *gdev = gc->gpiodev;
341 int i;
342
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000343 /* First check all names if they are unique */
344 for (i = 0; i != gc->ngpio; ++i) {
345 struct gpio_desc *gpio;
346
347 gpio = gpio_name_to_desc(gc->names[i]);
348 if (gpio)
349 dev_warn(&gdev->dev,
350 "Detected name collision for GPIO name '%s'\n",
351 gc->names[i]);
352 }
353
354 /* Then add all names to the GPIO descriptors */
355 for (i = 0; i != gc->ngpio; ++i)
356 gdev->descs[i].name = gc->names[i];
357
358 return 0;
359}
360
Olivier Deprez157378f2022-04-04 15:47:50 +0200361/*
362 * devprop_gpiochip_set_names - Set GPIO line names using device properties
363 * @chip: GPIO chip whose lines should be named, if possible
364 *
365 * Looks for device property "gpio-line-names" and if it exists assigns
366 * GPIO line names for the chip. The memory allocated for the assigned
367 * names belong to the underlying firmware node and should not be released
368 * by the caller.
369 */
370static int devprop_gpiochip_set_names(struct gpio_chip *chip)
371{
372 struct gpio_device *gdev = chip->gpiodev;
373 struct fwnode_handle *fwnode = dev_fwnode(&gdev->dev);
374 const char **names;
375 int ret, i;
376 int count;
377
378 count = fwnode_property_string_array_count(fwnode, "gpio-line-names");
379 if (count < 0)
380 return 0;
381
382 if (count > gdev->ngpio) {
383 dev_warn(&gdev->dev, "gpio-line-names is length %d but should be at most length %d",
384 count, gdev->ngpio);
385 count = gdev->ngpio;
386 }
387
388 names = kcalloc(count, sizeof(*names), GFP_KERNEL);
389 if (!names)
390 return -ENOMEM;
391
392 ret = fwnode_property_read_string_array(fwnode, "gpio-line-names",
393 names, count);
394 if (ret < 0) {
395 dev_warn(&gdev->dev, "failed to read GPIO line names\n");
396 kfree(names);
397 return ret;
398 }
399
400 for (i = 0; i < count; i++)
401 gdev->descs[i].name = names[i];
402
403 kfree(names);
404
405 return 0;
406}
407
408static unsigned long *gpiochip_allocate_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000409{
410 unsigned long *p;
411
Olivier Deprez157378f2022-04-04 15:47:50 +0200412 p = bitmap_alloc(gc->ngpio, GFP_KERNEL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000413 if (!p)
414 return NULL;
415
416 /* Assume by default all GPIOs are valid */
Olivier Deprez157378f2022-04-04 15:47:50 +0200417 bitmap_fill(p, gc->ngpio);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000418
419 return p;
420}
421
David Brazdil0f672f62019-12-10 10:32:29 +0000422static int gpiochip_alloc_valid_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000423{
David Brazdil0f672f62019-12-10 10:32:29 +0000424 if (!(of_gpio_need_valid_mask(gc) || gc->init_valid_mask))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000425 return 0;
426
David Brazdil0f672f62019-12-10 10:32:29 +0000427 gc->valid_mask = gpiochip_allocate_mask(gc);
428 if (!gc->valid_mask)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000429 return -ENOMEM;
430
431 return 0;
432}
433
David Brazdil0f672f62019-12-10 10:32:29 +0000434static int gpiochip_init_valid_mask(struct gpio_chip *gc)
435{
436 if (gc->init_valid_mask)
437 return gc->init_valid_mask(gc,
438 gc->valid_mask,
439 gc->ngpio);
440
441 return 0;
442}
443
Olivier Deprez157378f2022-04-04 15:47:50 +0200444static void gpiochip_free_valid_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000445{
Olivier Deprez157378f2022-04-04 15:47:50 +0200446 bitmap_free(gc->valid_mask);
447 gc->valid_mask = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000448}
449
Olivier Deprez157378f2022-04-04 15:47:50 +0200450static int gpiochip_add_pin_ranges(struct gpio_chip *gc)
451{
452 if (gc->add_pin_ranges)
453 return gc->add_pin_ranges(gc);
454
455 return 0;
456}
457
458bool gpiochip_line_is_valid(const struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000459 unsigned int offset)
460{
461 /* No mask means all valid */
Olivier Deprez157378f2022-04-04 15:47:50 +0200462 if (likely(!gc->valid_mask))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000463 return true;
Olivier Deprez157378f2022-04-04 15:47:50 +0200464 return test_bit(offset, gc->valid_mask);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000465}
466EXPORT_SYMBOL_GPL(gpiochip_line_is_valid);
467
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000468static void gpiodevice_release(struct device *dev)
469{
470 struct gpio_device *gdev = dev_get_drvdata(dev);
Olivier Deprez157378f2022-04-04 15:47:50 +0200471 unsigned long flags;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000472
Olivier Deprez157378f2022-04-04 15:47:50 +0200473 spin_lock_irqsave(&gpio_lock, flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000474 list_del(&gdev->list);
Olivier Deprez157378f2022-04-04 15:47:50 +0200475 spin_unlock_irqrestore(&gpio_lock, flags);
476
477 ida_free(&gpio_ida, gdev->id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000478 kfree_const(gdev->label);
479 kfree(gdev->descs);
480 kfree(gdev);
481}
482
Olivier Deprez157378f2022-04-04 15:47:50 +0200483#ifdef CONFIG_GPIO_CDEV
484#define gcdev_register(gdev, devt) gpiolib_cdev_register((gdev), (devt))
485#define gcdev_unregister(gdev) gpiolib_cdev_unregister((gdev))
486#else
487/*
488 * gpiolib_cdev_register() indirectly calls device_add(), which is still
489 * required even when cdev is not selected.
490 */
491#define gcdev_register(gdev, devt) device_add(&(gdev)->dev)
492#define gcdev_unregister(gdev) device_del(&(gdev)->dev)
493#endif
494
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000495static int gpiochip_setup_dev(struct gpio_device *gdev)
496{
David Brazdil0f672f62019-12-10 10:32:29 +0000497 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000498
Olivier Deprez157378f2022-04-04 15:47:50 +0200499 ret = gcdev_register(gdev, gpio_devt);
David Brazdil0f672f62019-12-10 10:32:29 +0000500 if (ret)
501 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000502
David Brazdil0f672f62019-12-10 10:32:29 +0000503 ret = gpiochip_sysfs_register(gdev);
504 if (ret)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000505 goto err_remove_device;
506
507 /* From this point, the .release() function cleans up gpio_device */
508 gdev->dev.release = gpiodevice_release;
Olivier Deprez157378f2022-04-04 15:47:50 +0200509 dev_dbg(&gdev->dev, "registered GPIOs %d to %d on %s\n", gdev->base,
510 gdev->base + gdev->ngpio - 1, gdev->chip->label ? : "generic");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000511
512 return 0;
513
514err_remove_device:
Olivier Deprez157378f2022-04-04 15:47:50 +0200515 gcdev_unregister(gdev);
David Brazdil0f672f62019-12-10 10:32:29 +0000516 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000517}
518
Olivier Deprez157378f2022-04-04 15:47:50 +0200519static void gpiochip_machine_hog(struct gpio_chip *gc, struct gpiod_hog *hog)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000520{
521 struct gpio_desc *desc;
522 int rv;
523
Olivier Deprez157378f2022-04-04 15:47:50 +0200524 desc = gpiochip_get_desc(gc, hog->chip_hwnum);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000525 if (IS_ERR(desc)) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200526 chip_err(gc, "%s: unable to get GPIO desc: %ld\n", __func__,
527 PTR_ERR(desc));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000528 return;
529 }
530
531 if (test_bit(FLAG_IS_HOGGED, &desc->flags))
532 return;
533
534 rv = gpiod_hog(desc, hog->line_name, hog->lflags, hog->dflags);
535 if (rv)
Olivier Deprez157378f2022-04-04 15:47:50 +0200536 gpiod_err(desc, "%s: unable to hog GPIO line (%s:%u): %d\n",
537 __func__, gc->label, hog->chip_hwnum, rv);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000538}
539
Olivier Deprez157378f2022-04-04 15:47:50 +0200540static void machine_gpiochip_add(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000541{
542 struct gpiod_hog *hog;
543
544 mutex_lock(&gpio_machine_hogs_mutex);
545
546 list_for_each_entry(hog, &gpio_machine_hogs, list) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200547 if (!strcmp(gc->label, hog->chip_label))
548 gpiochip_machine_hog(gc, hog);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000549 }
550
551 mutex_unlock(&gpio_machine_hogs_mutex);
552}
553
554static void gpiochip_setup_devs(void)
555{
556 struct gpio_device *gdev;
David Brazdil0f672f62019-12-10 10:32:29 +0000557 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000558
559 list_for_each_entry(gdev, &gpio_devices, list) {
David Brazdil0f672f62019-12-10 10:32:29 +0000560 ret = gpiochip_setup_dev(gdev);
561 if (ret)
Olivier Deprez157378f2022-04-04 15:47:50 +0200562 dev_err(&gdev->dev,
563 "Failed to initialize gpio device (%d)\n", ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000564 }
565}
566
Olivier Deprez157378f2022-04-04 15:47:50 +0200567int gpiochip_add_data_with_key(struct gpio_chip *gc, void *data,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000568 struct lock_class_key *lock_key,
569 struct lock_class_key *request_key)
570{
Olivier Deprez157378f2022-04-04 15:47:50 +0200571 struct fwnode_handle *fwnode = gc->parent ? dev_fwnode(gc->parent) : NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000572 unsigned long flags;
David Brazdil0f672f62019-12-10 10:32:29 +0000573 int ret = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000574 unsigned i;
Olivier Deprez157378f2022-04-04 15:47:50 +0200575 int base = gc->base;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000576 struct gpio_device *gdev;
577
578 /*
579 * First: allocate and populate the internal stat container, and
580 * set up the struct device.
581 */
582 gdev = kzalloc(sizeof(*gdev), GFP_KERNEL);
583 if (!gdev)
584 return -ENOMEM;
585 gdev->dev.bus = &gpio_bus_type;
Olivier Deprez157378f2022-04-04 15:47:50 +0200586 gdev->chip = gc;
587 gc->gpiodev = gdev;
588 if (gc->parent) {
589 gdev->dev.parent = gc->parent;
590 gdev->dev.of_node = gc->parent->of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000591 }
592
593#ifdef CONFIG_OF_GPIO
594 /* If the gpiochip has an assigned OF node this takes precedence */
Olivier Deprez157378f2022-04-04 15:47:50 +0200595 if (gc->of_node)
596 gdev->dev.of_node = gc->of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000597 else
Olivier Deprez157378f2022-04-04 15:47:50 +0200598 gc->of_node = gdev->dev.of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000599#endif
600
Olivier Deprez157378f2022-04-04 15:47:50 +0200601 /*
602 * Assign fwnode depending on the result of the previous calls,
603 * if none of them succeed, assign it to the parent's one.
604 */
605 gdev->dev.fwnode = dev_fwnode(&gdev->dev) ?: fwnode;
606
607 gdev->id = ida_alloc(&gpio_ida, GFP_KERNEL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000608 if (gdev->id < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +0000609 ret = gdev->id;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000610 goto err_free_gdev;
611 }
Olivier Deprez157378f2022-04-04 15:47:50 +0200612
613 ret = dev_set_name(&gdev->dev, GPIOCHIP_NAME "%d", gdev->id);
614 if (ret)
615 goto err_free_ida;
616
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000617 device_initialize(&gdev->dev);
618 dev_set_drvdata(&gdev->dev, gdev);
Olivier Deprez157378f2022-04-04 15:47:50 +0200619 if (gc->parent && gc->parent->driver)
620 gdev->owner = gc->parent->driver->owner;
621 else if (gc->owner)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000622 /* TODO: remove chip->owner */
Olivier Deprez157378f2022-04-04 15:47:50 +0200623 gdev->owner = gc->owner;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000624 else
625 gdev->owner = THIS_MODULE;
626
Olivier Deprez157378f2022-04-04 15:47:50 +0200627 gdev->descs = kcalloc(gc->ngpio, sizeof(gdev->descs[0]), GFP_KERNEL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000628 if (!gdev->descs) {
David Brazdil0f672f62019-12-10 10:32:29 +0000629 ret = -ENOMEM;
Olivier Deprez157378f2022-04-04 15:47:50 +0200630 goto err_free_dev_name;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000631 }
632
Olivier Deprez157378f2022-04-04 15:47:50 +0200633 if (gc->ngpio == 0) {
634 chip_err(gc, "tried to insert a GPIO chip with zero lines\n");
David Brazdil0f672f62019-12-10 10:32:29 +0000635 ret = -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000636 goto err_free_descs;
637 }
638
Olivier Deprez157378f2022-04-04 15:47:50 +0200639 if (gc->ngpio > FASTPATH_NGPIO)
640 chip_warn(gc, "line cnt %u is greater than fast path cnt %u\n",
641 gc->ngpio, FASTPATH_NGPIO);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000642
Olivier Deprez157378f2022-04-04 15:47:50 +0200643 gdev->label = kstrdup_const(gc->label ?: "unknown", GFP_KERNEL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000644 if (!gdev->label) {
David Brazdil0f672f62019-12-10 10:32:29 +0000645 ret = -ENOMEM;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000646 goto err_free_descs;
647 }
648
Olivier Deprez157378f2022-04-04 15:47:50 +0200649 gdev->ngpio = gc->ngpio;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000650 gdev->data = data;
651
652 spin_lock_irqsave(&gpio_lock, flags);
653
654 /*
655 * TODO: this allocates a Linux GPIO number base in the global
656 * GPIO numberspace for this chip. In the long run we want to
657 * get *rid* of this numberspace and use only descriptors, but
658 * it may be a pipe dream. It will not happen before we get rid
659 * of the sysfs interface anyways.
660 */
661 if (base < 0) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200662 base = gpiochip_find_base(gc->ngpio);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000663 if (base < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +0000664 ret = base;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000665 spin_unlock_irqrestore(&gpio_lock, flags);
666 goto err_free_label;
667 }
668 /*
669 * TODO: it should not be necessary to reflect the assigned
670 * base outside of the GPIO subsystem. Go over drivers and
671 * see if anyone makes use of this, else drop this and assign
672 * a poison instead.
673 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200674 gc->base = base;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000675 }
676 gdev->base = base;
677
David Brazdil0f672f62019-12-10 10:32:29 +0000678 ret = gpiodev_add_to_list(gdev);
679 if (ret) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000680 spin_unlock_irqrestore(&gpio_lock, flags);
681 goto err_free_label;
682 }
683
Olivier Deprez157378f2022-04-04 15:47:50 +0200684 for (i = 0; i < gc->ngpio; i++)
685 gdev->descs[i].gdev = gdev;
686
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000687 spin_unlock_irqrestore(&gpio_lock, flags);
688
Olivier Deprez157378f2022-04-04 15:47:50 +0200689 BLOCKING_INIT_NOTIFIER_HEAD(&gdev->notifier);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000690
691#ifdef CONFIG_PINCTRL
692 INIT_LIST_HEAD(&gdev->pin_ranges);
693#endif
694
Olivier Deprez157378f2022-04-04 15:47:50 +0200695 if (gc->names)
696 ret = gpiochip_set_desc_names(gc);
697 else
698 ret = devprop_gpiochip_set_names(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000699 if (ret)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000700 goto err_remove_from_list;
701
Olivier Deprez157378f2022-04-04 15:47:50 +0200702 ret = gpiochip_alloc_valid_mask(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000703 if (ret)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000704 goto err_remove_from_list;
705
Olivier Deprez157378f2022-04-04 15:47:50 +0200706 ret = of_gpiochip_add(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000707 if (ret)
708 goto err_free_gpiochip_mask;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000709
Olivier Deprez157378f2022-04-04 15:47:50 +0200710 ret = gpiochip_init_valid_mask(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000711 if (ret)
712 goto err_remove_of_chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000713
Olivier Deprez157378f2022-04-04 15:47:50 +0200714 for (i = 0; i < gc->ngpio; i++) {
David Brazdil0f672f62019-12-10 10:32:29 +0000715 struct gpio_desc *desc = &gdev->descs[i];
716
Olivier Deprez157378f2022-04-04 15:47:50 +0200717 if (gc->get_direction && gpiochip_line_is_valid(gc, i)) {
718 assign_bit(FLAG_IS_OUT,
719 &desc->flags, !gc->get_direction(gc, i));
David Brazdil0f672f62019-12-10 10:32:29 +0000720 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +0200721 assign_bit(FLAG_IS_OUT,
722 &desc->flags, !gc->direction_input);
David Brazdil0f672f62019-12-10 10:32:29 +0000723 }
724 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000725
Olivier Deprez157378f2022-04-04 15:47:50 +0200726 ret = gpiochip_add_pin_ranges(gc);
727 if (ret)
728 goto err_remove_of_chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000729
Olivier Deprez157378f2022-04-04 15:47:50 +0200730 acpi_gpiochip_add(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000731
Olivier Deprez157378f2022-04-04 15:47:50 +0200732 machine_gpiochip_add(gc);
733
734 ret = gpiochip_irqchip_init_valid_mask(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000735 if (ret)
736 goto err_remove_acpi_chip;
737
Olivier Deprez157378f2022-04-04 15:47:50 +0200738 ret = gpiochip_irqchip_init_hw(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000739 if (ret)
740 goto err_remove_acpi_chip;
741
Olivier Deprez157378f2022-04-04 15:47:50 +0200742 ret = gpiochip_add_irqchip(gc, lock_key, request_key);
David Brazdil0f672f62019-12-10 10:32:29 +0000743 if (ret)
744 goto err_remove_irqchip_mask;
745
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000746 /*
747 * By first adding the chardev, and then adding the device,
748 * we get a device node entry in sysfs under
749 * /sys/bus/gpio/devices/gpiochipN/dev that can be used for
750 * coldplug of device nodes and other udev business.
751 * We can do this only if gpiolib has been initialized.
752 * Otherwise, defer until later.
753 */
754 if (gpiolib_initialized) {
David Brazdil0f672f62019-12-10 10:32:29 +0000755 ret = gpiochip_setup_dev(gdev);
756 if (ret)
757 goto err_remove_irqchip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000758 }
759 return 0;
760
David Brazdil0f672f62019-12-10 10:32:29 +0000761err_remove_irqchip:
Olivier Deprez157378f2022-04-04 15:47:50 +0200762 gpiochip_irqchip_remove(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000763err_remove_irqchip_mask:
Olivier Deprez157378f2022-04-04 15:47:50 +0200764 gpiochip_irqchip_free_valid_mask(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000765err_remove_acpi_chip:
Olivier Deprez157378f2022-04-04 15:47:50 +0200766 acpi_gpiochip_remove(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000767err_remove_of_chip:
Olivier Deprez157378f2022-04-04 15:47:50 +0200768 gpiochip_free_hogs(gc);
769 of_gpiochip_remove(gc);
David Brazdil0f672f62019-12-10 10:32:29 +0000770err_free_gpiochip_mask:
Olivier Deprez157378f2022-04-04 15:47:50 +0200771 gpiochip_remove_pin_ranges(gc);
772 gpiochip_free_valid_mask(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000773err_remove_from_list:
774 spin_lock_irqsave(&gpio_lock, flags);
775 list_del(&gdev->list);
776 spin_unlock_irqrestore(&gpio_lock, flags);
777err_free_label:
778 kfree_const(gdev->label);
779err_free_descs:
780 kfree(gdev->descs);
Olivier Deprez157378f2022-04-04 15:47:50 +0200781err_free_dev_name:
782 kfree(dev_name(&gdev->dev));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000783err_free_ida:
Olivier Deprez157378f2022-04-04 15:47:50 +0200784 ida_free(&gpio_ida, gdev->id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000785err_free_gdev:
786 /* failures here can mean systems won't boot... */
787 pr_err("%s: GPIOs %d..%d (%s) failed to register, %d\n", __func__,
788 gdev->base, gdev->base + gdev->ngpio - 1,
Olivier Deprez157378f2022-04-04 15:47:50 +0200789 gc->label ? : "generic", ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000790 kfree(gdev);
David Brazdil0f672f62019-12-10 10:32:29 +0000791 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000792}
793EXPORT_SYMBOL_GPL(gpiochip_add_data_with_key);
794
795/**
796 * gpiochip_get_data() - get per-subdriver data for the chip
Olivier Deprez157378f2022-04-04 15:47:50 +0200797 * @gc: GPIO chip
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000798 *
799 * Returns:
800 * The per-subdriver data for the chip.
801 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200802void *gpiochip_get_data(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000803{
Olivier Deprez157378f2022-04-04 15:47:50 +0200804 return gc->gpiodev->data;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000805}
806EXPORT_SYMBOL_GPL(gpiochip_get_data);
807
808/**
809 * gpiochip_remove() - unregister a gpio_chip
Olivier Deprez157378f2022-04-04 15:47:50 +0200810 * @gc: the chip to unregister
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000811 *
812 * A gpio_chip with any GPIOs still requested may not be removed.
813 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200814void gpiochip_remove(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000815{
Olivier Deprez157378f2022-04-04 15:47:50 +0200816 struct gpio_device *gdev = gc->gpiodev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000817 unsigned long flags;
Olivier Deprez157378f2022-04-04 15:47:50 +0200818 unsigned int i;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000819
820 /* FIXME: should the legacy sysfs handling be moved to gpio_device? */
821 gpiochip_sysfs_unregister(gdev);
Olivier Deprez157378f2022-04-04 15:47:50 +0200822 gpiochip_free_hogs(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000823 /* Numb the device, cancelling all outstanding operations */
824 gdev->chip = NULL;
Olivier Deprez157378f2022-04-04 15:47:50 +0200825 gpiochip_irqchip_remove(gc);
826 acpi_gpiochip_remove(gc);
827 of_gpiochip_remove(gc);
828 gpiochip_remove_pin_ranges(gc);
829 gpiochip_free_valid_mask(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000830 /*
831 * We accept no more calls into the driver from this point, so
832 * NULL the driver data pointer
833 */
834 gdev->data = NULL;
835
836 spin_lock_irqsave(&gpio_lock, flags);
837 for (i = 0; i < gdev->ngpio; i++) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200838 if (gpiochip_is_requested(gc, i))
839 break;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000840 }
841 spin_unlock_irqrestore(&gpio_lock, flags);
842
Olivier Deprez157378f2022-04-04 15:47:50 +0200843 if (i != gdev->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000844 dev_crit(&gdev->dev,
845 "REMOVING GPIOCHIP WITH GPIOS STILL REQUESTED\n");
846
847 /*
848 * The gpiochip side puts its use of the device to rest here:
849 * if there are no userspace clients, the chardev and device will
850 * be removed, else it will be dangling until the last user is
851 * gone.
852 */
Olivier Deprez157378f2022-04-04 15:47:50 +0200853 gcdev_unregister(gdev);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000854 put_device(&gdev->dev);
855}
856EXPORT_SYMBOL_GPL(gpiochip_remove);
857
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000858/**
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000859 * gpiochip_find() - iterator for locating a specific gpio_chip
860 * @data: data to pass to match function
861 * @match: Callback function to check gpio_chip
862 *
863 * Similar to bus_find_device. It returns a reference to a gpio_chip as
864 * determined by a user supplied @match callback. The callback should return
865 * 0 if the device doesn't match and non-zero if it does. If the callback is
866 * non-zero, this function will return to the caller and not iterate over any
867 * more gpio_chips.
868 */
869struct gpio_chip *gpiochip_find(void *data,
Olivier Deprez157378f2022-04-04 15:47:50 +0200870 int (*match)(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000871 void *data))
872{
873 struct gpio_device *gdev;
Olivier Deprez157378f2022-04-04 15:47:50 +0200874 struct gpio_chip *gc = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000875 unsigned long flags;
876
877 spin_lock_irqsave(&gpio_lock, flags);
878 list_for_each_entry(gdev, &gpio_devices, list)
879 if (gdev->chip && match(gdev->chip, data)) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200880 gc = gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000881 break;
882 }
883
884 spin_unlock_irqrestore(&gpio_lock, flags);
885
Olivier Deprez157378f2022-04-04 15:47:50 +0200886 return gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000887}
888EXPORT_SYMBOL_GPL(gpiochip_find);
889
Olivier Deprez157378f2022-04-04 15:47:50 +0200890static int gpiochip_match_name(struct gpio_chip *gc, void *data)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000891{
892 const char *name = data;
893
Olivier Deprez157378f2022-04-04 15:47:50 +0200894 return !strcmp(gc->label, name);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000895}
896
897static struct gpio_chip *find_chip_by_name(const char *name)
898{
899 return gpiochip_find((void *)name, gpiochip_match_name);
900}
901
902#ifdef CONFIG_GPIOLIB_IRQCHIP
903
904/*
905 * The following is irqchip helper code for gpiochips.
906 */
907
David Brazdil0f672f62019-12-10 10:32:29 +0000908static int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000909{
David Brazdil0f672f62019-12-10 10:32:29 +0000910 struct gpio_irq_chip *girq = &gc->irq;
911
912 if (!girq->init_hw)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000913 return 0;
914
David Brazdil0f672f62019-12-10 10:32:29 +0000915 return girq->init_hw(gc);
916}
917
918static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
919{
920 struct gpio_irq_chip *girq = &gc->irq;
921
922 if (!girq->init_valid_mask)
923 return 0;
924
925 girq->valid_mask = gpiochip_allocate_mask(gc);
926 if (!girq->valid_mask)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000927 return -ENOMEM;
928
David Brazdil0f672f62019-12-10 10:32:29 +0000929 girq->init_valid_mask(gc, girq->valid_mask, gc->ngpio);
930
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000931 return 0;
932}
933
Olivier Deprez157378f2022-04-04 15:47:50 +0200934static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000935{
Olivier Deprez157378f2022-04-04 15:47:50 +0200936 bitmap_free(gc->irq.valid_mask);
937 gc->irq.valid_mask = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000938}
939
Olivier Deprez157378f2022-04-04 15:47:50 +0200940bool gpiochip_irqchip_irq_valid(const struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000941 unsigned int offset)
942{
Olivier Deprez157378f2022-04-04 15:47:50 +0200943 if (!gpiochip_line_is_valid(gc, offset))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000944 return false;
945 /* No mask means all valid */
Olivier Deprez157378f2022-04-04 15:47:50 +0200946 if (likely(!gc->irq.valid_mask))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000947 return true;
Olivier Deprez157378f2022-04-04 15:47:50 +0200948 return test_bit(offset, gc->irq.valid_mask);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000949}
950EXPORT_SYMBOL_GPL(gpiochip_irqchip_irq_valid);
951
952/**
953 * gpiochip_set_cascaded_irqchip() - connects a cascaded irqchip to a gpiochip
David Brazdil0f672f62019-12-10 10:32:29 +0000954 * @gc: the gpiochip to set the irqchip chain to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000955 * @parent_irq: the irq number corresponding to the parent IRQ for this
Olivier Deprez157378f2022-04-04 15:47:50 +0200956 * cascaded irqchip
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000957 * @parent_handler: the parent interrupt handler for the accumulated IRQ
958 * coming out of the gpiochip. If the interrupt is nested rather than
959 * cascaded, pass NULL in this handler argument
960 */
David Brazdil0f672f62019-12-10 10:32:29 +0000961static void gpiochip_set_cascaded_irqchip(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000962 unsigned int parent_irq,
963 irq_flow_handler_t parent_handler)
964{
David Brazdil0f672f62019-12-10 10:32:29 +0000965 struct gpio_irq_chip *girq = &gc->irq;
966 struct device *dev = &gc->gpiodev->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000967
David Brazdil0f672f62019-12-10 10:32:29 +0000968 if (!girq->domain) {
969 chip_err(gc, "called %s before setting up irqchip\n",
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000970 __func__);
971 return;
972 }
973
974 if (parent_handler) {
David Brazdil0f672f62019-12-10 10:32:29 +0000975 if (gc->can_sleep) {
976 chip_err(gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000977 "you cannot have chained interrupts on a chip that may sleep\n");
978 return;
979 }
David Brazdil0f672f62019-12-10 10:32:29 +0000980 girq->parents = devm_kcalloc(dev, 1,
981 sizeof(*girq->parents),
982 GFP_KERNEL);
983 if (!girq->parents) {
984 chip_err(gc, "out of memory allocating parent IRQ\n");
985 return;
986 }
987 girq->parents[0] = parent_irq;
988 girq->num_parents = 1;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000989 /*
990 * The parent irqchip is already using the chip_data for this
991 * irqchip, so our callbacks simply use the handler_data.
992 */
993 irq_set_chained_handler_and_data(parent_irq, parent_handler,
David Brazdil0f672f62019-12-10 10:32:29 +0000994 gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000995 }
996}
997
998/**
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000999 * gpiochip_set_nested_irqchip() - connects a nested irqchip to a gpiochip
Olivier Deprez157378f2022-04-04 15:47:50 +02001000 * @gc: the gpiochip to set the irqchip nested handler to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001001 * @irqchip: the irqchip to nest to the gpiochip
1002 * @parent_irq: the irq number corresponding to the parent IRQ for this
1003 * nested irqchip
1004 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001005void gpiochip_set_nested_irqchip(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001006 struct irq_chip *irqchip,
1007 unsigned int parent_irq)
1008{
Olivier Deprez157378f2022-04-04 15:47:50 +02001009 gpiochip_set_cascaded_irqchip(gc, parent_irq, NULL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001010}
1011EXPORT_SYMBOL_GPL(gpiochip_set_nested_irqchip);
1012
David Brazdil0f672f62019-12-10 10:32:29 +00001013#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1014
1015/**
1016 * gpiochip_set_hierarchical_irqchip() - connects a hierarchical irqchip
1017 * to a gpiochip
1018 * @gc: the gpiochip to set the irqchip hierarchical handler to
1019 * @irqchip: the irqchip to handle this level of the hierarchy, the interrupt
1020 * will then percolate up to the parent
1021 */
1022static void gpiochip_set_hierarchical_irqchip(struct gpio_chip *gc,
1023 struct irq_chip *irqchip)
1024{
1025 /* DT will deal with mapping each IRQ as we go along */
1026 if (is_of_node(gc->irq.fwnode))
1027 return;
1028
1029 /*
1030 * This is for legacy and boardfile "irqchip" fwnodes: allocate
1031 * irqs upfront instead of dynamically since we don't have the
1032 * dynamic type of allocation that hardware description languages
1033 * provide. Once all GPIO drivers using board files are gone from
1034 * the kernel we can delete this code, but for a transitional period
1035 * it is necessary to keep this around.
1036 */
1037 if (is_fwnode_irqchip(gc->irq.fwnode)) {
1038 int i;
1039 int ret;
1040
1041 for (i = 0; i < gc->ngpio; i++) {
1042 struct irq_fwspec fwspec;
1043 unsigned int parent_hwirq;
1044 unsigned int parent_type;
1045 struct gpio_irq_chip *girq = &gc->irq;
1046
1047 /*
1048 * We call the child to parent translation function
1049 * only to check if the child IRQ is valid or not.
1050 * Just pick the rising edge type here as that is what
1051 * we likely need to support.
1052 */
1053 ret = girq->child_to_parent_hwirq(gc, i,
1054 IRQ_TYPE_EDGE_RISING,
1055 &parent_hwirq,
1056 &parent_type);
1057 if (ret) {
1058 chip_err(gc, "skip set-up on hwirq %d\n",
1059 i);
1060 continue;
1061 }
1062
1063 fwspec.fwnode = gc->irq.fwnode;
1064 /* This is the hwirq for the GPIO line side of things */
1065 fwspec.param[0] = girq->child_offset_to_irq(gc, i);
1066 /* Just pick something */
1067 fwspec.param[1] = IRQ_TYPE_EDGE_RISING;
1068 fwspec.param_count = 2;
1069 ret = __irq_domain_alloc_irqs(gc->irq.domain,
1070 /* just pick something */
1071 -1,
1072 1,
1073 NUMA_NO_NODE,
1074 &fwspec,
1075 false,
1076 NULL);
1077 if (ret < 0) {
1078 chip_err(gc,
1079 "can not allocate irq for GPIO line %d parent hwirq %d in hierarchy domain: %d\n",
1080 i, parent_hwirq,
1081 ret);
1082 }
1083 }
1084 }
1085
1086 chip_err(gc, "%s unknown fwnode type proceed anyway\n", __func__);
1087
1088 return;
1089}
1090
1091static int gpiochip_hierarchy_irq_domain_translate(struct irq_domain *d,
1092 struct irq_fwspec *fwspec,
1093 unsigned long *hwirq,
1094 unsigned int *type)
1095{
1096 /* We support standard DT translation */
1097 if (is_of_node(fwspec->fwnode) && fwspec->param_count == 2) {
1098 return irq_domain_translate_twocell(d, fwspec, hwirq, type);
1099 }
1100
1101 /* This is for board files and others not using DT */
1102 if (is_fwnode_irqchip(fwspec->fwnode)) {
1103 int ret;
1104
1105 ret = irq_domain_translate_twocell(d, fwspec, hwirq, type);
1106 if (ret)
1107 return ret;
1108 WARN_ON(*type == IRQ_TYPE_NONE);
1109 return 0;
1110 }
1111 return -EINVAL;
1112}
1113
1114static int gpiochip_hierarchy_irq_domain_alloc(struct irq_domain *d,
1115 unsigned int irq,
1116 unsigned int nr_irqs,
1117 void *data)
1118{
1119 struct gpio_chip *gc = d->host_data;
1120 irq_hw_number_t hwirq;
1121 unsigned int type = IRQ_TYPE_NONE;
1122 struct irq_fwspec *fwspec = data;
Olivier Deprez157378f2022-04-04 15:47:50 +02001123 void *parent_arg;
David Brazdil0f672f62019-12-10 10:32:29 +00001124 unsigned int parent_hwirq;
1125 unsigned int parent_type;
1126 struct gpio_irq_chip *girq = &gc->irq;
1127 int ret;
1128
1129 /*
1130 * The nr_irqs parameter is always one except for PCI multi-MSI
1131 * so this should not happen.
1132 */
1133 WARN_ON(nr_irqs != 1);
1134
1135 ret = gc->irq.child_irq_domain_ops.translate(d, fwspec, &hwirq, &type);
1136 if (ret)
1137 return ret;
1138
Olivier Deprez157378f2022-04-04 15:47:50 +02001139 chip_dbg(gc, "allocate IRQ %d, hwirq %lu\n", irq, hwirq);
David Brazdil0f672f62019-12-10 10:32:29 +00001140
1141 ret = girq->child_to_parent_hwirq(gc, hwirq, type,
1142 &parent_hwirq, &parent_type);
1143 if (ret) {
1144 chip_err(gc, "can't look up hwirq %lu\n", hwirq);
1145 return ret;
1146 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001147 chip_dbg(gc, "found parent hwirq %u\n", parent_hwirq);
David Brazdil0f672f62019-12-10 10:32:29 +00001148
1149 /*
1150 * We set handle_bad_irq because the .set_type() should
1151 * always be invoked and set the right type of handler.
1152 */
1153 irq_domain_set_info(d,
1154 irq,
1155 hwirq,
1156 gc->irq.chip,
1157 gc,
1158 girq->handler,
1159 NULL, NULL);
1160 irq_set_probe(irq);
1161
David Brazdil0f672f62019-12-10 10:32:29 +00001162 /* This parent only handles asserted level IRQs */
Olivier Deprez157378f2022-04-04 15:47:50 +02001163 parent_arg = girq->populate_parent_alloc_arg(gc, parent_hwirq, parent_type);
1164 if (!parent_arg)
1165 return -ENOMEM;
1166
1167 chip_dbg(gc, "alloc_irqs_parent for %d parent hwirq %d\n",
David Brazdil0f672f62019-12-10 10:32:29 +00001168 irq, parent_hwirq);
Olivier Deprez0e641232021-09-23 10:07:05 +02001169 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
Olivier Deprez157378f2022-04-04 15:47:50 +02001170 ret = irq_domain_alloc_irqs_parent(d, irq, 1, parent_arg);
1171 /*
1172 * If the parent irqdomain is msi, the interrupts have already
1173 * been allocated, so the EEXIST is good.
1174 */
1175 if (irq_domain_is_msi(d->parent) && (ret == -EEXIST))
1176 ret = 0;
David Brazdil0f672f62019-12-10 10:32:29 +00001177 if (ret)
1178 chip_err(gc,
1179 "failed to allocate parent hwirq %d for hwirq %lu\n",
1180 parent_hwirq, hwirq);
1181
Olivier Deprez157378f2022-04-04 15:47:50 +02001182 kfree(parent_arg);
David Brazdil0f672f62019-12-10 10:32:29 +00001183 return ret;
1184}
1185
Olivier Deprez157378f2022-04-04 15:47:50 +02001186static unsigned int gpiochip_child_offset_to_irq_noop(struct gpio_chip *gc,
David Brazdil0f672f62019-12-10 10:32:29 +00001187 unsigned int offset)
1188{
1189 return offset;
1190}
1191
1192static void gpiochip_hierarchy_setup_domain_ops(struct irq_domain_ops *ops)
1193{
1194 ops->activate = gpiochip_irq_domain_activate;
1195 ops->deactivate = gpiochip_irq_domain_deactivate;
1196 ops->alloc = gpiochip_hierarchy_irq_domain_alloc;
1197 ops->free = irq_domain_free_irqs_common;
1198
1199 /*
1200 * We only allow overriding the translate() function for
1201 * hierarchical chips, and this should only be done if the user
1202 * really need something other than 1:1 translation.
1203 */
1204 if (!ops->translate)
1205 ops->translate = gpiochip_hierarchy_irq_domain_translate;
1206}
1207
1208static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1209{
1210 if (!gc->irq.child_to_parent_hwirq ||
1211 !gc->irq.fwnode) {
1212 chip_err(gc, "missing irqdomain vital data\n");
1213 return -EINVAL;
1214 }
1215
1216 if (!gc->irq.child_offset_to_irq)
1217 gc->irq.child_offset_to_irq = gpiochip_child_offset_to_irq_noop;
1218
Olivier Deprez157378f2022-04-04 15:47:50 +02001219 if (!gc->irq.populate_parent_alloc_arg)
1220 gc->irq.populate_parent_alloc_arg =
David Brazdil0f672f62019-12-10 10:32:29 +00001221 gpiochip_populate_parent_fwspec_twocell;
1222
1223 gpiochip_hierarchy_setup_domain_ops(&gc->irq.child_irq_domain_ops);
1224
1225 gc->irq.domain = irq_domain_create_hierarchy(
1226 gc->irq.parent_domain,
1227 0,
1228 gc->ngpio,
1229 gc->irq.fwnode,
1230 &gc->irq.child_irq_domain_ops,
1231 gc);
1232
1233 if (!gc->irq.domain)
1234 return -ENOMEM;
1235
1236 gpiochip_set_hierarchical_irqchip(gc, gc->irq.chip);
1237
1238 return 0;
1239}
1240
1241static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1242{
1243 return !!gc->irq.parent_domain;
1244}
1245
Olivier Deprez157378f2022-04-04 15:47:50 +02001246void *gpiochip_populate_parent_fwspec_twocell(struct gpio_chip *gc,
David Brazdil0f672f62019-12-10 10:32:29 +00001247 unsigned int parent_hwirq,
1248 unsigned int parent_type)
1249{
Olivier Deprez157378f2022-04-04 15:47:50 +02001250 struct irq_fwspec *fwspec;
1251
1252 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1253 if (!fwspec)
1254 return NULL;
1255
1256 fwspec->fwnode = gc->irq.parent_domain->fwnode;
David Brazdil0f672f62019-12-10 10:32:29 +00001257 fwspec->param_count = 2;
1258 fwspec->param[0] = parent_hwirq;
1259 fwspec->param[1] = parent_type;
Olivier Deprez157378f2022-04-04 15:47:50 +02001260
1261 return fwspec;
David Brazdil0f672f62019-12-10 10:32:29 +00001262}
1263EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_twocell);
1264
Olivier Deprez157378f2022-04-04 15:47:50 +02001265void *gpiochip_populate_parent_fwspec_fourcell(struct gpio_chip *gc,
David Brazdil0f672f62019-12-10 10:32:29 +00001266 unsigned int parent_hwirq,
1267 unsigned int parent_type)
1268{
Olivier Deprez157378f2022-04-04 15:47:50 +02001269 struct irq_fwspec *fwspec;
1270
1271 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1272 if (!fwspec)
1273 return NULL;
1274
1275 fwspec->fwnode = gc->irq.parent_domain->fwnode;
David Brazdil0f672f62019-12-10 10:32:29 +00001276 fwspec->param_count = 4;
1277 fwspec->param[0] = 0;
1278 fwspec->param[1] = parent_hwirq;
1279 fwspec->param[2] = 0;
1280 fwspec->param[3] = parent_type;
Olivier Deprez157378f2022-04-04 15:47:50 +02001281
1282 return fwspec;
David Brazdil0f672f62019-12-10 10:32:29 +00001283}
1284EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_fourcell);
1285
1286#else
1287
1288static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1289{
1290 return -EINVAL;
1291}
1292
1293static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1294{
1295 return false;
1296}
1297
1298#endif /* CONFIG_IRQ_DOMAIN_HIERARCHY */
1299
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001300/**
1301 * gpiochip_irq_map() - maps an IRQ into a GPIO irqchip
1302 * @d: the irqdomain used by this irqchip
1303 * @irq: the global irq number used by this GPIO irqchip irq
1304 * @hwirq: the local IRQ/GPIO line offset on this gpiochip
1305 *
1306 * This function will set up the mapping for a certain IRQ line on a
1307 * gpiochip by assigning the gpiochip as chip data, and using the irqchip
1308 * stored inside the gpiochip.
1309 */
1310int gpiochip_irq_map(struct irq_domain *d, unsigned int irq,
1311 irq_hw_number_t hwirq)
1312{
Olivier Deprez157378f2022-04-04 15:47:50 +02001313 struct gpio_chip *gc = d->host_data;
David Brazdil0f672f62019-12-10 10:32:29 +00001314 int ret = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001315
Olivier Deprez157378f2022-04-04 15:47:50 +02001316 if (!gpiochip_irqchip_irq_valid(gc, hwirq))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001317 return -ENXIO;
1318
Olivier Deprez157378f2022-04-04 15:47:50 +02001319 irq_set_chip_data(irq, gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001320 /*
1321 * This lock class tells lockdep that GPIO irqs are in a different
1322 * category than their parents, so it won't report false recursion.
1323 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001324 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
1325 irq_set_chip_and_handler(irq, gc->irq.chip, gc->irq.handler);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001326 /* Chips that use nested thread handlers have them marked */
Olivier Deprez157378f2022-04-04 15:47:50 +02001327 if (gc->irq.threaded)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001328 irq_set_nested_thread(irq, 1);
1329 irq_set_noprobe(irq);
1330
Olivier Deprez157378f2022-04-04 15:47:50 +02001331 if (gc->irq.num_parents == 1)
1332 ret = irq_set_parent(irq, gc->irq.parents[0]);
1333 else if (gc->irq.map)
1334 ret = irq_set_parent(irq, gc->irq.map[hwirq]);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001335
David Brazdil0f672f62019-12-10 10:32:29 +00001336 if (ret < 0)
1337 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001338
1339 /*
1340 * No set-up of the hardware will happen if IRQ_TYPE_NONE
1341 * is passed as default type.
1342 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001343 if (gc->irq.default_type != IRQ_TYPE_NONE)
1344 irq_set_irq_type(irq, gc->irq.default_type);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001345
1346 return 0;
1347}
1348EXPORT_SYMBOL_GPL(gpiochip_irq_map);
1349
1350void gpiochip_irq_unmap(struct irq_domain *d, unsigned int irq)
1351{
Olivier Deprez157378f2022-04-04 15:47:50 +02001352 struct gpio_chip *gc = d->host_data;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001353
Olivier Deprez157378f2022-04-04 15:47:50 +02001354 if (gc->irq.threaded)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001355 irq_set_nested_thread(irq, 0);
1356 irq_set_chip_and_handler(irq, NULL, NULL);
1357 irq_set_chip_data(irq, NULL);
1358}
1359EXPORT_SYMBOL_GPL(gpiochip_irq_unmap);
1360
1361static const struct irq_domain_ops gpiochip_domain_ops = {
1362 .map = gpiochip_irq_map,
1363 .unmap = gpiochip_irq_unmap,
1364 /* Virtually all GPIO irqchips are twocell:ed */
1365 .xlate = irq_domain_xlate_twocell,
1366};
1367
David Brazdil0f672f62019-12-10 10:32:29 +00001368/*
1369 * TODO: move these activate/deactivate in under the hierarchicial
1370 * irqchip implementation as static once SPMI and SSBI (all external
1371 * users) are phased over.
1372 */
1373/**
1374 * gpiochip_irq_domain_activate() - Lock a GPIO to be used as an IRQ
1375 * @domain: The IRQ domain used by this IRQ chip
1376 * @data: Outermost irq_data associated with the IRQ
1377 * @reserve: If set, only reserve an interrupt vector instead of assigning one
1378 *
1379 * This function is a wrapper that calls gpiochip_lock_as_irq() and is to be
1380 * used as the activate function for the &struct irq_domain_ops. The host_data
1381 * for the IRQ domain must be the &struct gpio_chip.
1382 */
1383int gpiochip_irq_domain_activate(struct irq_domain *domain,
1384 struct irq_data *data, bool reserve)
1385{
Olivier Deprez157378f2022-04-04 15:47:50 +02001386 struct gpio_chip *gc = domain->host_data;
David Brazdil0f672f62019-12-10 10:32:29 +00001387
Olivier Deprez157378f2022-04-04 15:47:50 +02001388 return gpiochip_lock_as_irq(gc, data->hwirq);
David Brazdil0f672f62019-12-10 10:32:29 +00001389}
1390EXPORT_SYMBOL_GPL(gpiochip_irq_domain_activate);
1391
1392/**
1393 * gpiochip_irq_domain_deactivate() - Unlock a GPIO used as an IRQ
1394 * @domain: The IRQ domain used by this IRQ chip
1395 * @data: Outermost irq_data associated with the IRQ
1396 *
1397 * This function is a wrapper that will call gpiochip_unlock_as_irq() and is to
1398 * be used as the deactivate function for the &struct irq_domain_ops. The
1399 * host_data for the IRQ domain must be the &struct gpio_chip.
1400 */
1401void gpiochip_irq_domain_deactivate(struct irq_domain *domain,
1402 struct irq_data *data)
1403{
Olivier Deprez157378f2022-04-04 15:47:50 +02001404 struct gpio_chip *gc = domain->host_data;
David Brazdil0f672f62019-12-10 10:32:29 +00001405
Olivier Deprez157378f2022-04-04 15:47:50 +02001406 return gpiochip_unlock_as_irq(gc, data->hwirq);
David Brazdil0f672f62019-12-10 10:32:29 +00001407}
1408EXPORT_SYMBOL_GPL(gpiochip_irq_domain_deactivate);
1409
Olivier Deprez157378f2022-04-04 15:47:50 +02001410static int gpiochip_to_irq(struct gpio_chip *gc, unsigned offset)
David Brazdil0f672f62019-12-10 10:32:29 +00001411{
Olivier Deprez157378f2022-04-04 15:47:50 +02001412 struct irq_domain *domain = gc->irq.domain;
David Brazdil0f672f62019-12-10 10:32:29 +00001413
Olivier Deprez157378f2022-04-04 15:47:50 +02001414 if (!gpiochip_irqchip_irq_valid(gc, offset))
David Brazdil0f672f62019-12-10 10:32:29 +00001415 return -ENXIO;
1416
1417#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1418 if (irq_domain_is_hierarchy(domain)) {
1419 struct irq_fwspec spec;
1420
1421 spec.fwnode = domain->fwnode;
1422 spec.param_count = 2;
Olivier Deprez157378f2022-04-04 15:47:50 +02001423 spec.param[0] = gc->irq.child_offset_to_irq(gc, offset);
David Brazdil0f672f62019-12-10 10:32:29 +00001424 spec.param[1] = IRQ_TYPE_NONE;
1425
1426 return irq_create_fwspec_mapping(&spec);
1427 }
1428#endif
1429
1430 return irq_create_mapping(domain, offset);
1431}
1432
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001433static int gpiochip_irq_reqres(struct irq_data *d)
1434{
Olivier Deprez157378f2022-04-04 15:47:50 +02001435 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001436
Olivier Deprez157378f2022-04-04 15:47:50 +02001437 return gpiochip_reqres_irq(gc, d->hwirq);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001438}
1439
1440static void gpiochip_irq_relres(struct irq_data *d)
1441{
Olivier Deprez157378f2022-04-04 15:47:50 +02001442 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001443
Olivier Deprez157378f2022-04-04 15:47:50 +02001444 gpiochip_relres_irq(gc, d->hwirq);
1445}
1446
1447static void gpiochip_irq_mask(struct irq_data *d)
1448{
1449 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1450
1451 if (gc->irq.irq_mask)
1452 gc->irq.irq_mask(d);
1453 gpiochip_disable_irq(gc, d->hwirq);
1454}
1455
1456static void gpiochip_irq_unmask(struct irq_data *d)
1457{
1458 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1459
1460 gpiochip_enable_irq(gc, d->hwirq);
1461 if (gc->irq.irq_unmask)
1462 gc->irq.irq_unmask(d);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001463}
1464
David Brazdil0f672f62019-12-10 10:32:29 +00001465static void gpiochip_irq_enable(struct irq_data *d)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001466{
Olivier Deprez157378f2022-04-04 15:47:50 +02001467 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001468
Olivier Deprez157378f2022-04-04 15:47:50 +02001469 gpiochip_enable_irq(gc, d->hwirq);
1470 gc->irq.irq_enable(d);
David Brazdil0f672f62019-12-10 10:32:29 +00001471}
1472
1473static void gpiochip_irq_disable(struct irq_data *d)
1474{
Olivier Deprez157378f2022-04-04 15:47:50 +02001475 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
David Brazdil0f672f62019-12-10 10:32:29 +00001476
Olivier Deprez157378f2022-04-04 15:47:50 +02001477 gc->irq.irq_disable(d);
1478 gpiochip_disable_irq(gc, d->hwirq);
David Brazdil0f672f62019-12-10 10:32:29 +00001479}
1480
Olivier Deprez157378f2022-04-04 15:47:50 +02001481static void gpiochip_set_irq_hooks(struct gpio_chip *gc)
David Brazdil0f672f62019-12-10 10:32:29 +00001482{
Olivier Deprez157378f2022-04-04 15:47:50 +02001483 struct irq_chip *irqchip = gc->irq.chip;
David Brazdil0f672f62019-12-10 10:32:29 +00001484
1485 if (!irqchip->irq_request_resources &&
1486 !irqchip->irq_release_resources) {
1487 irqchip->irq_request_resources = gpiochip_irq_reqres;
1488 irqchip->irq_release_resources = gpiochip_irq_relres;
1489 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001490 if (WARN_ON(gc->irq.irq_enable))
David Brazdil0f672f62019-12-10 10:32:29 +00001491 return;
1492 /* Check if the irqchip already has this hook... */
Olivier Deprez157378f2022-04-04 15:47:50 +02001493 if (irqchip->irq_enable == gpiochip_irq_enable ||
1494 irqchip->irq_mask == gpiochip_irq_mask) {
David Brazdil0f672f62019-12-10 10:32:29 +00001495 /*
1496 * ...and if so, give a gentle warning that this is bad
1497 * practice.
1498 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001499 chip_info(gc,
David Brazdil0f672f62019-12-10 10:32:29 +00001500 "detected irqchip that is shared with multiple gpiochips: please fix the driver.\n");
1501 return;
1502 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001503
1504 if (irqchip->irq_disable) {
1505 gc->irq.irq_disable = irqchip->irq_disable;
1506 irqchip->irq_disable = gpiochip_irq_disable;
1507 } else {
1508 gc->irq.irq_mask = irqchip->irq_mask;
1509 irqchip->irq_mask = gpiochip_irq_mask;
1510 }
1511
1512 if (irqchip->irq_enable) {
1513 gc->irq.irq_enable = irqchip->irq_enable;
1514 irqchip->irq_enable = gpiochip_irq_enable;
1515 } else {
1516 gc->irq.irq_unmask = irqchip->irq_unmask;
1517 irqchip->irq_unmask = gpiochip_irq_unmask;
1518 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001519}
1520
1521/**
1522 * gpiochip_add_irqchip() - adds an IRQ chip to a GPIO chip
Olivier Deprez157378f2022-04-04 15:47:50 +02001523 * @gc: the GPIO chip to add the IRQ chip to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001524 * @lock_key: lockdep class for IRQ lock
1525 * @request_key: lockdep class for IRQ request
1526 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001527static int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001528 struct lock_class_key *lock_key,
1529 struct lock_class_key *request_key)
1530{
Olivier Deprez157378f2022-04-04 15:47:50 +02001531 struct irq_chip *irqchip = gc->irq.chip;
David Brazdil0f672f62019-12-10 10:32:29 +00001532 const struct irq_domain_ops *ops = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001533 struct device_node *np;
1534 unsigned int type;
1535 unsigned int i;
1536
1537 if (!irqchip)
1538 return 0;
1539
Olivier Deprez157378f2022-04-04 15:47:50 +02001540 if (gc->irq.parent_handler && gc->can_sleep) {
1541 chip_err(gc, "you cannot have chained interrupts on a chip that may sleep\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001542 return -EINVAL;
1543 }
1544
Olivier Deprez157378f2022-04-04 15:47:50 +02001545 np = gc->gpiodev->dev.of_node;
1546 type = gc->irq.default_type;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001547
1548 /*
1549 * Specifying a default trigger is a terrible idea if DT or ACPI is
1550 * used to configure the interrupts, as you may end up with
1551 * conflicting triggers. Tell the user, and reset to NONE.
1552 */
1553 if (WARN(np && type != IRQ_TYPE_NONE,
1554 "%s: Ignoring %u default trigger\n", np->full_name, type))
1555 type = IRQ_TYPE_NONE;
1556
Olivier Deprez157378f2022-04-04 15:47:50 +02001557 if (has_acpi_companion(gc->parent) && type != IRQ_TYPE_NONE) {
1558 acpi_handle_warn(ACPI_HANDLE(gc->parent),
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001559 "Ignoring %u default trigger\n", type);
1560 type = IRQ_TYPE_NONE;
1561 }
1562
Olivier Deprez157378f2022-04-04 15:47:50 +02001563 gc->to_irq = gpiochip_to_irq;
1564 gc->irq.default_type = type;
1565 gc->irq.lock_key = lock_key;
1566 gc->irq.request_key = request_key;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001567
David Brazdil0f672f62019-12-10 10:32:29 +00001568 /* If a parent irqdomain is provided, let's build a hierarchy */
Olivier Deprez157378f2022-04-04 15:47:50 +02001569 if (gpiochip_hierarchy_is_hierarchical(gc)) {
1570 int ret = gpiochip_hierarchy_add_domain(gc);
David Brazdil0f672f62019-12-10 10:32:29 +00001571 if (ret)
1572 return ret;
1573 } else {
1574 /* Some drivers provide custom irqdomain ops */
Olivier Deprez157378f2022-04-04 15:47:50 +02001575 if (gc->irq.domain_ops)
1576 ops = gc->irq.domain_ops;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001577
David Brazdil0f672f62019-12-10 10:32:29 +00001578 if (!ops)
1579 ops = &gpiochip_domain_ops;
Olivier Deprez157378f2022-04-04 15:47:50 +02001580 gc->irq.domain = irq_domain_add_simple(np,
1581 gc->ngpio,
1582 gc->irq.first,
1583 ops, gc);
1584 if (!gc->irq.domain)
David Brazdil0f672f62019-12-10 10:32:29 +00001585 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001586 }
1587
Olivier Deprez157378f2022-04-04 15:47:50 +02001588 if (gc->irq.parent_handler) {
1589 void *data = gc->irq.parent_handler_data ?: gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001590
Olivier Deprez157378f2022-04-04 15:47:50 +02001591 for (i = 0; i < gc->irq.num_parents; i++) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001592 /*
1593 * The parent IRQ chip is already using the chip_data
1594 * for this IRQ chip, so our callbacks simply use the
1595 * handler_data.
1596 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001597 irq_set_chained_handler_and_data(gc->irq.parents[i],
1598 gc->irq.parent_handler,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001599 data);
1600 }
1601 }
1602
Olivier Deprez157378f2022-04-04 15:47:50 +02001603 gpiochip_set_irq_hooks(gc);
David Brazdil0f672f62019-12-10 10:32:29 +00001604
Olivier Deprez157378f2022-04-04 15:47:50 +02001605 acpi_gpiochip_request_interrupts(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001606
1607 return 0;
1608}
1609
1610/**
1611 * gpiochip_irqchip_remove() - removes an irqchip added to a gpiochip
Olivier Deprez157378f2022-04-04 15:47:50 +02001612 * @gc: the gpiochip to remove the irqchip from
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001613 *
1614 * This is called only from gpiochip_remove()
1615 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001616static void gpiochip_irqchip_remove(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001617{
Olivier Deprez157378f2022-04-04 15:47:50 +02001618 struct irq_chip *irqchip = gc->irq.chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001619 unsigned int offset;
1620
Olivier Deprez157378f2022-04-04 15:47:50 +02001621 acpi_gpiochip_free_interrupts(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001622
Olivier Deprez157378f2022-04-04 15:47:50 +02001623 if (irqchip && gc->irq.parent_handler) {
1624 struct gpio_irq_chip *irq = &gc->irq;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001625 unsigned int i;
1626
1627 for (i = 0; i < irq->num_parents; i++)
1628 irq_set_chained_handler_and_data(irq->parents[i],
1629 NULL, NULL);
1630 }
1631
1632 /* Remove all IRQ mappings and delete the domain */
Olivier Deprez157378f2022-04-04 15:47:50 +02001633 if (gc->irq.domain) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001634 unsigned int irq;
1635
Olivier Deprez157378f2022-04-04 15:47:50 +02001636 for (offset = 0; offset < gc->ngpio; offset++) {
1637 if (!gpiochip_irqchip_irq_valid(gc, offset))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001638 continue;
1639
Olivier Deprez157378f2022-04-04 15:47:50 +02001640 irq = irq_find_mapping(gc->irq.domain, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001641 irq_dispose_mapping(irq);
1642 }
1643
Olivier Deprez157378f2022-04-04 15:47:50 +02001644 irq_domain_remove(gc->irq.domain);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001645 }
1646
David Brazdil0f672f62019-12-10 10:32:29 +00001647 if (irqchip) {
1648 if (irqchip->irq_request_resources == gpiochip_irq_reqres) {
1649 irqchip->irq_request_resources = NULL;
1650 irqchip->irq_release_resources = NULL;
1651 }
1652 if (irqchip->irq_enable == gpiochip_irq_enable) {
Olivier Deprez157378f2022-04-04 15:47:50 +02001653 irqchip->irq_enable = gc->irq.irq_enable;
1654 irqchip->irq_disable = gc->irq.irq_disable;
David Brazdil0f672f62019-12-10 10:32:29 +00001655 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001656 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001657 gc->irq.irq_enable = NULL;
1658 gc->irq.irq_disable = NULL;
1659 gc->irq.chip = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001660
Olivier Deprez157378f2022-04-04 15:47:50 +02001661 gpiochip_irqchip_free_valid_mask(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001662}
1663
1664/**
1665 * gpiochip_irqchip_add_key() - adds an irqchip to a gpiochip
Olivier Deprez157378f2022-04-04 15:47:50 +02001666 * @gc: the gpiochip to add the irqchip to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001667 * @irqchip: the irqchip to add to the gpiochip
1668 * @first_irq: if not dynamically assigned, the base (first) IRQ to
1669 * allocate gpiochip irqs from
1670 * @handler: the irq handler to use (often a predefined irq core function)
1671 * @type: the default type for IRQs on this irqchip, pass IRQ_TYPE_NONE
1672 * to have the core avoid setting up any default type in the hardware.
1673 * @threaded: whether this irqchip uses a nested thread handler
1674 * @lock_key: lockdep class for IRQ lock
1675 * @request_key: lockdep class for IRQ request
1676 *
1677 * This function closely associates a certain irqchip with a certain
1678 * gpiochip, providing an irq domain to translate the local IRQs to
1679 * global irqs in the gpiolib core, and making sure that the gpiochip
1680 * is passed as chip data to all related functions. Driver callbacks
1681 * need to use gpiochip_get_data() to get their local state containers back
1682 * from the gpiochip passed as chip data. An irqdomain will be stored
1683 * in the gpiochip that shall be used by the driver to handle IRQ number
1684 * translation. The gpiochip will need to be initialized and registered
1685 * before calling this function.
1686 *
1687 * This function will handle two cell:ed simple IRQs and assumes all
1688 * the pins on the gpiochip can generate a unique IRQ. Everything else
1689 * need to be open coded.
1690 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001691int gpiochip_irqchip_add_key(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001692 struct irq_chip *irqchip,
1693 unsigned int first_irq,
1694 irq_flow_handler_t handler,
1695 unsigned int type,
1696 bool threaded,
1697 struct lock_class_key *lock_key,
1698 struct lock_class_key *request_key)
1699{
1700 struct device_node *of_node;
1701
Olivier Deprez157378f2022-04-04 15:47:50 +02001702 if (!gc || !irqchip)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001703 return -EINVAL;
1704
Olivier Deprez157378f2022-04-04 15:47:50 +02001705 if (!gc->parent) {
1706 chip_err(gc, "missing gpiochip .dev parent pointer\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001707 return -EINVAL;
1708 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001709 gc->irq.threaded = threaded;
1710 of_node = gc->parent->of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001711#ifdef CONFIG_OF_GPIO
1712 /*
1713 * If the gpiochip has an assigned OF node this takes precedence
Olivier Deprez157378f2022-04-04 15:47:50 +02001714 * FIXME: get rid of this and use gc->parent->of_node
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001715 * everywhere
1716 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001717 if (gc->of_node)
1718 of_node = gc->of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001719#endif
1720 /*
1721 * Specifying a default trigger is a terrible idea if DT or ACPI is
1722 * used to configure the interrupts, as you may end-up with
1723 * conflicting triggers. Tell the user, and reset to NONE.
1724 */
1725 if (WARN(of_node && type != IRQ_TYPE_NONE,
1726 "%pOF: Ignoring %d default trigger\n", of_node, type))
1727 type = IRQ_TYPE_NONE;
Olivier Deprez157378f2022-04-04 15:47:50 +02001728 if (has_acpi_companion(gc->parent) && type != IRQ_TYPE_NONE) {
1729 acpi_handle_warn(ACPI_HANDLE(gc->parent),
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001730 "Ignoring %d default trigger\n", type);
1731 type = IRQ_TYPE_NONE;
1732 }
1733
Olivier Deprez157378f2022-04-04 15:47:50 +02001734 gc->irq.chip = irqchip;
1735 gc->irq.handler = handler;
1736 gc->irq.default_type = type;
1737 gc->to_irq = gpiochip_to_irq;
1738 gc->irq.lock_key = lock_key;
1739 gc->irq.request_key = request_key;
1740 gc->irq.domain = irq_domain_add_simple(of_node,
1741 gc->ngpio, first_irq,
1742 &gpiochip_domain_ops, gc);
1743 if (!gc->irq.domain) {
1744 gc->irq.chip = NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001745 return -EINVAL;
1746 }
1747
Olivier Deprez157378f2022-04-04 15:47:50 +02001748 gpiochip_set_irq_hooks(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001749
Olivier Deprez157378f2022-04-04 15:47:50 +02001750 acpi_gpiochip_request_interrupts(gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001751
1752 return 0;
1753}
1754EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_key);
1755
Olivier Deprez157378f2022-04-04 15:47:50 +02001756/**
1757 * gpiochip_irqchip_add_domain() - adds an irqdomain to a gpiochip
1758 * @gc: the gpiochip to add the irqchip to
1759 * @domain: the irqdomain to add to the gpiochip
1760 *
1761 * This function adds an IRQ domain to the gpiochip.
1762 */
1763int gpiochip_irqchip_add_domain(struct gpio_chip *gc,
1764 struct irq_domain *domain)
1765{
1766 if (!domain)
1767 return -EINVAL;
1768
1769 gc->to_irq = gpiochip_to_irq;
1770 gc->irq.domain = domain;
1771
1772 return 0;
1773}
1774EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_domain);
1775
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001776#else /* CONFIG_GPIOLIB_IRQCHIP */
1777
Olivier Deprez157378f2022-04-04 15:47:50 +02001778static inline int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001779 struct lock_class_key *lock_key,
1780 struct lock_class_key *request_key)
1781{
1782 return 0;
1783}
Olivier Deprez157378f2022-04-04 15:47:50 +02001784static void gpiochip_irqchip_remove(struct gpio_chip *gc) {}
David Brazdil0f672f62019-12-10 10:32:29 +00001785
Olivier Deprez157378f2022-04-04 15:47:50 +02001786static inline int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
David Brazdil0f672f62019-12-10 10:32:29 +00001787{
1788 return 0;
1789}
1790
Olivier Deprez157378f2022-04-04 15:47:50 +02001791static inline int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001792{
1793 return 0;
1794}
Olivier Deprez157378f2022-04-04 15:47:50 +02001795static inline void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001796{ }
1797
1798#endif /* CONFIG_GPIOLIB_IRQCHIP */
1799
1800/**
1801 * gpiochip_generic_request() - request the gpio function for a pin
Olivier Deprez157378f2022-04-04 15:47:50 +02001802 * @gc: the gpiochip owning the GPIO
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001803 * @offset: the offset of the GPIO to request for GPIO function
1804 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001805int gpiochip_generic_request(struct gpio_chip *gc, unsigned offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001806{
Olivier Deprez157378f2022-04-04 15:47:50 +02001807#ifdef CONFIG_PINCTRL
1808 if (list_empty(&gc->gpiodev->pin_ranges))
1809 return 0;
1810#endif
1811
1812 return pinctrl_gpio_request(gc->gpiodev->base + offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001813}
1814EXPORT_SYMBOL_GPL(gpiochip_generic_request);
1815
1816/**
1817 * gpiochip_generic_free() - free the gpio function from a pin
Olivier Deprez157378f2022-04-04 15:47:50 +02001818 * @gc: the gpiochip to request the gpio function for
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001819 * @offset: the offset of the GPIO to free from GPIO function
1820 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001821void gpiochip_generic_free(struct gpio_chip *gc, unsigned offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001822{
Olivier Deprez157378f2022-04-04 15:47:50 +02001823#ifdef CONFIG_PINCTRL
1824 if (list_empty(&gc->gpiodev->pin_ranges))
1825 return;
1826#endif
1827
1828 pinctrl_gpio_free(gc->gpiodev->base + offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001829}
1830EXPORT_SYMBOL_GPL(gpiochip_generic_free);
1831
1832/**
1833 * gpiochip_generic_config() - apply configuration for a pin
Olivier Deprez157378f2022-04-04 15:47:50 +02001834 * @gc: the gpiochip owning the GPIO
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001835 * @offset: the offset of the GPIO to apply the configuration
1836 * @config: the configuration to be applied
1837 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001838int gpiochip_generic_config(struct gpio_chip *gc, unsigned offset,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001839 unsigned long config)
1840{
Olivier Deprez157378f2022-04-04 15:47:50 +02001841 return pinctrl_gpio_set_config(gc->gpiodev->base + offset, config);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001842}
1843EXPORT_SYMBOL_GPL(gpiochip_generic_config);
1844
1845#ifdef CONFIG_PINCTRL
1846
1847/**
1848 * gpiochip_add_pingroup_range() - add a range for GPIO <-> pin mapping
Olivier Deprez157378f2022-04-04 15:47:50 +02001849 * @gc: the gpiochip to add the range for
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001850 * @pctldev: the pin controller to map to
1851 * @gpio_offset: the start offset in the current gpio_chip number space
1852 * @pin_group: name of the pin group inside the pin controller
1853 *
1854 * Calling this function directly from a DeviceTree-supported
1855 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1856 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1857 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
1858 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001859int gpiochip_add_pingroup_range(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001860 struct pinctrl_dev *pctldev,
1861 unsigned int gpio_offset, const char *pin_group)
1862{
1863 struct gpio_pin_range *pin_range;
Olivier Deprez157378f2022-04-04 15:47:50 +02001864 struct gpio_device *gdev = gc->gpiodev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001865 int ret;
1866
1867 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1868 if (!pin_range) {
Olivier Deprez157378f2022-04-04 15:47:50 +02001869 chip_err(gc, "failed to allocate pin ranges\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001870 return -ENOMEM;
1871 }
1872
1873 /* Use local offset as range ID */
1874 pin_range->range.id = gpio_offset;
Olivier Deprez157378f2022-04-04 15:47:50 +02001875 pin_range->range.gc = gc;
1876 pin_range->range.name = gc->label;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001877 pin_range->range.base = gdev->base + gpio_offset;
1878 pin_range->pctldev = pctldev;
1879
1880 ret = pinctrl_get_group_pins(pctldev, pin_group,
1881 &pin_range->range.pins,
1882 &pin_range->range.npins);
1883 if (ret < 0) {
1884 kfree(pin_range);
1885 return ret;
1886 }
1887
1888 pinctrl_add_gpio_range(pctldev, &pin_range->range);
1889
Olivier Deprez157378f2022-04-04 15:47:50 +02001890 chip_dbg(gc, "created GPIO range %d->%d ==> %s PINGRP %s\n",
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001891 gpio_offset, gpio_offset + pin_range->range.npins - 1,
1892 pinctrl_dev_get_devname(pctldev), pin_group);
1893
1894 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1895
1896 return 0;
1897}
1898EXPORT_SYMBOL_GPL(gpiochip_add_pingroup_range);
1899
1900/**
1901 * gpiochip_add_pin_range() - add a range for GPIO <-> pin mapping
Olivier Deprez157378f2022-04-04 15:47:50 +02001902 * @gc: the gpiochip to add the range for
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001903 * @pinctl_name: the dev_name() of the pin controller to map to
1904 * @gpio_offset: the start offset in the current gpio_chip number space
1905 * @pin_offset: the start offset in the pin controller number space
1906 * @npins: the number of pins from the offset of each pin space (GPIO and
1907 * pin controller) to accumulate in this range
1908 *
1909 * Returns:
1910 * 0 on success, or a negative error-code on failure.
1911 *
1912 * Calling this function directly from a DeviceTree-supported
1913 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1914 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1915 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
1916 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001917int gpiochip_add_pin_range(struct gpio_chip *gc, const char *pinctl_name,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001918 unsigned int gpio_offset, unsigned int pin_offset,
1919 unsigned int npins)
1920{
1921 struct gpio_pin_range *pin_range;
Olivier Deprez157378f2022-04-04 15:47:50 +02001922 struct gpio_device *gdev = gc->gpiodev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001923 int ret;
1924
1925 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1926 if (!pin_range) {
Olivier Deprez157378f2022-04-04 15:47:50 +02001927 chip_err(gc, "failed to allocate pin ranges\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001928 return -ENOMEM;
1929 }
1930
1931 /* Use local offset as range ID */
1932 pin_range->range.id = gpio_offset;
Olivier Deprez157378f2022-04-04 15:47:50 +02001933 pin_range->range.gc = gc;
1934 pin_range->range.name = gc->label;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001935 pin_range->range.base = gdev->base + gpio_offset;
1936 pin_range->range.pin_base = pin_offset;
1937 pin_range->range.npins = npins;
1938 pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
1939 &pin_range->range);
1940 if (IS_ERR(pin_range->pctldev)) {
1941 ret = PTR_ERR(pin_range->pctldev);
Olivier Deprez157378f2022-04-04 15:47:50 +02001942 chip_err(gc, "could not create pin range\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001943 kfree(pin_range);
1944 return ret;
1945 }
Olivier Deprez157378f2022-04-04 15:47:50 +02001946 chip_dbg(gc, "created GPIO range %d->%d ==> %s PIN %d->%d\n",
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001947 gpio_offset, gpio_offset + npins - 1,
1948 pinctl_name,
1949 pin_offset, pin_offset + npins - 1);
1950
1951 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1952
1953 return 0;
1954}
1955EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
1956
1957/**
1958 * gpiochip_remove_pin_ranges() - remove all the GPIO <-> pin mappings
Olivier Deprez157378f2022-04-04 15:47:50 +02001959 * @gc: the chip to remove all the mappings for
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001960 */
Olivier Deprez157378f2022-04-04 15:47:50 +02001961void gpiochip_remove_pin_ranges(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001962{
1963 struct gpio_pin_range *pin_range, *tmp;
Olivier Deprez157378f2022-04-04 15:47:50 +02001964 struct gpio_device *gdev = gc->gpiodev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001965
1966 list_for_each_entry_safe(pin_range, tmp, &gdev->pin_ranges, node) {
1967 list_del(&pin_range->node);
1968 pinctrl_remove_gpio_range(pin_range->pctldev,
1969 &pin_range->range);
1970 kfree(pin_range);
1971 }
1972}
1973EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
1974
1975#endif /* CONFIG_PINCTRL */
1976
1977/* These "optional" allocation calls help prevent drivers from stomping
1978 * on each other, and help provide better diagnostics in debugfs.
1979 * They're called even less than the "set direction" calls.
1980 */
1981static int gpiod_request_commit(struct gpio_desc *desc, const char *label)
1982{
Olivier Deprez157378f2022-04-04 15:47:50 +02001983 struct gpio_chip *gc = desc->gdev->chip;
David Brazdil0f672f62019-12-10 10:32:29 +00001984 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001985 unsigned long flags;
1986 unsigned offset;
1987
David Brazdil0f672f62019-12-10 10:32:29 +00001988 if (label) {
1989 label = kstrdup_const(label, GFP_KERNEL);
1990 if (!label)
1991 return -ENOMEM;
1992 }
1993
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001994 spin_lock_irqsave(&gpio_lock, flags);
1995
1996 /* NOTE: gpio_request() can be called in early boot,
1997 * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
1998 */
1999
2000 if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
2001 desc_set_label(desc, label ? : "?");
David Brazdil0f672f62019-12-10 10:32:29 +00002002 ret = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002003 } else {
David Brazdil0f672f62019-12-10 10:32:29 +00002004 kfree_const(label);
2005 ret = -EBUSY;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002006 goto done;
2007 }
2008
Olivier Deprez157378f2022-04-04 15:47:50 +02002009 if (gc->request) {
2010 /* gc->request may sleep */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002011 spin_unlock_irqrestore(&gpio_lock, flags);
2012 offset = gpio_chip_hwgpio(desc);
Olivier Deprez157378f2022-04-04 15:47:50 +02002013 if (gpiochip_line_is_valid(gc, offset))
2014 ret = gc->request(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002015 else
David Brazdil0f672f62019-12-10 10:32:29 +00002016 ret = -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002017 spin_lock_irqsave(&gpio_lock, flags);
2018
David Brazdil0f672f62019-12-10 10:32:29 +00002019 if (ret < 0) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002020 desc_set_label(desc, NULL);
David Brazdil0f672f62019-12-10 10:32:29 +00002021 kfree_const(label);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002022 clear_bit(FLAG_REQUESTED, &desc->flags);
2023 goto done;
2024 }
2025 }
Olivier Deprez157378f2022-04-04 15:47:50 +02002026 if (gc->get_direction) {
2027 /* gc->get_direction may sleep */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002028 spin_unlock_irqrestore(&gpio_lock, flags);
2029 gpiod_get_direction(desc);
2030 spin_lock_irqsave(&gpio_lock, flags);
2031 }
2032done:
2033 spin_unlock_irqrestore(&gpio_lock, flags);
David Brazdil0f672f62019-12-10 10:32:29 +00002034 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002035}
2036
2037/*
2038 * This descriptor validation needs to be inserted verbatim into each
2039 * function taking a descriptor, so we need to use a preprocessor
2040 * macro to avoid endless duplication. If the desc is NULL it is an
2041 * optional GPIO and calls should just bail out.
2042 */
2043static int validate_desc(const struct gpio_desc *desc, const char *func)
2044{
2045 if (!desc)
2046 return 0;
2047 if (IS_ERR(desc)) {
2048 pr_warn("%s: invalid GPIO (errorpointer)\n", func);
2049 return PTR_ERR(desc);
2050 }
2051 if (!desc->gdev) {
2052 pr_warn("%s: invalid GPIO (no device)\n", func);
2053 return -EINVAL;
2054 }
2055 if (!desc->gdev->chip) {
2056 dev_warn(&desc->gdev->dev,
2057 "%s: backing chip is gone\n", func);
2058 return 0;
2059 }
2060 return 1;
2061}
2062
2063#define VALIDATE_DESC(desc) do { \
2064 int __valid = validate_desc(desc, __func__); \
2065 if (__valid <= 0) \
2066 return __valid; \
2067 } while (0)
2068
2069#define VALIDATE_DESC_VOID(desc) do { \
2070 int __valid = validate_desc(desc, __func__); \
2071 if (__valid <= 0) \
2072 return; \
2073 } while (0)
2074
2075int gpiod_request(struct gpio_desc *desc, const char *label)
2076{
David Brazdil0f672f62019-12-10 10:32:29 +00002077 int ret = -EPROBE_DEFER;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002078 struct gpio_device *gdev;
2079
2080 VALIDATE_DESC(desc);
2081 gdev = desc->gdev;
2082
2083 if (try_module_get(gdev->owner)) {
David Brazdil0f672f62019-12-10 10:32:29 +00002084 ret = gpiod_request_commit(desc, label);
2085 if (ret < 0)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002086 module_put(gdev->owner);
2087 else
2088 get_device(&gdev->dev);
2089 }
2090
David Brazdil0f672f62019-12-10 10:32:29 +00002091 if (ret)
2092 gpiod_dbg(desc, "%s: status %d\n", __func__, ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002093
David Brazdil0f672f62019-12-10 10:32:29 +00002094 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002095}
2096
2097static bool gpiod_free_commit(struct gpio_desc *desc)
2098{
2099 bool ret = false;
2100 unsigned long flags;
Olivier Deprez157378f2022-04-04 15:47:50 +02002101 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002102
2103 might_sleep();
2104
2105 gpiod_unexport(desc);
2106
2107 spin_lock_irqsave(&gpio_lock, flags);
2108
Olivier Deprez157378f2022-04-04 15:47:50 +02002109 gc = desc->gdev->chip;
2110 if (gc && test_bit(FLAG_REQUESTED, &desc->flags)) {
2111 if (gc->free) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002112 spin_unlock_irqrestore(&gpio_lock, flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02002113 might_sleep_if(gc->can_sleep);
2114 gc->free(gc, gpio_chip_hwgpio(desc));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002115 spin_lock_irqsave(&gpio_lock, flags);
2116 }
David Brazdil0f672f62019-12-10 10:32:29 +00002117 kfree_const(desc->label);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002118 desc_set_label(desc, NULL);
2119 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
2120 clear_bit(FLAG_REQUESTED, &desc->flags);
2121 clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
2122 clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02002123 clear_bit(FLAG_PULL_UP, &desc->flags);
2124 clear_bit(FLAG_PULL_DOWN, &desc->flags);
2125 clear_bit(FLAG_BIAS_DISABLE, &desc->flags);
2126 clear_bit(FLAG_EDGE_RISING, &desc->flags);
2127 clear_bit(FLAG_EDGE_FALLING, &desc->flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002128 clear_bit(FLAG_IS_HOGGED, &desc->flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02002129#ifdef CONFIG_OF_DYNAMIC
2130 desc->hog = NULL;
2131#endif
2132#ifdef CONFIG_GPIO_CDEV
2133 WRITE_ONCE(desc->debounce_period_us, 0);
2134#endif
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002135 ret = true;
2136 }
2137
2138 spin_unlock_irqrestore(&gpio_lock, flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02002139 blocking_notifier_call_chain(&desc->gdev->notifier,
2140 GPIOLINE_CHANGED_RELEASED, desc);
2141
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002142 return ret;
2143}
2144
2145void gpiod_free(struct gpio_desc *desc)
2146{
2147 if (desc && desc->gdev && gpiod_free_commit(desc)) {
2148 module_put(desc->gdev->owner);
2149 put_device(&desc->gdev->dev);
2150 } else {
2151 WARN_ON(extra_checks);
2152 }
2153}
2154
2155/**
2156 * gpiochip_is_requested - return string iff signal was requested
Olivier Deprez157378f2022-04-04 15:47:50 +02002157 * @gc: controller managing the signal
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002158 * @offset: of signal within controller's 0..(ngpio - 1) range
2159 *
2160 * Returns NULL if the GPIO is not currently requested, else a string.
2161 * The string returned is the label passed to gpio_request(); if none has been
2162 * passed it is a meaningless, non-NULL constant.
2163 *
2164 * This function is for use by GPIO controller drivers. The label can
2165 * help with diagnostics, and knowing that the signal is used as a GPIO
2166 * can help avoid accidentally multiplexing it to another controller.
2167 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002168const char *gpiochip_is_requested(struct gpio_chip *gc, unsigned offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002169{
2170 struct gpio_desc *desc;
2171
Olivier Deprez157378f2022-04-04 15:47:50 +02002172 if (offset >= gc->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002173 return NULL;
2174
Olivier Deprez157378f2022-04-04 15:47:50 +02002175 desc = gpiochip_get_desc(gc, offset);
2176 if (IS_ERR(desc))
2177 return NULL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002178
2179 if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
2180 return NULL;
2181 return desc->label;
2182}
2183EXPORT_SYMBOL_GPL(gpiochip_is_requested);
2184
2185/**
2186 * gpiochip_request_own_desc - Allow GPIO chip to request its own descriptor
Olivier Deprez157378f2022-04-04 15:47:50 +02002187 * @gc: GPIO chip
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002188 * @hwnum: hardware number of the GPIO for which to request the descriptor
2189 * @label: label for the GPIO
David Brazdil0f672f62019-12-10 10:32:29 +00002190 * @lflags: lookup flags for this GPIO or 0 if default, this can be used to
2191 * specify things like line inversion semantics with the machine flags
2192 * such as GPIO_OUT_LOW
2193 * @dflags: descriptor request flags for this GPIO or 0 if default, this
2194 * can be used to specify consumer semantics such as open drain
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002195 *
2196 * Function allows GPIO chip drivers to request and use their own GPIO
2197 * descriptors via gpiolib API. Difference to gpiod_request() is that this
2198 * function will not increase reference count of the GPIO chip module. This
2199 * allows the GPIO chip module to be unloaded as needed (we assume that the
2200 * GPIO chip driver handles freeing the GPIOs it has requested).
2201 *
2202 * Returns:
2203 * A pointer to the GPIO descriptor, or an ERR_PTR()-encoded negative error
2204 * code on failure.
2205 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002206struct gpio_desc *gpiochip_request_own_desc(struct gpio_chip *gc,
2207 unsigned int hwnum,
David Brazdil0f672f62019-12-10 10:32:29 +00002208 const char *label,
2209 enum gpio_lookup_flags lflags,
2210 enum gpiod_flags dflags)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002211{
Olivier Deprez157378f2022-04-04 15:47:50 +02002212 struct gpio_desc *desc = gpiochip_get_desc(gc, hwnum);
David Brazdil0f672f62019-12-10 10:32:29 +00002213 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002214
2215 if (IS_ERR(desc)) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002216 chip_err(gc, "failed to get GPIO descriptor\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002217 return desc;
2218 }
2219
David Brazdil0f672f62019-12-10 10:32:29 +00002220 ret = gpiod_request_commit(desc, label);
2221 if (ret < 0)
2222 return ERR_PTR(ret);
2223
2224 ret = gpiod_configure_flags(desc, label, lflags, dflags);
2225 if (ret) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002226 chip_err(gc, "setup of own GPIO %s failed\n", label);
David Brazdil0f672f62019-12-10 10:32:29 +00002227 gpiod_free_commit(desc);
2228 return ERR_PTR(ret);
2229 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002230
2231 return desc;
2232}
2233EXPORT_SYMBOL_GPL(gpiochip_request_own_desc);
2234
2235/**
2236 * gpiochip_free_own_desc - Free GPIO requested by the chip driver
2237 * @desc: GPIO descriptor to free
2238 *
2239 * Function frees the given GPIO requested previously with
2240 * gpiochip_request_own_desc().
2241 */
2242void gpiochip_free_own_desc(struct gpio_desc *desc)
2243{
2244 if (desc)
2245 gpiod_free_commit(desc);
2246}
2247EXPORT_SYMBOL_GPL(gpiochip_free_own_desc);
2248
2249/*
2250 * Drivers MUST set GPIO direction before making get/set calls. In
2251 * some cases this is done in early boot, before IRQs are enabled.
2252 *
2253 * As a rule these aren't called more than once (except for drivers
2254 * using the open-drain emulation idiom) so these are natural places
2255 * to accumulate extra debugging checks. Note that we can't (yet)
2256 * rely on gpio_request() having been called beforehand.
2257 */
2258
Olivier Deprez157378f2022-04-04 15:47:50 +02002259static int gpio_do_set_config(struct gpio_chip *gc, unsigned int offset,
2260 unsigned long config)
David Brazdil0f672f62019-12-10 10:32:29 +00002261{
Olivier Deprez157378f2022-04-04 15:47:50 +02002262 if (!gc->set_config)
2263 return -ENOTSUPP;
2264
2265 return gc->set_config(gc, offset, config);
2266}
2267
2268static int gpio_set_config(struct gpio_desc *desc, enum pin_config_param mode)
2269{
2270 struct gpio_chip *gc = desc->gdev->chip;
David Brazdil0f672f62019-12-10 10:32:29 +00002271 unsigned long config;
2272 unsigned arg;
2273
2274 switch (mode) {
2275 case PIN_CONFIG_BIAS_PULL_DOWN:
2276 case PIN_CONFIG_BIAS_PULL_UP:
2277 arg = 1;
2278 break;
2279
2280 default:
2281 arg = 0;
2282 }
2283
2284 config = PIN_CONF_PACKED(mode, arg);
Olivier Deprez157378f2022-04-04 15:47:50 +02002285 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
2286}
2287
2288static int gpio_set_bias(struct gpio_desc *desc)
2289{
2290 int bias = 0;
2291 int ret = 0;
2292
2293 if (test_bit(FLAG_BIAS_DISABLE, &desc->flags))
2294 bias = PIN_CONFIG_BIAS_DISABLE;
2295 else if (test_bit(FLAG_PULL_UP, &desc->flags))
2296 bias = PIN_CONFIG_BIAS_PULL_UP;
2297 else if (test_bit(FLAG_PULL_DOWN, &desc->flags))
2298 bias = PIN_CONFIG_BIAS_PULL_DOWN;
2299
2300 if (bias) {
2301 ret = gpio_set_config(desc, bias);
2302 if (ret != -ENOTSUPP)
2303 return ret;
2304 }
2305 return 0;
David Brazdil0f672f62019-12-10 10:32:29 +00002306}
2307
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002308/**
2309 * gpiod_direction_input - set the GPIO direction to input
2310 * @desc: GPIO to set to input
2311 *
2312 * Set the direction of the passed GPIO to input, such as gpiod_get_value() can
2313 * be called safely on it.
2314 *
2315 * Return 0 in case of success, else an error code.
2316 */
2317int gpiod_direction_input(struct gpio_desc *desc)
2318{
Olivier Deprez157378f2022-04-04 15:47:50 +02002319 struct gpio_chip *gc;
David Brazdil0f672f62019-12-10 10:32:29 +00002320 int ret = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002321
2322 VALIDATE_DESC(desc);
Olivier Deprez157378f2022-04-04 15:47:50 +02002323 gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002324
David Brazdil0f672f62019-12-10 10:32:29 +00002325 /*
2326 * It is legal to have no .get() and .direction_input() specified if
2327 * the chip is output-only, but you can't specify .direction_input()
2328 * and not support the .get() operation, that doesn't make sense.
2329 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002330 if (!gc->get && gc->direction_input) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002331 gpiod_warn(desc,
David Brazdil0f672f62019-12-10 10:32:29 +00002332 "%s: missing get() but have direction_input()\n",
2333 __func__);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002334 return -EIO;
2335 }
2336
David Brazdil0f672f62019-12-10 10:32:29 +00002337 /*
2338 * If we have a .direction_input() callback, things are simple,
2339 * just call it. Else we are some input-only chip so try to check the
2340 * direction (if .get_direction() is supported) else we silently
2341 * assume we are in input mode after this.
2342 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002343 if (gc->direction_input) {
2344 ret = gc->direction_input(gc, gpio_chip_hwgpio(desc));
2345 } else if (gc->get_direction &&
2346 (gc->get_direction(gc, gpio_chip_hwgpio(desc)) != 1)) {
David Brazdil0f672f62019-12-10 10:32:29 +00002347 gpiod_warn(desc,
2348 "%s: missing direction_input() operation and line is output\n",
2349 __func__);
2350 return -EIO;
2351 }
Olivier Deprez157378f2022-04-04 15:47:50 +02002352 if (ret == 0) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002353 clear_bit(FLAG_IS_OUT, &desc->flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02002354 ret = gpio_set_bias(desc);
2355 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002356
David Brazdil0f672f62019-12-10 10:32:29 +00002357 trace_gpio_direction(desc_to_gpio(desc), 1, ret);
2358
2359 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002360}
2361EXPORT_SYMBOL_GPL(gpiod_direction_input);
2362
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002363static int gpiod_direction_output_raw_commit(struct gpio_desc *desc, int value)
2364{
2365 struct gpio_chip *gc = desc->gdev->chip;
2366 int val = !!value;
David Brazdil0f672f62019-12-10 10:32:29 +00002367 int ret = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002368
David Brazdil0f672f62019-12-10 10:32:29 +00002369 /*
2370 * It's OK not to specify .direction_output() if the gpiochip is
2371 * output-only, but if there is then not even a .set() operation it
2372 * is pretty tricky to drive the output line.
2373 */
2374 if (!gc->set && !gc->direction_output) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002375 gpiod_warn(desc,
David Brazdil0f672f62019-12-10 10:32:29 +00002376 "%s: missing set() and direction_output() operations\n",
2377 __func__);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002378 return -EIO;
2379 }
2380
David Brazdil0f672f62019-12-10 10:32:29 +00002381 if (gc->direction_output) {
2382 ret = gc->direction_output(gc, gpio_chip_hwgpio(desc), val);
2383 } else {
2384 /* Check that we are in output mode if we can */
2385 if (gc->get_direction &&
2386 gc->get_direction(gc, gpio_chip_hwgpio(desc))) {
2387 gpiod_warn(desc,
2388 "%s: missing direction_output() operation\n",
2389 __func__);
2390 return -EIO;
2391 }
2392 /*
2393 * If we can't actively set the direction, we are some
2394 * output-only chip, so just drive the output as desired.
2395 */
2396 gc->set(gc, gpio_chip_hwgpio(desc), val);
2397 }
2398
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002399 if (!ret)
2400 set_bit(FLAG_IS_OUT, &desc->flags);
2401 trace_gpio_value(desc_to_gpio(desc), 0, val);
2402 trace_gpio_direction(desc_to_gpio(desc), 0, ret);
2403 return ret;
2404}
2405
2406/**
2407 * gpiod_direction_output_raw - set the GPIO direction to output
2408 * @desc: GPIO to set to output
2409 * @value: initial output value of the GPIO
2410 *
2411 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2412 * be called safely on it. The initial value of the output must be specified
2413 * as raw value on the physical line without regard for the ACTIVE_LOW status.
2414 *
2415 * Return 0 in case of success, else an error code.
2416 */
2417int gpiod_direction_output_raw(struct gpio_desc *desc, int value)
2418{
2419 VALIDATE_DESC(desc);
2420 return gpiod_direction_output_raw_commit(desc, value);
2421}
2422EXPORT_SYMBOL_GPL(gpiod_direction_output_raw);
2423
2424/**
2425 * gpiod_direction_output - set the GPIO direction to output
2426 * @desc: GPIO to set to output
2427 * @value: initial output value of the GPIO
2428 *
2429 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2430 * be called safely on it. The initial value of the output must be specified
2431 * as the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
2432 * account.
2433 *
2434 * Return 0 in case of success, else an error code.
2435 */
2436int gpiod_direction_output(struct gpio_desc *desc, int value)
2437{
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002438 int ret;
2439
2440 VALIDATE_DESC(desc);
2441 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2442 value = !value;
2443 else
2444 value = !!value;
2445
David Brazdil0f672f62019-12-10 10:32:29 +00002446 /* GPIOs used for enabled IRQs shall not be set as output */
2447 if (test_bit(FLAG_USED_AS_IRQ, &desc->flags) &&
2448 test_bit(FLAG_IRQ_IS_ENABLED, &desc->flags)) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002449 gpiod_err(desc,
2450 "%s: tried to set a GPIO tied to an IRQ as output\n",
2451 __func__);
2452 return -EIO;
2453 }
2454
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002455 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
2456 /* First see if we can enable open drain in hardware */
Olivier Deprez157378f2022-04-04 15:47:50 +02002457 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_DRAIN);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002458 if (!ret)
2459 goto set_output_value;
2460 /* Emulate open drain by not actively driving the line high */
David Brazdil0f672f62019-12-10 10:32:29 +00002461 if (value) {
2462 ret = gpiod_direction_input(desc);
2463 goto set_output_flag;
2464 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002465 }
2466 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002467 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_SOURCE);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002468 if (!ret)
2469 goto set_output_value;
2470 /* Emulate open source by not actively driving the line low */
David Brazdil0f672f62019-12-10 10:32:29 +00002471 if (!value) {
2472 ret = gpiod_direction_input(desc);
2473 goto set_output_flag;
2474 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002475 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +02002476 gpio_set_config(desc, PIN_CONFIG_DRIVE_PUSH_PULL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002477 }
2478
2479set_output_value:
Olivier Deprez157378f2022-04-04 15:47:50 +02002480 ret = gpio_set_bias(desc);
2481 if (ret)
2482 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002483 return gpiod_direction_output_raw_commit(desc, value);
David Brazdil0f672f62019-12-10 10:32:29 +00002484
2485set_output_flag:
2486 /*
2487 * When emulating open-source or open-drain functionalities by not
2488 * actively driving the line (setting mode to input) we still need to
2489 * set the IS_OUT flag or otherwise we won't be able to set the line
2490 * value anymore.
2491 */
2492 if (ret == 0)
2493 set_bit(FLAG_IS_OUT, &desc->flags);
2494 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002495}
2496EXPORT_SYMBOL_GPL(gpiod_direction_output);
2497
2498/**
Olivier Deprez157378f2022-04-04 15:47:50 +02002499 * gpiod_set_config - sets @config for a GPIO
2500 * @desc: descriptor of the GPIO for which to set the configuration
2501 * @config: Same packed config format as generic pinconf
2502 *
2503 * Returns:
2504 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2505 * configuration.
2506 */
2507int gpiod_set_config(struct gpio_desc *desc, unsigned long config)
2508{
2509 struct gpio_chip *gc;
2510
2511 VALIDATE_DESC(desc);
2512 gc = desc->gdev->chip;
2513
2514 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
2515}
2516EXPORT_SYMBOL_GPL(gpiod_set_config);
2517
2518/**
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002519 * gpiod_set_debounce - sets @debounce time for a GPIO
2520 * @desc: descriptor of the GPIO for which to set debounce time
2521 * @debounce: debounce time in microseconds
2522 *
2523 * Returns:
2524 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2525 * debounce time.
2526 */
2527int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce)
2528{
Olivier Deprez157378f2022-04-04 15:47:50 +02002529 unsigned long config;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002530
2531 config = pinconf_to_config_packed(PIN_CONFIG_INPUT_DEBOUNCE, debounce);
Olivier Deprez157378f2022-04-04 15:47:50 +02002532 return gpiod_set_config(desc, config);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002533}
2534EXPORT_SYMBOL_GPL(gpiod_set_debounce);
2535
2536/**
2537 * gpiod_set_transitory - Lose or retain GPIO state on suspend or reset
2538 * @desc: descriptor of the GPIO for which to configure persistence
2539 * @transitory: True to lose state on suspend or reset, false for persistence
2540 *
2541 * Returns:
2542 * 0 on success, otherwise a negative error code.
2543 */
2544int gpiod_set_transitory(struct gpio_desc *desc, bool transitory)
2545{
Olivier Deprez157378f2022-04-04 15:47:50 +02002546 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002547 unsigned long packed;
2548 int gpio;
2549 int rc;
2550
2551 VALIDATE_DESC(desc);
2552 /*
2553 * Handle FLAG_TRANSITORY first, enabling queries to gpiolib for
2554 * persistence state.
2555 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002556 assign_bit(FLAG_TRANSITORY, &desc->flags, transitory);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002557
2558 /* If the driver supports it, set the persistence state now */
Olivier Deprez157378f2022-04-04 15:47:50 +02002559 gc = desc->gdev->chip;
2560 if (!gc->set_config)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002561 return 0;
2562
2563 packed = pinconf_to_config_packed(PIN_CONFIG_PERSIST_STATE,
2564 !transitory);
2565 gpio = gpio_chip_hwgpio(desc);
Olivier Deprez157378f2022-04-04 15:47:50 +02002566 rc = gpio_do_set_config(gc, gpio, packed);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002567 if (rc == -ENOTSUPP) {
2568 dev_dbg(&desc->gdev->dev, "Persistence not supported for GPIO %d\n",
2569 gpio);
2570 return 0;
2571 }
2572
2573 return rc;
2574}
2575EXPORT_SYMBOL_GPL(gpiod_set_transitory);
2576
2577/**
2578 * gpiod_is_active_low - test whether a GPIO is active-low or not
2579 * @desc: the gpio descriptor to test
2580 *
2581 * Returns 1 if the GPIO is active-low, 0 otherwise.
2582 */
2583int gpiod_is_active_low(const struct gpio_desc *desc)
2584{
2585 VALIDATE_DESC(desc);
2586 return test_bit(FLAG_ACTIVE_LOW, &desc->flags);
2587}
2588EXPORT_SYMBOL_GPL(gpiod_is_active_low);
2589
Olivier Deprez0e641232021-09-23 10:07:05 +02002590/**
2591 * gpiod_toggle_active_low - toggle whether a GPIO is active-low or not
2592 * @desc: the gpio descriptor to change
2593 */
2594void gpiod_toggle_active_low(struct gpio_desc *desc)
2595{
2596 VALIDATE_DESC_VOID(desc);
2597 change_bit(FLAG_ACTIVE_LOW, &desc->flags);
2598}
2599EXPORT_SYMBOL_GPL(gpiod_toggle_active_low);
2600
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002601/* I/O calls are only valid after configuration completed; the relevant
2602 * "is this a valid GPIO" error checks should already have been done.
2603 *
2604 * "Get" operations are often inlinable as reading a pin value register,
2605 * and masking the relevant bit in that register.
2606 *
2607 * When "set" operations are inlinable, they involve writing that mask to
2608 * one register to set a low value, or a different register to set it high.
2609 * Otherwise locking is needed, so there may be little value to inlining.
2610 *
2611 *------------------------------------------------------------------------
2612 *
2613 * IMPORTANT!!! The hot paths -- get/set value -- assume that callers
2614 * have requested the GPIO. That can include implicit requesting by
2615 * a direction setting call. Marking a gpio as requested locks its chip
2616 * in memory, guaranteeing that these table lookups need no more locking
2617 * and that gpiochip_remove() will fail.
2618 *
2619 * REVISIT when debugging, consider adding some instrumentation to ensure
2620 * that the GPIO was actually requested.
2621 */
2622
2623static int gpiod_get_raw_value_commit(const struct gpio_desc *desc)
2624{
Olivier Deprez157378f2022-04-04 15:47:50 +02002625 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002626 int offset;
2627 int value;
2628
Olivier Deprez157378f2022-04-04 15:47:50 +02002629 gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002630 offset = gpio_chip_hwgpio(desc);
Olivier Deprez157378f2022-04-04 15:47:50 +02002631 value = gc->get ? gc->get(gc, offset) : -EIO;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002632 value = value < 0 ? value : !!value;
2633 trace_gpio_value(desc_to_gpio(desc), 1, value);
2634 return value;
2635}
2636
Olivier Deprez157378f2022-04-04 15:47:50 +02002637static int gpio_chip_get_multiple(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002638 unsigned long *mask, unsigned long *bits)
2639{
Olivier Deprez157378f2022-04-04 15:47:50 +02002640 if (gc->get_multiple) {
2641 return gc->get_multiple(gc, mask, bits);
2642 } else if (gc->get) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002643 int i, value;
2644
Olivier Deprez157378f2022-04-04 15:47:50 +02002645 for_each_set_bit(i, mask, gc->ngpio) {
2646 value = gc->get(gc, i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002647 if (value < 0)
2648 return value;
2649 __assign_bit(i, bits, value);
2650 }
2651 return 0;
2652 }
2653 return -EIO;
2654}
2655
2656int gpiod_get_array_value_complex(bool raw, bool can_sleep,
2657 unsigned int array_size,
2658 struct gpio_desc **desc_array,
David Brazdil0f672f62019-12-10 10:32:29 +00002659 struct gpio_array *array_info,
2660 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002661{
David Brazdil0f672f62019-12-10 10:32:29 +00002662 int ret, i = 0;
2663
2664 /*
2665 * Validate array_info against desc_array and its size.
2666 * It should immediately follow desc_array if both
2667 * have been obtained from the same gpiod_get_array() call.
2668 */
2669 if (array_info && array_info->desc == desc_array &&
2670 array_size <= array_info->size &&
2671 (void *)array_info == desc_array + array_info->size) {
2672 if (!can_sleep)
2673 WARN_ON(array_info->chip->can_sleep);
2674
2675 ret = gpio_chip_get_multiple(array_info->chip,
2676 array_info->get_mask,
2677 value_bitmap);
2678 if (ret)
2679 return ret;
2680
2681 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2682 bitmap_xor(value_bitmap, value_bitmap,
2683 array_info->invert_mask, array_size);
2684
David Brazdil0f672f62019-12-10 10:32:29 +00002685 i = find_first_zero_bit(array_info->get_mask, array_size);
Olivier Deprez157378f2022-04-04 15:47:50 +02002686 if (i == array_size)
2687 return 0;
David Brazdil0f672f62019-12-10 10:32:29 +00002688 } else {
2689 array_info = NULL;
2690 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002691
2692 while (i < array_size) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002693 struct gpio_chip *gc = desc_array[i]->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002694 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2695 unsigned long *mask, *bits;
2696 int first, j, ret;
2697
Olivier Deprez157378f2022-04-04 15:47:50 +02002698 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002699 mask = fastpath;
2700 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +02002701 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002702 sizeof(*mask),
2703 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2704 if (!mask)
2705 return -ENOMEM;
2706 }
2707
Olivier Deprez157378f2022-04-04 15:47:50 +02002708 bits = mask + BITS_TO_LONGS(gc->ngpio);
2709 bitmap_zero(mask, gc->ngpio);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002710
2711 if (!can_sleep)
Olivier Deprez157378f2022-04-04 15:47:50 +02002712 WARN_ON(gc->can_sleep);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002713
2714 /* collect all inputs belonging to the same chip */
2715 first = i;
2716 do {
2717 const struct gpio_desc *desc = desc_array[i];
2718 int hwgpio = gpio_chip_hwgpio(desc);
2719
2720 __set_bit(hwgpio, mask);
2721 i++;
David Brazdil0f672f62019-12-10 10:32:29 +00002722
2723 if (array_info)
2724 i = find_next_zero_bit(array_info->get_mask,
2725 array_size, i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002726 } while ((i < array_size) &&
Olivier Deprez157378f2022-04-04 15:47:50 +02002727 (desc_array[i]->gdev->chip == gc));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002728
Olivier Deprez157378f2022-04-04 15:47:50 +02002729 ret = gpio_chip_get_multiple(gc, mask, bits);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002730 if (ret) {
2731 if (mask != fastpath)
2732 kfree(mask);
2733 return ret;
2734 }
2735
David Brazdil0f672f62019-12-10 10:32:29 +00002736 for (j = first; j < i; ) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002737 const struct gpio_desc *desc = desc_array[j];
2738 int hwgpio = gpio_chip_hwgpio(desc);
2739 int value = test_bit(hwgpio, bits);
2740
2741 if (!raw && test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2742 value = !value;
David Brazdil0f672f62019-12-10 10:32:29 +00002743 __assign_bit(j, value_bitmap, value);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002744 trace_gpio_value(desc_to_gpio(desc), 1, value);
David Brazdil0f672f62019-12-10 10:32:29 +00002745 j++;
2746
2747 if (array_info)
2748 j = find_next_zero_bit(array_info->get_mask, i,
2749 j);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002750 }
2751
2752 if (mask != fastpath)
2753 kfree(mask);
2754 }
2755 return 0;
2756}
2757
2758/**
2759 * gpiod_get_raw_value() - return a gpio's raw value
2760 * @desc: gpio whose value will be returned
2761 *
2762 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
2763 * its ACTIVE_LOW status, or negative errno on failure.
2764 *
David Brazdil0f672f62019-12-10 10:32:29 +00002765 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002766 * complain if the GPIO chip functions potentially sleep.
2767 */
2768int gpiod_get_raw_value(const struct gpio_desc *desc)
2769{
2770 VALIDATE_DESC(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00002771 /* Should be using gpiod_get_raw_value_cansleep() */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002772 WARN_ON(desc->gdev->chip->can_sleep);
2773 return gpiod_get_raw_value_commit(desc);
2774}
2775EXPORT_SYMBOL_GPL(gpiod_get_raw_value);
2776
2777/**
2778 * gpiod_get_value() - return a gpio's value
2779 * @desc: gpio whose value will be returned
2780 *
2781 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
2782 * account, or negative errno on failure.
2783 *
David Brazdil0f672f62019-12-10 10:32:29 +00002784 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002785 * complain if the GPIO chip functions potentially sleep.
2786 */
2787int gpiod_get_value(const struct gpio_desc *desc)
2788{
2789 int value;
2790
2791 VALIDATE_DESC(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00002792 /* Should be using gpiod_get_value_cansleep() */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002793 WARN_ON(desc->gdev->chip->can_sleep);
2794
2795 value = gpiod_get_raw_value_commit(desc);
2796 if (value < 0)
2797 return value;
2798
2799 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2800 value = !value;
2801
2802 return value;
2803}
2804EXPORT_SYMBOL_GPL(gpiod_get_value);
2805
2806/**
2807 * gpiod_get_raw_array_value() - read raw values from an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00002808 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002809 * @desc_array: array of GPIO descriptors whose values will be read
David Brazdil0f672f62019-12-10 10:32:29 +00002810 * @array_info: information on applicability of fast bitmap processing path
2811 * @value_bitmap: bitmap to store the read values
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002812 *
2813 * Read the raw values of the GPIOs, i.e. the values of the physical lines
2814 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
2815 * else an error code.
2816 *
David Brazdil0f672f62019-12-10 10:32:29 +00002817 * This function can be called from contexts where we cannot sleep,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002818 * and it will complain if the GPIO chip functions potentially sleep.
2819 */
2820int gpiod_get_raw_array_value(unsigned int array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00002821 struct gpio_desc **desc_array,
2822 struct gpio_array *array_info,
2823 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002824{
2825 if (!desc_array)
2826 return -EINVAL;
2827 return gpiod_get_array_value_complex(true, false, array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00002828 desc_array, array_info,
2829 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002830}
2831EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value);
2832
2833/**
2834 * gpiod_get_array_value() - read values from an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00002835 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002836 * @desc_array: array of GPIO descriptors whose values will be read
David Brazdil0f672f62019-12-10 10:32:29 +00002837 * @array_info: information on applicability of fast bitmap processing path
2838 * @value_bitmap: bitmap to store the read values
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002839 *
2840 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
2841 * into account. Return 0 in case of success, else an error code.
2842 *
David Brazdil0f672f62019-12-10 10:32:29 +00002843 * This function can be called from contexts where we cannot sleep,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002844 * and it will complain if the GPIO chip functions potentially sleep.
2845 */
2846int gpiod_get_array_value(unsigned int array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00002847 struct gpio_desc **desc_array,
2848 struct gpio_array *array_info,
2849 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002850{
2851 if (!desc_array)
2852 return -EINVAL;
2853 return gpiod_get_array_value_complex(false, false, array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00002854 desc_array, array_info,
2855 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002856}
2857EXPORT_SYMBOL_GPL(gpiod_get_array_value);
2858
2859/*
2860 * gpio_set_open_drain_value_commit() - Set the open drain gpio's value.
2861 * @desc: gpio descriptor whose state need to be set.
2862 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
2863 */
2864static void gpio_set_open_drain_value_commit(struct gpio_desc *desc, bool value)
2865{
David Brazdil0f672f62019-12-10 10:32:29 +00002866 int ret = 0;
Olivier Deprez157378f2022-04-04 15:47:50 +02002867 struct gpio_chip *gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002868 int offset = gpio_chip_hwgpio(desc);
2869
2870 if (value) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002871 ret = gc->direction_input(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002872 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +02002873 ret = gc->direction_output(gc, offset, 0);
David Brazdil0f672f62019-12-10 10:32:29 +00002874 if (!ret)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002875 set_bit(FLAG_IS_OUT, &desc->flags);
2876 }
David Brazdil0f672f62019-12-10 10:32:29 +00002877 trace_gpio_direction(desc_to_gpio(desc), value, ret);
2878 if (ret < 0)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002879 gpiod_err(desc,
2880 "%s: Error in set_value for open drain err %d\n",
David Brazdil0f672f62019-12-10 10:32:29 +00002881 __func__, ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002882}
2883
2884/*
2885 * _gpio_set_open_source_value() - Set the open source gpio's value.
2886 * @desc: gpio descriptor whose state need to be set.
2887 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
2888 */
2889static void gpio_set_open_source_value_commit(struct gpio_desc *desc, bool value)
2890{
David Brazdil0f672f62019-12-10 10:32:29 +00002891 int ret = 0;
Olivier Deprez157378f2022-04-04 15:47:50 +02002892 struct gpio_chip *gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002893 int offset = gpio_chip_hwgpio(desc);
2894
2895 if (value) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002896 ret = gc->direction_output(gc, offset, 1);
David Brazdil0f672f62019-12-10 10:32:29 +00002897 if (!ret)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002898 set_bit(FLAG_IS_OUT, &desc->flags);
2899 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +02002900 ret = gc->direction_input(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002901 }
David Brazdil0f672f62019-12-10 10:32:29 +00002902 trace_gpio_direction(desc_to_gpio(desc), !value, ret);
2903 if (ret < 0)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002904 gpiod_err(desc,
2905 "%s: Error in set_value for open source err %d\n",
David Brazdil0f672f62019-12-10 10:32:29 +00002906 __func__, ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002907}
2908
2909static void gpiod_set_raw_value_commit(struct gpio_desc *desc, bool value)
2910{
Olivier Deprez157378f2022-04-04 15:47:50 +02002911 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002912
Olivier Deprez157378f2022-04-04 15:47:50 +02002913 gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002914 trace_gpio_value(desc_to_gpio(desc), 0, value);
Olivier Deprez157378f2022-04-04 15:47:50 +02002915 gc->set(gc, gpio_chip_hwgpio(desc), value);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002916}
2917
2918/*
2919 * set multiple outputs on the same chip;
2920 * use the chip's set_multiple function if available;
2921 * otherwise set the outputs sequentially;
Olivier Deprez157378f2022-04-04 15:47:50 +02002922 * @chip: the GPIO chip we operate on
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002923 * @mask: bit mask array; one bit per output; BITS_PER_LONG bits per word
2924 * defines which outputs are to be changed
2925 * @bits: bit value array; one bit per output; BITS_PER_LONG bits per word
2926 * defines the values the outputs specified by mask are to be set to
2927 */
Olivier Deprez157378f2022-04-04 15:47:50 +02002928static void gpio_chip_set_multiple(struct gpio_chip *gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002929 unsigned long *mask, unsigned long *bits)
2930{
Olivier Deprez157378f2022-04-04 15:47:50 +02002931 if (gc->set_multiple) {
2932 gc->set_multiple(gc, mask, bits);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002933 } else {
2934 unsigned int i;
2935
2936 /* set outputs if the corresponding mask bit is set */
Olivier Deprez157378f2022-04-04 15:47:50 +02002937 for_each_set_bit(i, mask, gc->ngpio)
2938 gc->set(gc, i, test_bit(i, bits));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002939 }
2940}
2941
2942int gpiod_set_array_value_complex(bool raw, bool can_sleep,
David Brazdil0f672f62019-12-10 10:32:29 +00002943 unsigned int array_size,
2944 struct gpio_desc **desc_array,
2945 struct gpio_array *array_info,
2946 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002947{
2948 int i = 0;
2949
David Brazdil0f672f62019-12-10 10:32:29 +00002950 /*
2951 * Validate array_info against desc_array and its size.
2952 * It should immediately follow desc_array if both
2953 * have been obtained from the same gpiod_get_array() call.
2954 */
2955 if (array_info && array_info->desc == desc_array &&
2956 array_size <= array_info->size &&
2957 (void *)array_info == desc_array + array_info->size) {
2958 if (!can_sleep)
2959 WARN_ON(array_info->chip->can_sleep);
2960
2961 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2962 bitmap_xor(value_bitmap, value_bitmap,
2963 array_info->invert_mask, array_size);
2964
2965 gpio_chip_set_multiple(array_info->chip, array_info->set_mask,
2966 value_bitmap);
2967
David Brazdil0f672f62019-12-10 10:32:29 +00002968 i = find_first_zero_bit(array_info->set_mask, array_size);
Olivier Deprez157378f2022-04-04 15:47:50 +02002969 if (i == array_size)
2970 return 0;
David Brazdil0f672f62019-12-10 10:32:29 +00002971 } else {
2972 array_info = NULL;
2973 }
2974
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002975 while (i < array_size) {
Olivier Deprez157378f2022-04-04 15:47:50 +02002976 struct gpio_chip *gc = desc_array[i]->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002977 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2978 unsigned long *mask, *bits;
2979 int count = 0;
2980
Olivier Deprez157378f2022-04-04 15:47:50 +02002981 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002982 mask = fastpath;
2983 } else {
Olivier Deprez157378f2022-04-04 15:47:50 +02002984 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002985 sizeof(*mask),
2986 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2987 if (!mask)
2988 return -ENOMEM;
2989 }
2990
Olivier Deprez157378f2022-04-04 15:47:50 +02002991 bits = mask + BITS_TO_LONGS(gc->ngpio);
2992 bitmap_zero(mask, gc->ngpio);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002993
2994 if (!can_sleep)
Olivier Deprez157378f2022-04-04 15:47:50 +02002995 WARN_ON(gc->can_sleep);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002996
2997 do {
2998 struct gpio_desc *desc = desc_array[i];
2999 int hwgpio = gpio_chip_hwgpio(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00003000 int value = test_bit(i, value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003001
David Brazdil0f672f62019-12-10 10:32:29 +00003002 /*
3003 * Pins applicable for fast input but not for
3004 * fast output processing may have been already
3005 * inverted inside the fast path, skip them.
3006 */
3007 if (!raw && !(array_info &&
3008 test_bit(i, array_info->invert_mask)) &&
3009 test_bit(FLAG_ACTIVE_LOW, &desc->flags))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003010 value = !value;
3011 trace_gpio_value(desc_to_gpio(desc), 0, value);
3012 /*
3013 * collect all normal outputs belonging to the same chip
3014 * open drain and open source outputs are set individually
3015 */
3016 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) && !raw) {
3017 gpio_set_open_drain_value_commit(desc, value);
3018 } else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags) && !raw) {
3019 gpio_set_open_source_value_commit(desc, value);
3020 } else {
3021 __set_bit(hwgpio, mask);
Olivier Deprez157378f2022-04-04 15:47:50 +02003022 __assign_bit(hwgpio, bits, value);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003023 count++;
3024 }
3025 i++;
David Brazdil0f672f62019-12-10 10:32:29 +00003026
3027 if (array_info)
3028 i = find_next_zero_bit(array_info->set_mask,
3029 array_size, i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003030 } while ((i < array_size) &&
Olivier Deprez157378f2022-04-04 15:47:50 +02003031 (desc_array[i]->gdev->chip == gc));
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003032 /* push collected bits to outputs */
3033 if (count != 0)
Olivier Deprez157378f2022-04-04 15:47:50 +02003034 gpio_chip_set_multiple(gc, mask, bits);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003035
3036 if (mask != fastpath)
3037 kfree(mask);
3038 }
3039 return 0;
3040}
3041
3042/**
3043 * gpiod_set_raw_value() - assign a gpio's raw value
3044 * @desc: gpio whose value will be assigned
3045 * @value: value to assign
3046 *
3047 * Set the raw value of the GPIO, i.e. the value of its physical line without
3048 * regard for its ACTIVE_LOW status.
3049 *
David Brazdil0f672f62019-12-10 10:32:29 +00003050 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003051 * complain if the GPIO chip functions potentially sleep.
3052 */
3053void gpiod_set_raw_value(struct gpio_desc *desc, int value)
3054{
3055 VALIDATE_DESC_VOID(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00003056 /* Should be using gpiod_set_raw_value_cansleep() */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003057 WARN_ON(desc->gdev->chip->can_sleep);
3058 gpiod_set_raw_value_commit(desc, value);
3059}
3060EXPORT_SYMBOL_GPL(gpiod_set_raw_value);
3061
3062/**
3063 * gpiod_set_value_nocheck() - set a GPIO line value without checking
3064 * @desc: the descriptor to set the value on
3065 * @value: value to set
3066 *
3067 * This sets the value of a GPIO line backing a descriptor, applying
3068 * different semantic quirks like active low and open drain/source
3069 * handling.
3070 */
3071static void gpiod_set_value_nocheck(struct gpio_desc *desc, int value)
3072{
3073 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3074 value = !value;
3075 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
3076 gpio_set_open_drain_value_commit(desc, value);
3077 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
3078 gpio_set_open_source_value_commit(desc, value);
3079 else
3080 gpiod_set_raw_value_commit(desc, value);
3081}
3082
3083/**
3084 * gpiod_set_value() - assign a gpio's value
3085 * @desc: gpio whose value will be assigned
3086 * @value: value to assign
3087 *
3088 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW,
3089 * OPEN_DRAIN and OPEN_SOURCE flags into account.
3090 *
David Brazdil0f672f62019-12-10 10:32:29 +00003091 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003092 * complain if the GPIO chip functions potentially sleep.
3093 */
3094void gpiod_set_value(struct gpio_desc *desc, int value)
3095{
3096 VALIDATE_DESC_VOID(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00003097 /* Should be using gpiod_set_value_cansleep() */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003098 WARN_ON(desc->gdev->chip->can_sleep);
3099 gpiod_set_value_nocheck(desc, value);
3100}
3101EXPORT_SYMBOL_GPL(gpiod_set_value);
3102
3103/**
3104 * gpiod_set_raw_array_value() - assign values to an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003105 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003106 * @desc_array: array of GPIO descriptors whose values will be assigned
David Brazdil0f672f62019-12-10 10:32:29 +00003107 * @array_info: information on applicability of fast bitmap processing path
3108 * @value_bitmap: bitmap of values to assign
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003109 *
3110 * Set the raw values of the GPIOs, i.e. the values of the physical lines
3111 * without regard for their ACTIVE_LOW status.
3112 *
David Brazdil0f672f62019-12-10 10:32:29 +00003113 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003114 * complain if the GPIO chip functions potentially sleep.
3115 */
3116int gpiod_set_raw_array_value(unsigned int array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00003117 struct gpio_desc **desc_array,
3118 struct gpio_array *array_info,
3119 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003120{
3121 if (!desc_array)
3122 return -EINVAL;
3123 return gpiod_set_array_value_complex(true, false, array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00003124 desc_array, array_info, value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003125}
3126EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value);
3127
3128/**
3129 * gpiod_set_array_value() - assign values to an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003130 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003131 * @desc_array: array of GPIO descriptors whose values will be assigned
David Brazdil0f672f62019-12-10 10:32:29 +00003132 * @array_info: information on applicability of fast bitmap processing path
3133 * @value_bitmap: bitmap of values to assign
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003134 *
3135 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3136 * into account.
3137 *
David Brazdil0f672f62019-12-10 10:32:29 +00003138 * This function can be called from contexts where we cannot sleep, and will
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003139 * complain if the GPIO chip functions potentially sleep.
3140 */
David Brazdil0f672f62019-12-10 10:32:29 +00003141int gpiod_set_array_value(unsigned int array_size,
3142 struct gpio_desc **desc_array,
3143 struct gpio_array *array_info,
3144 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003145{
3146 if (!desc_array)
David Brazdil0f672f62019-12-10 10:32:29 +00003147 return -EINVAL;
3148 return gpiod_set_array_value_complex(false, false, array_size,
3149 desc_array, array_info,
3150 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003151}
3152EXPORT_SYMBOL_GPL(gpiod_set_array_value);
3153
3154/**
3155 * gpiod_cansleep() - report whether gpio value access may sleep
3156 * @desc: gpio to check
3157 *
3158 */
3159int gpiod_cansleep(const struct gpio_desc *desc)
3160{
3161 VALIDATE_DESC(desc);
3162 return desc->gdev->chip->can_sleep;
3163}
3164EXPORT_SYMBOL_GPL(gpiod_cansleep);
3165
3166/**
3167 * gpiod_set_consumer_name() - set the consumer name for the descriptor
3168 * @desc: gpio to set the consumer name on
3169 * @name: the new consumer name
3170 */
David Brazdil0f672f62019-12-10 10:32:29 +00003171int gpiod_set_consumer_name(struct gpio_desc *desc, const char *name)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003172{
David Brazdil0f672f62019-12-10 10:32:29 +00003173 VALIDATE_DESC(desc);
3174 if (name) {
3175 name = kstrdup_const(name, GFP_KERNEL);
3176 if (!name)
3177 return -ENOMEM;
3178 }
3179
3180 kfree_const(desc->label);
3181 desc_set_label(desc, name);
3182
3183 return 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003184}
3185EXPORT_SYMBOL_GPL(gpiod_set_consumer_name);
3186
3187/**
3188 * gpiod_to_irq() - return the IRQ corresponding to a GPIO
3189 * @desc: gpio whose IRQ will be returned (already requested)
3190 *
3191 * Return the IRQ corresponding to the passed GPIO, or an error code in case of
3192 * error.
3193 */
3194int gpiod_to_irq(const struct gpio_desc *desc)
3195{
Olivier Deprez157378f2022-04-04 15:47:50 +02003196 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003197 int offset;
3198
3199 /*
3200 * Cannot VALIDATE_DESC() here as gpiod_to_irq() consumer semantics
3201 * requires this function to not return zero on an invalid descriptor
3202 * but rather a negative error number.
3203 */
3204 if (!desc || IS_ERR(desc) || !desc->gdev || !desc->gdev->chip)
3205 return -EINVAL;
3206
Olivier Deprez157378f2022-04-04 15:47:50 +02003207 gc = desc->gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003208 offset = gpio_chip_hwgpio(desc);
Olivier Deprez157378f2022-04-04 15:47:50 +02003209 if (gc->to_irq) {
3210 int retirq = gc->to_irq(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003211
3212 /* Zero means NO_IRQ */
3213 if (!retirq)
3214 return -ENXIO;
3215
3216 return retirq;
3217 }
Olivier Deprez157378f2022-04-04 15:47:50 +02003218#ifdef CONFIG_GPIOLIB_IRQCHIP
3219 if (gc->irq.chip) {
3220 /*
3221 * Avoid race condition with other code, which tries to lookup
3222 * an IRQ before the irqchip has been properly registered,
3223 * i.e. while gpiochip is still being brought up.
3224 */
3225 return -EPROBE_DEFER;
3226 }
3227#endif
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003228 return -ENXIO;
3229}
3230EXPORT_SYMBOL_GPL(gpiod_to_irq);
3231
3232/**
3233 * gpiochip_lock_as_irq() - lock a GPIO to be used as IRQ
Olivier Deprez157378f2022-04-04 15:47:50 +02003234 * @gc: the chip the GPIO to lock belongs to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003235 * @offset: the offset of the GPIO to lock as IRQ
3236 *
3237 * This is used directly by GPIO drivers that want to lock down
3238 * a certain GPIO line to be used for IRQs.
3239 */
Olivier Deprez157378f2022-04-04 15:47:50 +02003240int gpiochip_lock_as_irq(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003241{
3242 struct gpio_desc *desc;
3243
Olivier Deprez157378f2022-04-04 15:47:50 +02003244 desc = gpiochip_get_desc(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003245 if (IS_ERR(desc))
3246 return PTR_ERR(desc);
3247
3248 /*
3249 * If it's fast: flush the direction setting if something changed
3250 * behind our back
3251 */
Olivier Deprez157378f2022-04-04 15:47:50 +02003252 if (!gc->can_sleep && gc->get_direction) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003253 int dir = gpiod_get_direction(desc);
3254
3255 if (dir < 0) {
Olivier Deprez157378f2022-04-04 15:47:50 +02003256 chip_err(gc, "%s: cannot get GPIO direction\n",
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003257 __func__);
3258 return dir;
3259 }
3260 }
3261
Olivier Deprez0e641232021-09-23 10:07:05 +02003262 /* To be valid for IRQ the line needs to be input or open drain */
3263 if (test_bit(FLAG_IS_OUT, &desc->flags) &&
3264 !test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
Olivier Deprez157378f2022-04-04 15:47:50 +02003265 chip_err(gc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003266 "%s: tried to flag a GPIO set as output for IRQ\n",
3267 __func__);
3268 return -EIO;
3269 }
3270
3271 set_bit(FLAG_USED_AS_IRQ, &desc->flags);
David Brazdil0f672f62019-12-10 10:32:29 +00003272 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003273
3274 /*
3275 * If the consumer has not set up a label (such as when the
3276 * IRQ is referenced from .to_irq()) we set up a label here
3277 * so it is clear this is used as an interrupt.
3278 */
3279 if (!desc->label)
3280 desc_set_label(desc, "interrupt");
3281
3282 return 0;
3283}
3284EXPORT_SYMBOL_GPL(gpiochip_lock_as_irq);
3285
3286/**
3287 * gpiochip_unlock_as_irq() - unlock a GPIO used as IRQ
Olivier Deprez157378f2022-04-04 15:47:50 +02003288 * @gc: the chip the GPIO to lock belongs to
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003289 * @offset: the offset of the GPIO to lock as IRQ
3290 *
3291 * This is used directly by GPIO drivers that want to indicate
3292 * that a certain GPIO is no longer used exclusively for IRQ.
3293 */
Olivier Deprez157378f2022-04-04 15:47:50 +02003294void gpiochip_unlock_as_irq(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003295{
3296 struct gpio_desc *desc;
3297
Olivier Deprez157378f2022-04-04 15:47:50 +02003298 desc = gpiochip_get_desc(gc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003299 if (IS_ERR(desc))
3300 return;
3301
3302 clear_bit(FLAG_USED_AS_IRQ, &desc->flags);
David Brazdil0f672f62019-12-10 10:32:29 +00003303 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003304
3305 /* If we only had this marking, erase it */
3306 if (desc->label && !strcmp(desc->label, "interrupt"))
3307 desc_set_label(desc, NULL);
3308}
3309EXPORT_SYMBOL_GPL(gpiochip_unlock_as_irq);
3310
Olivier Deprez157378f2022-04-04 15:47:50 +02003311void gpiochip_disable_irq(struct gpio_chip *gc, unsigned int offset)
David Brazdil0f672f62019-12-10 10:32:29 +00003312{
Olivier Deprez157378f2022-04-04 15:47:50 +02003313 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
David Brazdil0f672f62019-12-10 10:32:29 +00003314
3315 if (!IS_ERR(desc) &&
3316 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags)))
3317 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3318}
3319EXPORT_SYMBOL_GPL(gpiochip_disable_irq);
3320
Olivier Deprez157378f2022-04-04 15:47:50 +02003321void gpiochip_enable_irq(struct gpio_chip *gc, unsigned int offset)
David Brazdil0f672f62019-12-10 10:32:29 +00003322{
Olivier Deprez157378f2022-04-04 15:47:50 +02003323 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
David Brazdil0f672f62019-12-10 10:32:29 +00003324
3325 if (!IS_ERR(desc) &&
3326 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags))) {
Olivier Deprez0e641232021-09-23 10:07:05 +02003327 /*
3328 * We must not be output when using IRQ UNLESS we are
3329 * open drain.
3330 */
3331 WARN_ON(test_bit(FLAG_IS_OUT, &desc->flags) &&
3332 !test_bit(FLAG_OPEN_DRAIN, &desc->flags));
David Brazdil0f672f62019-12-10 10:32:29 +00003333 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3334 }
3335}
3336EXPORT_SYMBOL_GPL(gpiochip_enable_irq);
3337
Olivier Deprez157378f2022-04-04 15:47:50 +02003338bool gpiochip_line_is_irq(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003339{
Olivier Deprez157378f2022-04-04 15:47:50 +02003340 if (offset >= gc->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003341 return false;
3342
Olivier Deprez157378f2022-04-04 15:47:50 +02003343 return test_bit(FLAG_USED_AS_IRQ, &gc->gpiodev->descs[offset].flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003344}
3345EXPORT_SYMBOL_GPL(gpiochip_line_is_irq);
3346
Olivier Deprez157378f2022-04-04 15:47:50 +02003347int gpiochip_reqres_irq(struct gpio_chip *gc, unsigned int offset)
David Brazdil0f672f62019-12-10 10:32:29 +00003348{
3349 int ret;
3350
Olivier Deprez157378f2022-04-04 15:47:50 +02003351 if (!try_module_get(gc->gpiodev->owner))
David Brazdil0f672f62019-12-10 10:32:29 +00003352 return -ENODEV;
3353
Olivier Deprez157378f2022-04-04 15:47:50 +02003354 ret = gpiochip_lock_as_irq(gc, offset);
David Brazdil0f672f62019-12-10 10:32:29 +00003355 if (ret) {
Olivier Deprez157378f2022-04-04 15:47:50 +02003356 chip_err(gc, "unable to lock HW IRQ %u for IRQ\n", offset);
3357 module_put(gc->gpiodev->owner);
David Brazdil0f672f62019-12-10 10:32:29 +00003358 return ret;
3359 }
3360 return 0;
3361}
3362EXPORT_SYMBOL_GPL(gpiochip_reqres_irq);
3363
Olivier Deprez157378f2022-04-04 15:47:50 +02003364void gpiochip_relres_irq(struct gpio_chip *gc, unsigned int offset)
David Brazdil0f672f62019-12-10 10:32:29 +00003365{
Olivier Deprez157378f2022-04-04 15:47:50 +02003366 gpiochip_unlock_as_irq(gc, offset);
3367 module_put(gc->gpiodev->owner);
David Brazdil0f672f62019-12-10 10:32:29 +00003368}
3369EXPORT_SYMBOL_GPL(gpiochip_relres_irq);
3370
Olivier Deprez157378f2022-04-04 15:47:50 +02003371bool gpiochip_line_is_open_drain(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003372{
Olivier Deprez157378f2022-04-04 15:47:50 +02003373 if (offset >= gc->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003374 return false;
3375
Olivier Deprez157378f2022-04-04 15:47:50 +02003376 return test_bit(FLAG_OPEN_DRAIN, &gc->gpiodev->descs[offset].flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003377}
3378EXPORT_SYMBOL_GPL(gpiochip_line_is_open_drain);
3379
Olivier Deprez157378f2022-04-04 15:47:50 +02003380bool gpiochip_line_is_open_source(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003381{
Olivier Deprez157378f2022-04-04 15:47:50 +02003382 if (offset >= gc->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003383 return false;
3384
Olivier Deprez157378f2022-04-04 15:47:50 +02003385 return test_bit(FLAG_OPEN_SOURCE, &gc->gpiodev->descs[offset].flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003386}
3387EXPORT_SYMBOL_GPL(gpiochip_line_is_open_source);
3388
Olivier Deprez157378f2022-04-04 15:47:50 +02003389bool gpiochip_line_is_persistent(struct gpio_chip *gc, unsigned int offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003390{
Olivier Deprez157378f2022-04-04 15:47:50 +02003391 if (offset >= gc->ngpio)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003392 return false;
3393
Olivier Deprez157378f2022-04-04 15:47:50 +02003394 return !test_bit(FLAG_TRANSITORY, &gc->gpiodev->descs[offset].flags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003395}
3396EXPORT_SYMBOL_GPL(gpiochip_line_is_persistent);
3397
3398/**
3399 * gpiod_get_raw_value_cansleep() - return a gpio's raw value
3400 * @desc: gpio whose value will be returned
3401 *
3402 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
3403 * its ACTIVE_LOW status, or negative errno on failure.
3404 *
3405 * This function is to be called from contexts that can sleep.
3406 */
3407int gpiod_get_raw_value_cansleep(const struct gpio_desc *desc)
3408{
3409 might_sleep_if(extra_checks);
3410 VALIDATE_DESC(desc);
3411 return gpiod_get_raw_value_commit(desc);
3412}
3413EXPORT_SYMBOL_GPL(gpiod_get_raw_value_cansleep);
3414
3415/**
3416 * gpiod_get_value_cansleep() - return a gpio's value
3417 * @desc: gpio whose value will be returned
3418 *
3419 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
3420 * account, or negative errno on failure.
3421 *
3422 * This function is to be called from contexts that can sleep.
3423 */
3424int gpiod_get_value_cansleep(const struct gpio_desc *desc)
3425{
3426 int value;
3427
3428 might_sleep_if(extra_checks);
3429 VALIDATE_DESC(desc);
3430 value = gpiod_get_raw_value_commit(desc);
3431 if (value < 0)
3432 return value;
3433
3434 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3435 value = !value;
3436
3437 return value;
3438}
3439EXPORT_SYMBOL_GPL(gpiod_get_value_cansleep);
3440
3441/**
3442 * gpiod_get_raw_array_value_cansleep() - read raw values from an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003443 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003444 * @desc_array: array of GPIO descriptors whose values will be read
David Brazdil0f672f62019-12-10 10:32:29 +00003445 * @array_info: information on applicability of fast bitmap processing path
3446 * @value_bitmap: bitmap to store the read values
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003447 *
3448 * Read the raw values of the GPIOs, i.e. the values of the physical lines
3449 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
3450 * else an error code.
3451 *
3452 * This function is to be called from contexts that can sleep.
3453 */
3454int gpiod_get_raw_array_value_cansleep(unsigned int array_size,
3455 struct gpio_desc **desc_array,
David Brazdil0f672f62019-12-10 10:32:29 +00003456 struct gpio_array *array_info,
3457 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003458{
3459 might_sleep_if(extra_checks);
3460 if (!desc_array)
3461 return -EINVAL;
3462 return gpiod_get_array_value_complex(true, true, array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00003463 desc_array, array_info,
3464 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003465}
3466EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value_cansleep);
3467
3468/**
3469 * gpiod_get_array_value_cansleep() - read values from an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003470 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003471 * @desc_array: array of GPIO descriptors whose values will be read
David Brazdil0f672f62019-12-10 10:32:29 +00003472 * @array_info: information on applicability of fast bitmap processing path
3473 * @value_bitmap: bitmap to store the read values
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003474 *
3475 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3476 * into account. Return 0 in case of success, else an error code.
3477 *
3478 * This function is to be called from contexts that can sleep.
3479 */
3480int gpiod_get_array_value_cansleep(unsigned int array_size,
3481 struct gpio_desc **desc_array,
David Brazdil0f672f62019-12-10 10:32:29 +00003482 struct gpio_array *array_info,
3483 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003484{
3485 might_sleep_if(extra_checks);
3486 if (!desc_array)
3487 return -EINVAL;
3488 return gpiod_get_array_value_complex(false, true, array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00003489 desc_array, array_info,
3490 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003491}
3492EXPORT_SYMBOL_GPL(gpiod_get_array_value_cansleep);
3493
3494/**
3495 * gpiod_set_raw_value_cansleep() - assign a gpio's raw value
3496 * @desc: gpio whose value will be assigned
3497 * @value: value to assign
3498 *
3499 * Set the raw value of the GPIO, i.e. the value of its physical line without
3500 * regard for its ACTIVE_LOW status.
3501 *
3502 * This function is to be called from contexts that can sleep.
3503 */
3504void gpiod_set_raw_value_cansleep(struct gpio_desc *desc, int value)
3505{
3506 might_sleep_if(extra_checks);
3507 VALIDATE_DESC_VOID(desc);
3508 gpiod_set_raw_value_commit(desc, value);
3509}
3510EXPORT_SYMBOL_GPL(gpiod_set_raw_value_cansleep);
3511
3512/**
3513 * gpiod_set_value_cansleep() - assign a gpio's value
3514 * @desc: gpio whose value will be assigned
3515 * @value: value to assign
3516 *
3517 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
3518 * account
3519 *
3520 * This function is to be called from contexts that can sleep.
3521 */
3522void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
3523{
3524 might_sleep_if(extra_checks);
3525 VALIDATE_DESC_VOID(desc);
3526 gpiod_set_value_nocheck(desc, value);
3527}
3528EXPORT_SYMBOL_GPL(gpiod_set_value_cansleep);
3529
3530/**
3531 * gpiod_set_raw_array_value_cansleep() - assign values to an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003532 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003533 * @desc_array: array of GPIO descriptors whose values will be assigned
David Brazdil0f672f62019-12-10 10:32:29 +00003534 * @array_info: information on applicability of fast bitmap processing path
3535 * @value_bitmap: bitmap of values to assign
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003536 *
3537 * Set the raw values of the GPIOs, i.e. the values of the physical lines
3538 * without regard for their ACTIVE_LOW status.
3539 *
3540 * This function is to be called from contexts that can sleep.
3541 */
3542int gpiod_set_raw_array_value_cansleep(unsigned int array_size,
David Brazdil0f672f62019-12-10 10:32:29 +00003543 struct gpio_desc **desc_array,
3544 struct gpio_array *array_info,
3545 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003546{
3547 might_sleep_if(extra_checks);
3548 if (!desc_array)
3549 return -EINVAL;
3550 return gpiod_set_array_value_complex(true, true, array_size, desc_array,
David Brazdil0f672f62019-12-10 10:32:29 +00003551 array_info, value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003552}
3553EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value_cansleep);
3554
3555/**
3556 * gpiod_add_lookup_tables() - register GPIO device consumers
3557 * @tables: list of tables of consumers to register
3558 * @n: number of tables in the list
3559 */
3560void gpiod_add_lookup_tables(struct gpiod_lookup_table **tables, size_t n)
3561{
3562 unsigned int i;
3563
3564 mutex_lock(&gpio_lookup_lock);
3565
3566 for (i = 0; i < n; i++)
3567 list_add_tail(&tables[i]->list, &gpio_lookup_list);
3568
3569 mutex_unlock(&gpio_lookup_lock);
3570}
3571
3572/**
3573 * gpiod_set_array_value_cansleep() - assign values to an array of GPIOs
David Brazdil0f672f62019-12-10 10:32:29 +00003574 * @array_size: number of elements in the descriptor array / value bitmap
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003575 * @desc_array: array of GPIO descriptors whose values will be assigned
David Brazdil0f672f62019-12-10 10:32:29 +00003576 * @array_info: information on applicability of fast bitmap processing path
3577 * @value_bitmap: bitmap of values to assign
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003578 *
3579 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3580 * into account.
3581 *
3582 * This function is to be called from contexts that can sleep.
3583 */
David Brazdil0f672f62019-12-10 10:32:29 +00003584int gpiod_set_array_value_cansleep(unsigned int array_size,
3585 struct gpio_desc **desc_array,
3586 struct gpio_array *array_info,
3587 unsigned long *value_bitmap)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003588{
3589 might_sleep_if(extra_checks);
3590 if (!desc_array)
David Brazdil0f672f62019-12-10 10:32:29 +00003591 return -EINVAL;
3592 return gpiod_set_array_value_complex(false, true, array_size,
3593 desc_array, array_info,
3594 value_bitmap);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003595}
3596EXPORT_SYMBOL_GPL(gpiod_set_array_value_cansleep);
3597
3598/**
3599 * gpiod_add_lookup_table() - register GPIO device consumers
3600 * @table: table of consumers to register
3601 */
3602void gpiod_add_lookup_table(struct gpiod_lookup_table *table)
3603{
3604 mutex_lock(&gpio_lookup_lock);
3605
3606 list_add_tail(&table->list, &gpio_lookup_list);
3607
3608 mutex_unlock(&gpio_lookup_lock);
3609}
3610EXPORT_SYMBOL_GPL(gpiod_add_lookup_table);
3611
3612/**
3613 * gpiod_remove_lookup_table() - unregister GPIO device consumers
3614 * @table: table of consumers to unregister
3615 */
3616void gpiod_remove_lookup_table(struct gpiod_lookup_table *table)
3617{
3618 mutex_lock(&gpio_lookup_lock);
3619
3620 list_del(&table->list);
3621
3622 mutex_unlock(&gpio_lookup_lock);
3623}
3624EXPORT_SYMBOL_GPL(gpiod_remove_lookup_table);
3625
3626/**
3627 * gpiod_add_hogs() - register a set of GPIO hogs from machine code
3628 * @hogs: table of gpio hog entries with a zeroed sentinel at the end
3629 */
3630void gpiod_add_hogs(struct gpiod_hog *hogs)
3631{
Olivier Deprez157378f2022-04-04 15:47:50 +02003632 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003633 struct gpiod_hog *hog;
3634
3635 mutex_lock(&gpio_machine_hogs_mutex);
3636
3637 for (hog = &hogs[0]; hog->chip_label; hog++) {
3638 list_add_tail(&hog->list, &gpio_machine_hogs);
3639
3640 /*
3641 * The chip may have been registered earlier, so check if it
3642 * exists and, if so, try to hog the line now.
3643 */
Olivier Deprez157378f2022-04-04 15:47:50 +02003644 gc = find_chip_by_name(hog->chip_label);
3645 if (gc)
3646 gpiochip_machine_hog(gc, hog);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003647 }
3648
3649 mutex_unlock(&gpio_machine_hogs_mutex);
3650}
3651EXPORT_SYMBOL_GPL(gpiod_add_hogs);
3652
3653static struct gpiod_lookup_table *gpiod_find_lookup_table(struct device *dev)
3654{
3655 const char *dev_id = dev ? dev_name(dev) : NULL;
3656 struct gpiod_lookup_table *table;
3657
3658 mutex_lock(&gpio_lookup_lock);
3659
3660 list_for_each_entry(table, &gpio_lookup_list, list) {
3661 if (table->dev_id && dev_id) {
3662 /*
3663 * Valid strings on both ends, must be identical to have
3664 * a match
3665 */
3666 if (!strcmp(table->dev_id, dev_id))
3667 goto found;
3668 } else {
3669 /*
3670 * One of the pointers is NULL, so both must be to have
3671 * a match
3672 */
3673 if (dev_id == table->dev_id)
3674 goto found;
3675 }
3676 }
3677 table = NULL;
3678
3679found:
3680 mutex_unlock(&gpio_lookup_lock);
3681 return table;
3682}
3683
3684static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id,
David Brazdil0f672f62019-12-10 10:32:29 +00003685 unsigned int idx, unsigned long *flags)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003686{
3687 struct gpio_desc *desc = ERR_PTR(-ENOENT);
3688 struct gpiod_lookup_table *table;
3689 struct gpiod_lookup *p;
3690
3691 table = gpiod_find_lookup_table(dev);
3692 if (!table)
3693 return desc;
3694
Olivier Deprez157378f2022-04-04 15:47:50 +02003695 for (p = &table->table[0]; p->key; p++) {
3696 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003697
3698 /* idx must always match exactly */
3699 if (p->idx != idx)
3700 continue;
3701
3702 /* If the lookup entry has a con_id, require exact match */
3703 if (p->con_id && (!con_id || strcmp(p->con_id, con_id)))
3704 continue;
3705
Olivier Deprez157378f2022-04-04 15:47:50 +02003706 if (p->chip_hwnum == U16_MAX) {
3707 desc = gpio_name_to_desc(p->key);
3708 if (desc) {
3709 *flags = p->flags;
3710 return desc;
3711 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003712
Olivier Deprez157378f2022-04-04 15:47:50 +02003713 dev_warn(dev, "cannot find GPIO line %s, deferring\n",
3714 p->key);
3715 return ERR_PTR(-EPROBE_DEFER);
3716 }
3717
3718 gc = find_chip_by_name(p->key);
3719
3720 if (!gc) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003721 /*
3722 * As the lookup table indicates a chip with
Olivier Deprez157378f2022-04-04 15:47:50 +02003723 * p->key should exist, assume it may
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003724 * still appear later and let the interested
3725 * consumer be probed again or let the Deferred
3726 * Probe infrastructure handle the error.
3727 */
3728 dev_warn(dev, "cannot find GPIO chip %s, deferring\n",
Olivier Deprez157378f2022-04-04 15:47:50 +02003729 p->key);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003730 return ERR_PTR(-EPROBE_DEFER);
3731 }
3732
Olivier Deprez157378f2022-04-04 15:47:50 +02003733 if (gc->ngpio <= p->chip_hwnum) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003734 dev_err(dev,
Olivier Deprez0e641232021-09-23 10:07:05 +02003735 "requested GPIO %u (%u) is out of range [0..%u] for chip %s\n",
Olivier Deprez157378f2022-04-04 15:47:50 +02003736 idx, p->chip_hwnum, gc->ngpio - 1,
3737 gc->label);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003738 return ERR_PTR(-EINVAL);
3739 }
3740
Olivier Deprez157378f2022-04-04 15:47:50 +02003741 desc = gpiochip_get_desc(gc, p->chip_hwnum);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003742 *flags = p->flags;
3743
3744 return desc;
3745 }
3746
3747 return desc;
3748}
3749
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003750static int platform_gpio_count(struct device *dev, const char *con_id)
3751{
3752 struct gpiod_lookup_table *table;
3753 struct gpiod_lookup *p;
3754 unsigned int count = 0;
3755
3756 table = gpiod_find_lookup_table(dev);
3757 if (!table)
3758 return -ENOENT;
3759
Olivier Deprez157378f2022-04-04 15:47:50 +02003760 for (p = &table->table[0]; p->key; p++) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003761 if ((con_id && p->con_id && !strcmp(con_id, p->con_id)) ||
3762 (!con_id && !p->con_id))
3763 count++;
3764 }
3765 if (!count)
3766 return -ENOENT;
3767
3768 return count;
3769}
3770
3771/**
Olivier Deprez157378f2022-04-04 15:47:50 +02003772 * fwnode_gpiod_get_index - obtain a GPIO from firmware node
3773 * @fwnode: handle of the firmware node
3774 * @con_id: function within the GPIO consumer
3775 * @index: index of the GPIO to obtain for the consumer
3776 * @flags: GPIO initialization flags
3777 * @label: label to attach to the requested GPIO
3778 *
3779 * This function can be used for drivers that get their configuration
3780 * from opaque firmware.
3781 *
3782 * The function properly finds the corresponding GPIO using whatever is the
3783 * underlying firmware interface and then makes sure that the GPIO
3784 * descriptor is requested before it is returned to the caller.
3785 *
3786 * Returns:
3787 * On successful request the GPIO pin is configured in accordance with
3788 * provided @flags.
3789 *
3790 * In case of error an ERR_PTR() is returned.
3791 */
3792struct gpio_desc *fwnode_gpiod_get_index(struct fwnode_handle *fwnode,
3793 const char *con_id, int index,
3794 enum gpiod_flags flags,
3795 const char *label)
3796{
3797 struct gpio_desc *desc;
3798 char prop_name[32]; /* 32 is max size of property name */
3799 unsigned int i;
3800
3801 for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
3802 if (con_id)
3803 snprintf(prop_name, sizeof(prop_name), "%s-%s",
3804 con_id, gpio_suffixes[i]);
3805 else
3806 snprintf(prop_name, sizeof(prop_name), "%s",
3807 gpio_suffixes[i]);
3808
3809 desc = fwnode_get_named_gpiod(fwnode, prop_name, index, flags,
3810 label);
3811 if (!IS_ERR(desc) || (PTR_ERR(desc) != -ENOENT))
3812 break;
3813 }
3814
3815 return desc;
3816}
3817EXPORT_SYMBOL_GPL(fwnode_gpiod_get_index);
3818
3819/**
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003820 * gpiod_count - return the number of GPIOs associated with a device / function
3821 * or -ENOENT if no GPIO has been assigned to the requested function
3822 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3823 * @con_id: function within the GPIO consumer
3824 */
3825int gpiod_count(struct device *dev, const char *con_id)
3826{
3827 int count = -ENOENT;
3828
3829 if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
David Brazdil0f672f62019-12-10 10:32:29 +00003830 count = of_gpio_get_count(dev, con_id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003831 else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev))
3832 count = acpi_gpio_count(dev, con_id);
3833
3834 if (count < 0)
3835 count = platform_gpio_count(dev, con_id);
3836
3837 return count;
3838}
3839EXPORT_SYMBOL_GPL(gpiod_count);
3840
3841/**
3842 * gpiod_get - obtain a GPIO for a given GPIO function
3843 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3844 * @con_id: function within the GPIO consumer
3845 * @flags: optional GPIO initialization flags
3846 *
3847 * Return the GPIO descriptor corresponding to the function con_id of device
3848 * dev, -ENOENT if no GPIO has been assigned to the requested function, or
3849 * another IS_ERR() code if an error occurred while trying to acquire the GPIO.
3850 */
3851struct gpio_desc *__must_check gpiod_get(struct device *dev, const char *con_id,
3852 enum gpiod_flags flags)
3853{
3854 return gpiod_get_index(dev, con_id, 0, flags);
3855}
3856EXPORT_SYMBOL_GPL(gpiod_get);
3857
3858/**
3859 * gpiod_get_optional - obtain an optional GPIO for a given GPIO function
3860 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3861 * @con_id: function within the GPIO consumer
3862 * @flags: optional GPIO initialization flags
3863 *
3864 * This is equivalent to gpiod_get(), except that when no GPIO was assigned to
3865 * the requested function it will return NULL. This is convenient for drivers
3866 * that need to handle optional GPIOs.
3867 */
3868struct gpio_desc *__must_check gpiod_get_optional(struct device *dev,
3869 const char *con_id,
3870 enum gpiod_flags flags)
3871{
3872 return gpiod_get_index_optional(dev, con_id, 0, flags);
3873}
3874EXPORT_SYMBOL_GPL(gpiod_get_optional);
3875
3876
3877/**
3878 * gpiod_configure_flags - helper function to configure a given GPIO
3879 * @desc: gpio whose value will be assigned
3880 * @con_id: function within the GPIO consumer
David Brazdil0f672f62019-12-10 10:32:29 +00003881 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
3882 * of_find_gpio() or of_get_gpio_hog()
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003883 * @dflags: gpiod_flags - optional GPIO initialization flags
3884 *
3885 * Return 0 on success, -ENOENT if no GPIO has been assigned to the
3886 * requested function and/or index, or another IS_ERR() code if an error
3887 * occurred while trying to acquire the GPIO.
3888 */
3889int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id,
3890 unsigned long lflags, enum gpiod_flags dflags)
3891{
David Brazdil0f672f62019-12-10 10:32:29 +00003892 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003893
3894 if (lflags & GPIO_ACTIVE_LOW)
3895 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
3896
3897 if (lflags & GPIO_OPEN_DRAIN)
3898 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3899 else if (dflags & GPIOD_FLAGS_BIT_OPEN_DRAIN) {
3900 /*
3901 * This enforces open drain mode from the consumer side.
3902 * This is necessary for some busses like I2C, but the lookup
3903 * should *REALLY* have specified them as open drain in the
3904 * first place, so print a little warning here.
3905 */
3906 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3907 gpiod_warn(desc,
3908 "enforced open drain please flag it properly in DT/ACPI DSDT/board file\n");
3909 }
3910
3911 if (lflags & GPIO_OPEN_SOURCE)
3912 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
3913
David Brazdil0f672f62019-12-10 10:32:29 +00003914 if ((lflags & GPIO_PULL_UP) && (lflags & GPIO_PULL_DOWN)) {
3915 gpiod_err(desc,
3916 "both pull-up and pull-down enabled, invalid configuration\n");
3917 return -EINVAL;
3918 }
3919
3920 if (lflags & GPIO_PULL_UP)
3921 set_bit(FLAG_PULL_UP, &desc->flags);
3922 else if (lflags & GPIO_PULL_DOWN)
3923 set_bit(FLAG_PULL_DOWN, &desc->flags);
3924
3925 ret = gpiod_set_transitory(desc, (lflags & GPIO_TRANSITORY));
3926 if (ret < 0)
3927 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003928
3929 /* No particular flag request, return here... */
3930 if (!(dflags & GPIOD_FLAGS_BIT_DIR_SET)) {
Olivier Deprez157378f2022-04-04 15:47:50 +02003931 gpiod_dbg(desc, "no flags found for %s\n", con_id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003932 return 0;
3933 }
3934
3935 /* Process flags */
3936 if (dflags & GPIOD_FLAGS_BIT_DIR_OUT)
David Brazdil0f672f62019-12-10 10:32:29 +00003937 ret = gpiod_direction_output(desc,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003938 !!(dflags & GPIOD_FLAGS_BIT_DIR_VAL));
3939 else
David Brazdil0f672f62019-12-10 10:32:29 +00003940 ret = gpiod_direction_input(desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003941
David Brazdil0f672f62019-12-10 10:32:29 +00003942 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003943}
3944
3945/**
3946 * gpiod_get_index - obtain a GPIO from a multi-index GPIO function
3947 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3948 * @con_id: function within the GPIO consumer
3949 * @idx: index of the GPIO to obtain in the consumer
3950 * @flags: optional GPIO initialization flags
3951 *
3952 * This variant of gpiod_get() allows to access GPIOs other than the first
3953 * defined one for functions that define several GPIOs.
3954 *
3955 * Return a valid GPIO descriptor, -ENOENT if no GPIO has been assigned to the
3956 * requested function and/or index, or another IS_ERR() code if an error
3957 * occurred while trying to acquire the GPIO.
3958 */
3959struct gpio_desc *__must_check gpiod_get_index(struct device *dev,
3960 const char *con_id,
3961 unsigned int idx,
3962 enum gpiod_flags flags)
3963{
David Brazdil0f672f62019-12-10 10:32:29 +00003964 unsigned long lookupflags = GPIO_LOOKUP_FLAGS_DEFAULT;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003965 struct gpio_desc *desc = NULL;
David Brazdil0f672f62019-12-10 10:32:29 +00003966 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00003967 /* Maybe we have a device name, maybe not */
3968 const char *devname = dev ? dev_name(dev) : "?";
3969
3970 dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id);
3971
3972 if (dev) {
3973 /* Using device tree? */
3974 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
3975 dev_dbg(dev, "using device tree for GPIO lookup\n");
3976 desc = of_find_gpio(dev, con_id, idx, &lookupflags);
3977 } else if (ACPI_COMPANION(dev)) {
3978 dev_dbg(dev, "using ACPI for GPIO lookup\n");
3979 desc = acpi_find_gpio(dev, con_id, idx, &flags, &lookupflags);
3980 }
3981 }
3982
3983 /*
3984 * Either we are not using DT or ACPI, or their lookup did not return
3985 * a result. In that case, use platform lookup as a fallback.
3986 */
3987 if (!desc || desc == ERR_PTR(-ENOENT)) {
3988 dev_dbg(dev, "using lookup tables for GPIO lookup\n");
3989 desc = gpiod_find(dev, con_id, idx, &lookupflags);
3990 }
3991
3992 if (IS_ERR(desc)) {
3993 dev_dbg(dev, "No GPIO consumer %s found\n", con_id);
3994 return desc;
3995 }
3996
3997 /*
3998 * If a connection label was passed use that, else attempt to use
3999 * the device name as label
4000 */
David Brazdil0f672f62019-12-10 10:32:29 +00004001 ret = gpiod_request(desc, con_id ? con_id : devname);
4002 if (ret < 0) {
4003 if (ret == -EBUSY && flags & GPIOD_FLAGS_BIT_NONEXCLUSIVE) {
4004 /*
4005 * This happens when there are several consumers for
4006 * the same GPIO line: we just return here without
4007 * further initialization. It is a bit if a hack.
4008 * This is necessary to support fixed regulators.
4009 *
4010 * FIXME: Make this more sane and safe.
4011 */
4012 dev_info(dev, "nonexclusive access to GPIO for %s\n",
4013 con_id ? con_id : devname);
4014 return desc;
4015 } else {
4016 return ERR_PTR(ret);
4017 }
4018 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004019
David Brazdil0f672f62019-12-10 10:32:29 +00004020 ret = gpiod_configure_flags(desc, con_id, lookupflags, flags);
4021 if (ret < 0) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004022 dev_dbg(dev, "setup of GPIO %s failed\n", con_id);
4023 gpiod_put(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00004024 return ERR_PTR(ret);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004025 }
4026
Olivier Deprez157378f2022-04-04 15:47:50 +02004027 blocking_notifier_call_chain(&desc->gdev->notifier,
4028 GPIOLINE_CHANGED_REQUESTED, desc);
4029
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004030 return desc;
4031}
4032EXPORT_SYMBOL_GPL(gpiod_get_index);
4033
4034/**
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004035 * fwnode_get_named_gpiod - obtain a GPIO from firmware node
4036 * @fwnode: handle of the firmware node
4037 * @propname: name of the firmware property representing the GPIO
4038 * @index: index of the GPIO to obtain for the consumer
4039 * @dflags: GPIO initialization flags
4040 * @label: label to attach to the requested GPIO
4041 *
4042 * This function can be used for drivers that get their configuration
4043 * from opaque firmware.
4044 *
4045 * The function properly finds the corresponding GPIO using whatever is the
4046 * underlying firmware interface and then makes sure that the GPIO
4047 * descriptor is requested before it is returned to the caller.
4048 *
4049 * Returns:
4050 * On successful request the GPIO pin is configured in accordance with
4051 * provided @dflags.
4052 *
4053 * In case of error an ERR_PTR() is returned.
4054 */
4055struct gpio_desc *fwnode_get_named_gpiod(struct fwnode_handle *fwnode,
4056 const char *propname, int index,
4057 enum gpiod_flags dflags,
4058 const char *label)
4059{
David Brazdil0f672f62019-12-10 10:32:29 +00004060 unsigned long lflags = GPIO_LOOKUP_FLAGS_DEFAULT;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004061 struct gpio_desc *desc = ERR_PTR(-ENODEV);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004062 int ret;
4063
4064 if (!fwnode)
4065 return ERR_PTR(-EINVAL);
4066
4067 if (is_of_node(fwnode)) {
4068 desc = gpiod_get_from_of_node(to_of_node(fwnode),
4069 propname, index,
4070 dflags,
4071 label);
4072 return desc;
4073 } else if (is_acpi_node(fwnode)) {
4074 struct acpi_gpio_info info;
4075
4076 desc = acpi_node_get_gpiod(fwnode, propname, index, &info);
4077 if (IS_ERR(desc))
4078 return desc;
4079
4080 acpi_gpio_update_gpiod_flags(&dflags, &info);
David Brazdil0f672f62019-12-10 10:32:29 +00004081 acpi_gpio_update_gpiod_lookup_flags(&lflags, &info);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004082 }
4083
4084 /* Currently only ACPI takes this path */
4085 ret = gpiod_request(desc, label);
4086 if (ret)
4087 return ERR_PTR(ret);
4088
4089 ret = gpiod_configure_flags(desc, propname, lflags, dflags);
4090 if (ret < 0) {
4091 gpiod_put(desc);
4092 return ERR_PTR(ret);
4093 }
4094
Olivier Deprez157378f2022-04-04 15:47:50 +02004095 blocking_notifier_call_chain(&desc->gdev->notifier,
4096 GPIOLINE_CHANGED_REQUESTED, desc);
4097
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004098 return desc;
4099}
4100EXPORT_SYMBOL_GPL(fwnode_get_named_gpiod);
4101
4102/**
4103 * gpiod_get_index_optional - obtain an optional GPIO from a multi-index GPIO
4104 * function
4105 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4106 * @con_id: function within the GPIO consumer
4107 * @index: index of the GPIO to obtain in the consumer
4108 * @flags: optional GPIO initialization flags
4109 *
4110 * This is equivalent to gpiod_get_index(), except that when no GPIO with the
4111 * specified index was assigned to the requested function it will return NULL.
4112 * This is convenient for drivers that need to handle optional GPIOs.
4113 */
4114struct gpio_desc *__must_check gpiod_get_index_optional(struct device *dev,
4115 const char *con_id,
4116 unsigned int index,
4117 enum gpiod_flags flags)
4118{
4119 struct gpio_desc *desc;
4120
4121 desc = gpiod_get_index(dev, con_id, index, flags);
4122 if (IS_ERR(desc)) {
4123 if (PTR_ERR(desc) == -ENOENT)
4124 return NULL;
4125 }
4126
4127 return desc;
4128}
4129EXPORT_SYMBOL_GPL(gpiod_get_index_optional);
4130
4131/**
4132 * gpiod_hog - Hog the specified GPIO desc given the provided flags
4133 * @desc: gpio whose value will be assigned
4134 * @name: gpio line name
David Brazdil0f672f62019-12-10 10:32:29 +00004135 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
4136 * of_find_gpio() or of_get_gpio_hog()
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004137 * @dflags: gpiod_flags - optional GPIO initialization flags
4138 */
4139int gpiod_hog(struct gpio_desc *desc, const char *name,
4140 unsigned long lflags, enum gpiod_flags dflags)
4141{
Olivier Deprez157378f2022-04-04 15:47:50 +02004142 struct gpio_chip *gc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004143 struct gpio_desc *local_desc;
4144 int hwnum;
David Brazdil0f672f62019-12-10 10:32:29 +00004145 int ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004146
Olivier Deprez157378f2022-04-04 15:47:50 +02004147 gc = gpiod_to_chip(desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004148 hwnum = gpio_chip_hwgpio(desc);
4149
Olivier Deprez157378f2022-04-04 15:47:50 +02004150 local_desc = gpiochip_request_own_desc(gc, hwnum, name,
David Brazdil0f672f62019-12-10 10:32:29 +00004151 lflags, dflags);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004152 if (IS_ERR(local_desc)) {
David Brazdil0f672f62019-12-10 10:32:29 +00004153 ret = PTR_ERR(local_desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004154 pr_err("requesting hog GPIO %s (chip %s, offset %d) failed, %d\n",
Olivier Deprez157378f2022-04-04 15:47:50 +02004155 name, gc->label, hwnum, ret);
David Brazdil0f672f62019-12-10 10:32:29 +00004156 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004157 }
4158
4159 /* Mark GPIO as hogged so it can be identified and removed later */
4160 set_bit(FLAG_IS_HOGGED, &desc->flags);
4161
Olivier Deprez157378f2022-04-04 15:47:50 +02004162 gpiod_info(desc, "hogged as %s%s\n",
4163 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ? "output" : "input",
4164 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ?
4165 (dflags & GPIOD_FLAGS_BIT_DIR_VAL) ? "/high" : "/low" : "");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004166
4167 return 0;
4168}
4169
4170/**
4171 * gpiochip_free_hogs - Scan gpio-controller chip and release GPIO hog
Olivier Deprez157378f2022-04-04 15:47:50 +02004172 * @gc: gpio chip to act on
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004173 */
Olivier Deprez157378f2022-04-04 15:47:50 +02004174static void gpiochip_free_hogs(struct gpio_chip *gc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004175{
4176 int id;
4177
Olivier Deprez157378f2022-04-04 15:47:50 +02004178 for (id = 0; id < gc->ngpio; id++) {
4179 if (test_bit(FLAG_IS_HOGGED, &gc->gpiodev->descs[id].flags))
4180 gpiochip_free_own_desc(&gc->gpiodev->descs[id]);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004181 }
4182}
4183
4184/**
4185 * gpiod_get_array - obtain multiple GPIOs from a multi-index GPIO function
4186 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4187 * @con_id: function within the GPIO consumer
4188 * @flags: optional GPIO initialization flags
4189 *
4190 * This function acquires all the GPIOs defined under a given function.
4191 *
4192 * Return a struct gpio_descs containing an array of descriptors, -ENOENT if
4193 * no GPIO has been assigned to the requested function, or another IS_ERR()
4194 * code if an error occurred while trying to acquire the GPIOs.
4195 */
4196struct gpio_descs *__must_check gpiod_get_array(struct device *dev,
4197 const char *con_id,
4198 enum gpiod_flags flags)
4199{
4200 struct gpio_desc *desc;
4201 struct gpio_descs *descs;
David Brazdil0f672f62019-12-10 10:32:29 +00004202 struct gpio_array *array_info = NULL;
Olivier Deprez157378f2022-04-04 15:47:50 +02004203 struct gpio_chip *gc;
David Brazdil0f672f62019-12-10 10:32:29 +00004204 int count, bitmap_size;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004205
4206 count = gpiod_count(dev, con_id);
4207 if (count < 0)
4208 return ERR_PTR(count);
4209
4210 descs = kzalloc(struct_size(descs, desc, count), GFP_KERNEL);
4211 if (!descs)
4212 return ERR_PTR(-ENOMEM);
4213
4214 for (descs->ndescs = 0; descs->ndescs < count; ) {
4215 desc = gpiod_get_index(dev, con_id, descs->ndescs, flags);
4216 if (IS_ERR(desc)) {
4217 gpiod_put_array(descs);
4218 return ERR_CAST(desc);
4219 }
David Brazdil0f672f62019-12-10 10:32:29 +00004220
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004221 descs->desc[descs->ndescs] = desc;
David Brazdil0f672f62019-12-10 10:32:29 +00004222
Olivier Deprez157378f2022-04-04 15:47:50 +02004223 gc = gpiod_to_chip(desc);
David Brazdil0f672f62019-12-10 10:32:29 +00004224 /*
4225 * If pin hardware number of array member 0 is also 0, select
4226 * its chip as a candidate for fast bitmap processing path.
4227 */
4228 if (descs->ndescs == 0 && gpio_chip_hwgpio(desc) == 0) {
4229 struct gpio_descs *array;
4230
Olivier Deprez157378f2022-04-04 15:47:50 +02004231 bitmap_size = BITS_TO_LONGS(gc->ngpio > count ?
4232 gc->ngpio : count);
David Brazdil0f672f62019-12-10 10:32:29 +00004233
4234 array = kzalloc(struct_size(descs, desc, count) +
4235 struct_size(array_info, invert_mask,
4236 3 * bitmap_size), GFP_KERNEL);
4237 if (!array) {
4238 gpiod_put_array(descs);
4239 return ERR_PTR(-ENOMEM);
4240 }
4241
4242 memcpy(array, descs,
4243 struct_size(descs, desc, descs->ndescs + 1));
4244 kfree(descs);
4245
4246 descs = array;
4247 array_info = (void *)(descs->desc + count);
4248 array_info->get_mask = array_info->invert_mask +
4249 bitmap_size;
4250 array_info->set_mask = array_info->get_mask +
4251 bitmap_size;
4252
4253 array_info->desc = descs->desc;
4254 array_info->size = count;
Olivier Deprez157378f2022-04-04 15:47:50 +02004255 array_info->chip = gc;
David Brazdil0f672f62019-12-10 10:32:29 +00004256 bitmap_set(array_info->get_mask, descs->ndescs,
4257 count - descs->ndescs);
4258 bitmap_set(array_info->set_mask, descs->ndescs,
4259 count - descs->ndescs);
4260 descs->info = array_info;
4261 }
4262 /* Unmark array members which don't belong to the 'fast' chip */
Olivier Deprez157378f2022-04-04 15:47:50 +02004263 if (array_info && array_info->chip != gc) {
David Brazdil0f672f62019-12-10 10:32:29 +00004264 __clear_bit(descs->ndescs, array_info->get_mask);
4265 __clear_bit(descs->ndescs, array_info->set_mask);
4266 }
4267 /*
4268 * Detect array members which belong to the 'fast' chip
4269 * but their pins are not in hardware order.
4270 */
4271 else if (array_info &&
4272 gpio_chip_hwgpio(desc) != descs->ndescs) {
4273 /*
4274 * Don't use fast path if all array members processed so
4275 * far belong to the same chip as this one but its pin
4276 * hardware number is different from its array index.
4277 */
4278 if (bitmap_full(array_info->get_mask, descs->ndescs)) {
4279 array_info = NULL;
4280 } else {
4281 __clear_bit(descs->ndescs,
4282 array_info->get_mask);
4283 __clear_bit(descs->ndescs,
4284 array_info->set_mask);
4285 }
4286 } else if (array_info) {
4287 /* Exclude open drain or open source from fast output */
Olivier Deprez157378f2022-04-04 15:47:50 +02004288 if (gpiochip_line_is_open_drain(gc, descs->ndescs) ||
4289 gpiochip_line_is_open_source(gc, descs->ndescs))
David Brazdil0f672f62019-12-10 10:32:29 +00004290 __clear_bit(descs->ndescs,
4291 array_info->set_mask);
4292 /* Identify 'fast' pins which require invertion */
4293 if (gpiod_is_active_low(desc))
4294 __set_bit(descs->ndescs,
4295 array_info->invert_mask);
4296 }
4297
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004298 descs->ndescs++;
4299 }
David Brazdil0f672f62019-12-10 10:32:29 +00004300 if (array_info)
4301 dev_dbg(dev,
4302 "GPIO array info: chip=%s, size=%d, get_mask=%lx, set_mask=%lx, invert_mask=%lx\n",
4303 array_info->chip->label, array_info->size,
4304 *array_info->get_mask, *array_info->set_mask,
4305 *array_info->invert_mask);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004306 return descs;
4307}
4308EXPORT_SYMBOL_GPL(gpiod_get_array);
4309
4310/**
4311 * gpiod_get_array_optional - obtain multiple GPIOs from a multi-index GPIO
4312 * function
4313 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4314 * @con_id: function within the GPIO consumer
4315 * @flags: optional GPIO initialization flags
4316 *
4317 * This is equivalent to gpiod_get_array(), except that when no GPIO was
4318 * assigned to the requested function it will return NULL.
4319 */
4320struct gpio_descs *__must_check gpiod_get_array_optional(struct device *dev,
4321 const char *con_id,
4322 enum gpiod_flags flags)
4323{
4324 struct gpio_descs *descs;
4325
4326 descs = gpiod_get_array(dev, con_id, flags);
Olivier Deprez157378f2022-04-04 15:47:50 +02004327 if (PTR_ERR(descs) == -ENOENT)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004328 return NULL;
4329
4330 return descs;
4331}
4332EXPORT_SYMBOL_GPL(gpiod_get_array_optional);
4333
4334/**
4335 * gpiod_put - dispose of a GPIO descriptor
4336 * @desc: GPIO descriptor to dispose of
4337 *
4338 * No descriptor can be used after gpiod_put() has been called on it.
4339 */
4340void gpiod_put(struct gpio_desc *desc)
4341{
David Brazdil0f672f62019-12-10 10:32:29 +00004342 if (desc)
4343 gpiod_free(desc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004344}
4345EXPORT_SYMBOL_GPL(gpiod_put);
4346
4347/**
4348 * gpiod_put_array - dispose of multiple GPIO descriptors
4349 * @descs: struct gpio_descs containing an array of descriptors
4350 */
4351void gpiod_put_array(struct gpio_descs *descs)
4352{
4353 unsigned int i;
4354
4355 for (i = 0; i < descs->ndescs; i++)
4356 gpiod_put(descs->desc[i]);
4357
4358 kfree(descs);
4359}
4360EXPORT_SYMBOL_GPL(gpiod_put_array);
4361
4362static int __init gpiolib_dev_init(void)
4363{
4364 int ret;
4365
4366 /* Register GPIO sysfs bus */
4367 ret = bus_register(&gpio_bus_type);
4368 if (ret < 0) {
4369 pr_err("gpiolib: could not register GPIO bus type\n");
4370 return ret;
4371 }
4372
Olivier Deprez157378f2022-04-04 15:47:50 +02004373 ret = alloc_chrdev_region(&gpio_devt, 0, GPIO_DEV_MAX, GPIOCHIP_NAME);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004374 if (ret < 0) {
4375 pr_err("gpiolib: failed to allocate char dev region\n");
4376 bus_unregister(&gpio_bus_type);
Olivier Deprez157378f2022-04-04 15:47:50 +02004377 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004378 }
Olivier Deprez157378f2022-04-04 15:47:50 +02004379
4380 gpiolib_initialized = true;
4381 gpiochip_setup_devs();
4382
4383#if IS_ENABLED(CONFIG_OF_DYNAMIC) && IS_ENABLED(CONFIG_OF_GPIO)
4384 WARN_ON(of_reconfig_notifier_register(&gpio_of_notifier));
4385#endif /* CONFIG_OF_DYNAMIC && CONFIG_OF_GPIO */
4386
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004387 return ret;
4388}
4389core_initcall(gpiolib_dev_init);
4390
4391#ifdef CONFIG_DEBUG_FS
4392
4393static void gpiolib_dbg_show(struct seq_file *s, struct gpio_device *gdev)
4394{
4395 unsigned i;
Olivier Deprez157378f2022-04-04 15:47:50 +02004396 struct gpio_chip *gc = gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004397 unsigned gpio = gdev->base;
4398 struct gpio_desc *gdesc = &gdev->descs[0];
David Brazdil0f672f62019-12-10 10:32:29 +00004399 bool is_out;
4400 bool is_irq;
4401 bool active_low;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004402
4403 for (i = 0; i < gdev->ngpio; i++, gpio++, gdesc++) {
4404 if (!test_bit(FLAG_REQUESTED, &gdesc->flags)) {
4405 if (gdesc->name) {
4406 seq_printf(s, " gpio-%-3d (%-20.20s)\n",
4407 gpio, gdesc->name);
4408 }
4409 continue;
4410 }
4411
4412 gpiod_get_direction(gdesc);
4413 is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
4414 is_irq = test_bit(FLAG_USED_AS_IRQ, &gdesc->flags);
David Brazdil0f672f62019-12-10 10:32:29 +00004415 active_low = test_bit(FLAG_ACTIVE_LOW, &gdesc->flags);
4416 seq_printf(s, " gpio-%-3d (%-20.20s|%-20.20s) %s %s %s%s",
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004417 gpio, gdesc->name ? gdesc->name : "", gdesc->label,
4418 is_out ? "out" : "in ",
Olivier Deprez157378f2022-04-04 15:47:50 +02004419 gc->get ? (gc->get(gc, i) ? "hi" : "lo") : "? ",
David Brazdil0f672f62019-12-10 10:32:29 +00004420 is_irq ? "IRQ " : "",
4421 active_low ? "ACTIVE LOW" : "");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004422 seq_printf(s, "\n");
4423 }
4424}
4425
4426static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
4427{
4428 unsigned long flags;
4429 struct gpio_device *gdev = NULL;
4430 loff_t index = *pos;
4431
4432 s->private = "";
4433
4434 spin_lock_irqsave(&gpio_lock, flags);
4435 list_for_each_entry(gdev, &gpio_devices, list)
4436 if (index-- == 0) {
4437 spin_unlock_irqrestore(&gpio_lock, flags);
4438 return gdev;
4439 }
4440 spin_unlock_irqrestore(&gpio_lock, flags);
4441
4442 return NULL;
4443}
4444
4445static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
4446{
4447 unsigned long flags;
4448 struct gpio_device *gdev = v;
4449 void *ret = NULL;
4450
4451 spin_lock_irqsave(&gpio_lock, flags);
4452 if (list_is_last(&gdev->list, &gpio_devices))
4453 ret = NULL;
4454 else
4455 ret = list_entry(gdev->list.next, struct gpio_device, list);
4456 spin_unlock_irqrestore(&gpio_lock, flags);
4457
4458 s->private = "\n";
4459 ++*pos;
4460
4461 return ret;
4462}
4463
4464static void gpiolib_seq_stop(struct seq_file *s, void *v)
4465{
4466}
4467
4468static int gpiolib_seq_show(struct seq_file *s, void *v)
4469{
4470 struct gpio_device *gdev = v;
Olivier Deprez157378f2022-04-04 15:47:50 +02004471 struct gpio_chip *gc = gdev->chip;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004472 struct device *parent;
4473
Olivier Deprez157378f2022-04-04 15:47:50 +02004474 if (!gc) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004475 seq_printf(s, "%s%s: (dangling chip)", (char *)s->private,
4476 dev_name(&gdev->dev));
4477 return 0;
4478 }
4479
4480 seq_printf(s, "%s%s: GPIOs %d-%d", (char *)s->private,
4481 dev_name(&gdev->dev),
4482 gdev->base, gdev->base + gdev->ngpio - 1);
Olivier Deprez157378f2022-04-04 15:47:50 +02004483 parent = gc->parent;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004484 if (parent)
4485 seq_printf(s, ", parent: %s/%s",
4486 parent->bus ? parent->bus->name : "no-bus",
4487 dev_name(parent));
Olivier Deprez157378f2022-04-04 15:47:50 +02004488 if (gc->label)
4489 seq_printf(s, ", %s", gc->label);
4490 if (gc->can_sleep)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004491 seq_printf(s, ", can sleep");
4492 seq_printf(s, ":\n");
4493
Olivier Deprez157378f2022-04-04 15:47:50 +02004494 if (gc->dbg_show)
4495 gc->dbg_show(s, gc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004496 else
4497 gpiolib_dbg_show(s, gdev);
4498
4499 return 0;
4500}
4501
Olivier Deprez157378f2022-04-04 15:47:50 +02004502static const struct seq_operations gpiolib_sops = {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004503 .start = gpiolib_seq_start,
4504 .next = gpiolib_seq_next,
4505 .stop = gpiolib_seq_stop,
4506 .show = gpiolib_seq_show,
4507};
Olivier Deprez157378f2022-04-04 15:47:50 +02004508DEFINE_SEQ_ATTRIBUTE(gpiolib);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004509
4510static int __init gpiolib_debugfs_init(void)
4511{
4512 /* /sys/kernel/debug/gpio */
Olivier Deprez157378f2022-04-04 15:47:50 +02004513 debugfs_create_file("gpio", 0444, NULL, NULL, &gpiolib_fops);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00004514 return 0;
4515}
4516subsys_initcall(gpiolib_debugfs_init);
4517
4518#endif /* DEBUG_FS */