blob: 5ce0c14c637b38dcdb5ffbdac44c9dcdce1a655d [file] [log] [blame]
Linus Walleijdae5f0a2018-09-25 09:08:48 +02001// SPDX-License-Identifier: GPL-2.0
Enrico Weigeltc47d9e12020-12-02 14:37:54 +01002
Andy Shevchenko923a6542017-05-25 16:08:38 +03003#include <linux/bitmap.h>
David Brownelld2876d02008-02-04 22:28:20 -08004#include <linux/kernel.h>
5#include <linux/module.h>
Daniel Glöcknerff77c352009-09-22 16:46:38 -07006#include <linux/interrupt.h>
David Brownelld2876d02008-02-04 22:28:20 -08007#include <linux/irq.h>
8#include <linux/spinlock.h>
Alexandre Courbot1a989d02013-02-03 01:29:24 +09009#include <linux/list.h>
David Brownelld8f388d82008-07-25 01:46:07 -070010#include <linux/device.h>
11#include <linux/err.h>
12#include <linux/debugfs.h>
13#include <linux/seq_file.h>
14#include <linux/gpio.h>
Daniel Glöcknerff77c352009-09-22 16:46:38 -070015#include <linux/idr.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090016#include <linux/slab.h>
Rafael J. Wysocki7b199812013-11-11 22:41:56 +010017#include <linux/acpi.h>
Alexandre Courbot53e7cac2013-11-16 21:44:52 +090018#include <linux/gpio/driver.h>
Linus Walleij0a6d3152014-07-24 20:08:55 +020019#include <linux/gpio/machine.h>
Jonas Gorskic771c2f2015-10-11 17:34:15 +020020#include <linux/pinctrl/consumer.h>
Linus Walleij3c702e92015-10-21 15:29:53 +020021#include <linux/fs.h>
Linus Walleij8b92e172016-05-27 14:24:04 +020022#include <linux/compat.h>
Lars-Peter Clausen953b9562016-10-24 13:59:15 +020023#include <linux/file.h>
Linus Walleij3c702e92015-10-21 15:29:53 +020024#include <uapi/linux/gpio.h>
David Brownelld2876d02008-02-04 22:28:20 -080025
Mika Westerberg664e3e52014-01-08 12:40:54 +020026#include "gpiolib.h"
Linus Walleijf626d6d2019-07-17 09:10:01 +020027#include "gpiolib-of.h"
Andy Shevchenko77cb9072019-07-30 13:43:36 +030028#include "gpiolib-acpi.h"
Kent Gibson925ca362020-06-16 17:36:15 +080029#include "gpiolib-cdev.h"
Kent Gibsonef087d82020-07-08 12:15:44 +080030#include "gpiolib-sysfs.h"
Mika Westerberg664e3e52014-01-08 12:40:54 +020031
Uwe Kleine-König3f397c212011-05-20 00:40:19 -060032#define CREATE_TRACE_POINTS
33#include <trace/events/gpio.h>
David Brownelld2876d02008-02-04 22:28:20 -080034
Alexandre Courbot79a9bec2013-10-17 10:21:36 -070035/* Implementation infrastructure for GPIO interfaces.
David Brownelld2876d02008-02-04 22:28:20 -080036 *
Alexandre Courbot79a9bec2013-10-17 10:21:36 -070037 * The GPIO programming interface allows for inlining speed-critical
38 * get/set operations for common cases, so that access to SOC-integrated
39 * GPIOs can sometimes cost only an instruction or two per bit.
David Brownelld2876d02008-02-04 22:28:20 -080040 */
41
42
43/* When debugging, extend minimal trust to callers and platform code.
44 * Also emit diagnostic messages that may help initial bringup, when
45 * board setup or driver bugs are most common.
46 *
47 * Otherwise, minimize overhead in what may be bitbanging codepaths.
48 */
49#ifdef DEBUG
50#define extra_checks 1
51#else
52#define extra_checks 0
53#endif
54
Linus Walleijff2b1352015-10-20 11:10:38 +020055/* Device and char device-related information */
56static DEFINE_IDA(gpio_ida);
Linus Walleij3c702e92015-10-21 15:29:53 +020057static dev_t gpio_devt;
58#define GPIO_DEV_MAX 256 /* 256 GPIO chip devices supported */
59static struct bus_type gpio_bus_type = {
60 .name = "gpio",
61};
Linus Walleijff2b1352015-10-20 11:10:38 +020062
Laura Abbott30277432018-05-21 10:57:07 -070063/*
64 * Number of GPIOs to use for the fast path in set array
65 */
66#define FASTPATH_NGPIO CONFIG_GPIOLIB_FASTPATH_LIMIT
67
David Brownelld2876d02008-02-04 22:28:20 -080068/* gpio_lock prevents conflicts during gpio_desc[] table updates.
69 * While any GPIO is requested, its gpio_chip is not removable;
70 * each GPIO's "requested" flag serves as a lock and refcount.
71 */
Alexandre Courbot0eb4c6c2014-07-01 14:45:15 +090072DEFINE_SPINLOCK(gpio_lock);
David Brownelld2876d02008-02-04 22:28:20 -080073
Alexandre Courbotbae48da2013-10-17 10:21:38 -070074static DEFINE_MUTEX(gpio_lookup_lock);
75static LIST_HEAD(gpio_lookup_list);
Linus Walleijff2b1352015-10-20 11:10:38 +020076LIST_HEAD(gpio_devices);
Johan Hovold6d867502015-05-04 17:23:25 +020077
Bartosz Golaszewskia411e812018-04-10 22:30:28 +020078static DEFINE_MUTEX(gpio_machine_hogs_mutex);
79static LIST_HEAD(gpio_machine_hogs);
80
Linus Walleija0b66a72020-03-29 16:04:05 +020081static void gpiochip_free_hogs(struct gpio_chip *gc);
82static int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Lunn39c3fd52017-12-02 18:11:04 +010083 struct lock_class_key *lock_key,
84 struct lock_class_key *request_key);
Linus Walleija0b66a72020-03-29 16:04:05 +020085static void gpiochip_irqchip_remove(struct gpio_chip *gc);
86static int gpiochip_irqchip_init_hw(struct gpio_chip *gc);
87static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc);
88static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc);
Johan Hovold6d867502015-05-04 17:23:25 +020089
Guenter Roeck159f3cd2016-03-31 08:11:30 -070090static bool gpiolib_initialized;
Johan Hovold6d867502015-05-04 17:23:25 +020091
David Brownelld2876d02008-02-04 22:28:20 -080092static inline void desc_set_label(struct gpio_desc *d, const char *label)
93{
David Brownelld2876d02008-02-04 22:28:20 -080094 d->label = label;
David Brownelld2876d02008-02-04 22:28:20 -080095}
96
Alexandre Courbot372e7222013-02-03 01:29:29 +090097/**
Thierry Reding950d55f52017-07-24 16:57:22 +020098 * gpio_to_desc - Convert a GPIO number to its descriptor
99 * @gpio: global GPIO number
100 *
101 * Returns:
102 * The GPIO descriptor associated with the given GPIO, or %NULL if no GPIO
103 * with the given number exists in the system.
Alexandre Courbot372e7222013-02-03 01:29:29 +0900104 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700105struct gpio_desc *gpio_to_desc(unsigned gpio)
Alexandre Courbot372e7222013-02-03 01:29:29 +0900106{
Linus Walleijff2b1352015-10-20 11:10:38 +0200107 struct gpio_device *gdev;
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900108 unsigned long flags;
109
110 spin_lock_irqsave(&gpio_lock, flags);
111
Linus Walleijff2b1352015-10-20 11:10:38 +0200112 list_for_each_entry(gdev, &gpio_devices, list) {
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100113 if (gdev->base <= gpio &&
114 gdev->base + gdev->ngpio > gpio) {
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900115 spin_unlock_irqrestore(&gpio_lock, flags);
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100116 return &gdev->descs[gpio - gdev->base];
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900117 }
118 }
119
120 spin_unlock_irqrestore(&gpio_lock, flags);
121
Alexandre Courbot0e9a5ed2014-12-02 23:15:05 +0900122 if (!gpio_is_valid(gpio))
Enrico Weigeltc47d9e12020-12-02 14:37:54 +0100123 pr_warn("invalid GPIO %d\n", gpio);
Alexandre Courbot0e9a5ed2014-12-02 23:15:05 +0900124
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900125 return NULL;
Alexandre Courbot372e7222013-02-03 01:29:29 +0900126}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700127EXPORT_SYMBOL_GPL(gpio_to_desc);
Alexandre Courbot372e7222013-02-03 01:29:29 +0900128
129/**
Thierry Reding950d55f52017-07-24 16:57:22 +0200130 * gpiochip_get_desc - get the GPIO descriptor corresponding to the given
131 * hardware number for this chip
Linus Walleija0b66a72020-03-29 16:04:05 +0200132 * @gc: GPIO chip
Thierry Reding950d55f52017-07-24 16:57:22 +0200133 * @hwnum: hardware number of the GPIO for this chip
134 *
135 * Returns:
Mauro Carvalho Chehab35c6cfb2020-03-17 15:54:21 +0100136 * A pointer to the GPIO descriptor or ``ERR_PTR(-EINVAL)`` if no GPIO exists
Thierry Reding950d55f52017-07-24 16:57:22 +0200137 * in the given chip for the specified hardware number.
Linus Walleijd468bf92013-09-24 11:54:38 +0200138 */
Linus Walleija0b66a72020-03-29 16:04:05 +0200139struct gpio_desc *gpiochip_get_desc(struct gpio_chip *gc,
Bartosz Golaszewski06863622019-12-24 13:06:59 +0100140 unsigned int hwnum)
Linus Walleijd468bf92013-09-24 11:54:38 +0200141{
Linus Walleija0b66a72020-03-29 16:04:05 +0200142 struct gpio_device *gdev = gc->gpiodev;
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100143
144 if (hwnum >= gdev->ngpio)
Alexandre Courbotb7d0a282013-12-03 12:31:11 +0900145 return ERR_PTR(-EINVAL);
Linus Walleijd468bf92013-09-24 11:54:38 +0200146
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100147 return &gdev->descs[hwnum];
Linus Walleijd468bf92013-09-24 11:54:38 +0200148}
Marco Felsch97795422020-02-25 10:31:02 +0100149EXPORT_SYMBOL_GPL(gpiochip_get_desc);
Alexandre Courbot372e7222013-02-03 01:29:29 +0900150
151/**
Thierry Reding950d55f52017-07-24 16:57:22 +0200152 * desc_to_gpio - convert a GPIO descriptor to the integer namespace
153 * @desc: GPIO descriptor
154 *
Alexandre Courbot372e7222013-02-03 01:29:29 +0900155 * This should disappear in the future but is needed since we still
Thierry Reding950d55f52017-07-24 16:57:22 +0200156 * use GPIO numbers for error messages and sysfs nodes.
157 *
158 * Returns:
159 * The global GPIO number for the GPIO specified by its descriptor.
Alexandre Courbot372e7222013-02-03 01:29:29 +0900160 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700161int desc_to_gpio(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +0900162{
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100163 return desc->gdev->base + (desc - &desc->gdev->descs[0]);
Alexandre Courbot372e7222013-02-03 01:29:29 +0900164}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700165EXPORT_SYMBOL_GPL(desc_to_gpio);
Alexandre Courbot372e7222013-02-03 01:29:29 +0900166
167
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700168/**
169 * gpiod_to_chip - Return the GPIO chip to which a GPIO descriptor belongs
170 * @desc: descriptor to return the chip of
171 */
172struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +0900173{
Vladimir Zapolskiydd3b9a42017-12-21 18:37:30 +0200174 if (!desc || !desc->gdev)
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100175 return NULL;
176 return desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +0900177}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700178EXPORT_SYMBOL_GPL(gpiod_to_chip);
David Brownelld2876d02008-02-04 22:28:20 -0800179
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700180/* dynamic allocation of GPIOs, e.g. on a hotplugged device */
181static int gpiochip_find_base(int ngpio)
182{
Linus Walleijff2b1352015-10-20 11:10:38 +0200183 struct gpio_device *gdev;
Alexandre Courbot83cabe32013-02-03 01:29:28 +0900184 int base = ARCH_NR_GPIOS - ngpio;
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700185
Linus Walleijff2b1352015-10-20 11:10:38 +0200186 list_for_each_entry_reverse(gdev, &gpio_devices, list) {
Alexandre Courbot83cabe32013-02-03 01:29:28 +0900187 /* found a free space? */
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100188 if (gdev->base + gdev->ngpio <= base)
Alexandre Courbot83cabe32013-02-03 01:29:28 +0900189 break;
190 else
191 /* nope, check the space right before the chip */
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100192 base = gdev->base - ngpio;
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700193 }
194
Alexandre Courbot83cabe32013-02-03 01:29:28 +0900195 if (gpio_is_valid(base)) {
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700196 pr_debug("%s: found new base at %d\n", __func__, base);
Alexandre Courbot83cabe32013-02-03 01:29:28 +0900197 return base;
198 } else {
199 pr_err("%s: cannot find free range\n", __func__);
200 return -ENOSPC;
Anton Vorontsov169b6a72008-04-28 02:14:47 -0700201 }
Anton Vorontsov169b6a72008-04-28 02:14:47 -0700202}
203
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700204/**
205 * gpiod_get_direction - return the current direction of a GPIO
206 * @desc: GPIO to get the direction of
207 *
Wolfram Sang94fc7302018-01-09 12:35:53 +0100208 * Returns 0 for output, 1 for input, or an error code in case of error.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700209 *
210 * This function may sleep if gpiod_cansleep() is true.
211 */
Alexandre Courbot8e53b0f2014-11-25 17:16:31 +0900212int gpiod_get_direction(struct gpio_desc *desc)
Mathias Nyman80b0a602012-10-24 17:25:27 +0300213{
Linus Walleija0b66a72020-03-29 16:04:05 +0200214 struct gpio_chip *gc;
Andy Shevchenko13daf482020-11-09 22:53:16 +0200215 unsigned int offset;
Linus Walleijd377f562019-07-16 11:11:45 +0200216 int ret;
Mathias Nyman80b0a602012-10-24 17:25:27 +0300217
Linus Walleija0b66a72020-03-29 16:04:05 +0200218 gc = gpiod_to_chip(desc);
Alexandre Courbot372e7222013-02-03 01:29:29 +0900219 offset = gpio_chip_hwgpio(desc);
Mathias Nyman80b0a602012-10-24 17:25:27 +0300220
Russell King256efae2019-12-07 16:20:18 +0000221 /*
222 * Open drain emulation using input mode may incorrectly report
223 * input here, fix that up.
224 */
225 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) &&
226 test_bit(FLAG_IS_OUT, &desc->flags))
227 return 0;
228
Linus Walleija0b66a72020-03-29 16:04:05 +0200229 if (!gc->get_direction)
Wolfram Sangd0121b82018-07-11 18:33:19 +0200230 return -ENOTSUPP;
Mathias Nyman80b0a602012-10-24 17:25:27 +0300231
Linus Walleija0b66a72020-03-29 16:04:05 +0200232 ret = gc->get_direction(gc, offset);
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +0200233 if (ret < 0)
234 return ret;
235
236 /* GPIOF_DIR_IN or other positive, otherwise GPIOF_DIR_OUT */
237 if (ret > 0)
Linus Walleijd377f562019-07-16 11:11:45 +0200238 ret = 1;
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +0200239
240 assign_bit(FLAG_IS_OUT, &desc->flags, !ret);
241
Linus Walleijd377f562019-07-16 11:11:45 +0200242 return ret;
Mathias Nyman80b0a602012-10-24 17:25:27 +0300243}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -0700244EXPORT_SYMBOL_GPL(gpiod_get_direction);
Mathias Nyman80b0a602012-10-24 17:25:27 +0300245
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900246/*
247 * Add a new chip to the global chips list, keeping the list of chips sorted
Bamvor Jian Zhangef7c7552015-11-16 13:02:46 +0800248 * by range(means [base, base + ngpio - 1]) order.
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900249 *
250 * Return -EBUSY if the new chip overlaps with some other chip's integer
251 * space.
252 */
Linus Walleijff2b1352015-10-20 11:10:38 +0200253static int gpiodev_add_to_list(struct gpio_device *gdev)
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900254{
Bamvor Jian Zhanga961f9b2016-02-26 22:37:14 +0800255 struct gpio_device *prev, *next;
Linus Walleijff2b1352015-10-20 11:10:38 +0200256
257 if (list_empty(&gpio_devices)) {
Bamvor Jian Zhanga961f9b2016-02-26 22:37:14 +0800258 /* initial entry in list */
Linus Walleijff2b1352015-10-20 11:10:38 +0200259 list_add_tail(&gdev->list, &gpio_devices);
Sudip Mukherjeee28ecca2015-12-27 19:06:50 +0530260 return 0;
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900261 }
262
Bamvor Jian Zhanga961f9b2016-02-26 22:37:14 +0800263 next = list_entry(gpio_devices.next, struct gpio_device, list);
264 if (gdev->base + gdev->ngpio <= next->base) {
265 /* add before first entry */
266 list_add(&gdev->list, &gpio_devices);
Julien Grossholtz96098df2016-01-07 16:46:45 -0500267 return 0;
268 }
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900269
Bamvor Jian Zhanga961f9b2016-02-26 22:37:14 +0800270 prev = list_entry(gpio_devices.prev, struct gpio_device, list);
271 if (prev->base + prev->ngpio <= gdev->base) {
272 /* add behind last entry */
273 list_add_tail(&gdev->list, &gpio_devices);
274 return 0;
275 }
Bamvor Jian Zhangef7c7552015-11-16 13:02:46 +0800276
Bamvor Jian Zhanga961f9b2016-02-26 22:37:14 +0800277 list_for_each_entry_safe(prev, next, &gpio_devices, list) {
278 /* at the end of the list */
279 if (&next->list == &gpio_devices)
280 break;
281
282 /* add between prev and next */
283 if (prev->base + prev->ngpio <= gdev->base
284 && gdev->base + gdev->ngpio <= next->base) {
285 list_add(&gdev->list, &prev->list);
286 return 0;
287 }
288 }
289
290 dev_err(&gdev->dev, "GPIO integer space overlap, cannot add chip\n");
291 return -EBUSY;
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900292}
293
Thierry Reding950d55f52017-07-24 16:57:22 +0200294/*
Linus Walleijf881bab02015-09-23 16:20:43 -0700295 * Convert a GPIO name to its descriptor
Geert Uytterhoeven582838e2020-05-11 12:18:28 +0200296 * Note that there is no guarantee that GPIO names are globally unique!
297 * Hence this function will return, if it exists, a reference to the first GPIO
298 * line found that matches the given name.
Linus Walleijf881bab02015-09-23 16:20:43 -0700299 */
300static struct gpio_desc *gpio_name_to_desc(const char * const name)
301{
Linus Walleijff2b1352015-10-20 11:10:38 +0200302 struct gpio_device *gdev;
Linus Walleijf881bab02015-09-23 16:20:43 -0700303 unsigned long flags;
304
Michał Mirosławee203bb2020-03-15 17:34:34 +0100305 if (!name)
306 return NULL;
307
Linus Walleijf881bab02015-09-23 16:20:43 -0700308 spin_lock_irqsave(&gpio_lock, flags);
309
Linus Walleijff2b1352015-10-20 11:10:38 +0200310 list_for_each_entry(gdev, &gpio_devices, list) {
Linus Walleijf881bab02015-09-23 16:20:43 -0700311 int i;
312
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100313 for (i = 0; i != gdev->ngpio; ++i) {
314 struct gpio_desc *desc = &gdev->descs[i];
Linus Walleijf881bab02015-09-23 16:20:43 -0700315
Michał Mirosławee203bb2020-03-15 17:34:34 +0100316 if (!desc->name)
Linus Walleijf881bab02015-09-23 16:20:43 -0700317 continue;
318
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100319 if (!strcmp(desc->name, name)) {
Linus Walleijf881bab02015-09-23 16:20:43 -0700320 spin_unlock_irqrestore(&gpio_lock, flags);
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100321 return desc;
Linus Walleijf881bab02015-09-23 16:20:43 -0700322 }
323 }
324 }
325
326 spin_unlock_irqrestore(&gpio_lock, flags);
327
328 return NULL;
329}
330
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200331/*
Geert Uytterhoeven582838e2020-05-11 12:18:28 +0200332 * Take the names from gc->names and assign them to their GPIO descriptors.
333 * Warn if a name is already used for a GPIO line on a different GPIO chip.
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200334 *
Geert Uytterhoeven582838e2020-05-11 12:18:28 +0200335 * Note that:
336 * 1. Non-unique names are still accepted,
337 * 2. Name collisions within the same GPIO chip are not reported.
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200338 */
339static int gpiochip_set_desc_names(struct gpio_chip *gc)
340{
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100341 struct gpio_device *gdev = gc->gpiodev;
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200342 int i;
343
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200344 /* First check all names if they are unique */
345 for (i = 0; i != gc->ngpio; ++i) {
346 struct gpio_desc *gpio;
347
348 gpio = gpio_name_to_desc(gc->names[i]);
Linus Walleijf881bab02015-09-23 16:20:43 -0700349 if (gpio)
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100350 dev_warn(&gdev->dev,
Linus Walleij34ffd852015-10-20 11:31:54 +0200351 "Detected name collision for GPIO name '%s'\n",
Linus Walleijf881bab02015-09-23 16:20:43 -0700352 gc->names[i]);
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200353 }
354
355 /* Then add all names to the GPIO descriptors */
356 for (i = 0; i != gc->ngpio; ++i)
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100357 gdev->descs[i].name = gc->names[i];
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200358
359 return 0;
360}
361
Bartosz Golaszewski32fc5aa2020-09-09 10:54:26 +0200362/*
363 * devprop_gpiochip_set_names - Set GPIO line names using device properties
364 * @chip: GPIO chip whose lines should be named, if possible
365 *
366 * Looks for device property "gpio-line-names" and if it exists assigns
367 * GPIO line names for the chip. The memory allocated for the assigned
368 * names belong to the underlying software node and should not be released
369 * by the caller.
370 */
371static int devprop_gpiochip_set_names(struct gpio_chip *chip)
372{
373 struct gpio_device *gdev = chip->gpiodev;
374 struct device *dev = chip->parent;
375 const char **names;
376 int ret, i;
377 int count;
378
Bartosz Golaszewski587823d2020-09-17 09:48:57 +0200379 /* GPIO chip may not have a parent device whose properties we inspect. */
380 if (!dev)
381 return 0;
382
Bartosz Golaszewski32fc5aa2020-09-09 10:54:26 +0200383 count = device_property_string_array_count(dev, "gpio-line-names");
384 if (count < 0)
385 return 0;
386
387 if (count > gdev->ngpio) {
388 dev_warn(&gdev->dev, "gpio-line-names is length %d but should be at most length %d",
389 count, gdev->ngpio);
390 count = gdev->ngpio;
391 }
392
393 names = kcalloc(count, sizeof(*names), GFP_KERNEL);
394 if (!names)
395 return -ENOMEM;
396
397 ret = device_property_read_string_array(dev, "gpio-line-names",
398 names, count);
399 if (ret < 0) {
400 dev_warn(&gdev->dev, "failed to read GPIO line names\n");
401 kfree(names);
402 return ret;
403 }
404
405 for (i = 0; i < count; i++)
406 gdev->descs[i].name = names[i];
407
408 kfree(names);
409
410 return 0;
411}
412
Linus Walleija0b66a72020-03-29 16:04:05 +0200413static unsigned long *gpiochip_allocate_mask(struct gpio_chip *gc)
Stephen Boyde4371f6e2018-03-23 09:34:50 -0700414{
415 unsigned long *p;
416
Linus Walleija0b66a72020-03-29 16:04:05 +0200417 p = bitmap_alloc(gc->ngpio, GFP_KERNEL);
Stephen Boyde4371f6e2018-03-23 09:34:50 -0700418 if (!p)
419 return NULL;
420
421 /* Assume by default all GPIOs are valid */
Linus Walleija0b66a72020-03-29 16:04:05 +0200422 bitmap_fill(p, gc->ngpio);
Stephen Boyde4371f6e2018-03-23 09:34:50 -0700423
424 return p;
425}
426
Linus Walleijf626d6d2019-07-17 09:10:01 +0200427static int gpiochip_alloc_valid_mask(struct gpio_chip *gc)
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700428{
Linus Walleijeb1e8bd2019-08-19 11:30:58 +0200429 if (!(of_gpio_need_valid_mask(gc) || gc->init_valid_mask))
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700430 return 0;
431
Linus Walleijf626d6d2019-07-17 09:10:01 +0200432 gc->valid_mask = gpiochip_allocate_mask(gc);
433 if (!gc->valid_mask)
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700434 return -ENOMEM;
435
436 return 0;
437}
438
Linus Walleijc9fc5af2019-08-19 10:49:04 +0200439static int gpiochip_init_valid_mask(struct gpio_chip *gc)
Ricardo Ribalda Delgadof8ec92a2018-10-05 08:52:58 +0200440{
Linus Walleijc9fc5af2019-08-19 10:49:04 +0200441 if (gc->init_valid_mask)
442 return gc->init_valid_mask(gc,
443 gc->valid_mask,
444 gc->ngpio);
Ricardo Ribalda Delgadof8ec92a2018-10-05 08:52:58 +0200445
446 return 0;
447}
448
Linus Walleija0b66a72020-03-29 16:04:05 +0200449static void gpiochip_free_valid_mask(struct gpio_chip *gc)
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700450{
Linus Walleija0b66a72020-03-29 16:04:05 +0200451 bitmap_free(gc->valid_mask);
452 gc->valid_mask = NULL;
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700453}
454
Andy Shevchenkob056ca12019-11-04 18:09:39 +0200455static int gpiochip_add_pin_ranges(struct gpio_chip *gc)
456{
457 if (gc->add_pin_ranges)
458 return gc->add_pin_ranges(gc);
459
460 return 0;
461}
462
Linus Walleija0b66a72020-03-29 16:04:05 +0200463bool gpiochip_line_is_valid(const struct gpio_chip *gc,
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700464 unsigned int offset)
465{
466 /* No mask means all valid */
Linus Walleija0b66a72020-03-29 16:04:05 +0200467 if (likely(!gc->valid_mask))
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700468 return true;
Linus Walleija0b66a72020-03-29 16:04:05 +0200469 return test_bit(offset, gc->valid_mask);
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700470}
471EXPORT_SYMBOL_GPL(gpiochip_line_is_valid);
472
Linus Walleijff2b1352015-10-20 11:10:38 +0200473static void gpiodevice_release(struct device *dev)
474{
475 struct gpio_device *gdev = dev_get_drvdata(dev);
476
477 list_del(&gdev->list);
Bartosz Golaszewski8d4a85b2020-09-08 15:12:25 +0200478 ida_free(&gpio_ida, gdev->id);
Bartosz Golaszewskifcf273e52017-12-14 15:29:20 +0100479 kfree_const(gdev->label);
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700480 kfree(gdev->descs);
Linus Walleij9efd9e62016-02-09 14:27:42 +0100481 kfree(gdev);
Linus Walleijff2b1352015-10-20 11:10:38 +0200482}
483
Kent Gibson1f5eb8b2020-11-05 18:40:49 +0800484#ifdef CONFIG_GPIO_CDEV
485#define gcdev_register(gdev, devt) gpiolib_cdev_register((gdev), (devt))
486#define gcdev_unregister(gdev) gpiolib_cdev_unregister((gdev))
487#else
488/*
489 * gpiolib_cdev_register() indirectly calls device_add(), which is still
490 * required even when cdev is not selected.
491 */
492#define gcdev_register(gdev, devt) device_add(&(gdev)->dev)
493#define gcdev_unregister(gdev) device_del(&(gdev)->dev)
494#endif
495
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700496static int gpiochip_setup_dev(struct gpio_device *gdev)
497{
Linus Walleijd377f562019-07-16 11:11:45 +0200498 int ret;
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700499
Kent Gibson1f5eb8b2020-11-05 18:40:49 +0800500 ret = gcdev_register(gdev, gpio_devt);
Linus Walleijd377f562019-07-16 11:11:45 +0200501 if (ret)
502 return ret;
Logan Gunthorpe111379d2017-03-17 12:48:12 -0600503
Linus Walleijd377f562019-07-16 11:11:45 +0200504 ret = gpiochip_sysfs_register(gdev);
505 if (ret)
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700506 goto err_remove_device;
507
508 /* From this point, the .release() function cleans up gpio_device */
509 gdev->dev.release = gpiodevice_release;
Geert Uytterhoeven262b9012020-04-24 16:14:32 +0200510 dev_dbg(&gdev->dev, "registered GPIOs %d to %d on %s\n", gdev->base,
511 gdev->base + gdev->ngpio - 1, gdev->chip->label ? : "generic");
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700512
513 return 0;
514
515err_remove_device:
Kent Gibson1f5eb8b2020-11-05 18:40:49 +0800516 gcdev_unregister(gdev);
Linus Walleijd377f562019-07-16 11:11:45 +0200517 return ret;
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700518}
519
Linus Walleija0b66a72020-03-29 16:04:05 +0200520static void gpiochip_machine_hog(struct gpio_chip *gc, struct gpiod_hog *hog)
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200521{
522 struct gpio_desc *desc;
523 int rv;
524
Linus Walleija0b66a72020-03-29 16:04:05 +0200525 desc = gpiochip_get_desc(gc, hog->chip_hwnum);
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200526 if (IS_ERR(desc)) {
Geert Uytterhoeven262b9012020-04-24 16:14:32 +0200527 chip_err(gc, "%s: unable to get GPIO desc: %ld\n", __func__,
528 PTR_ERR(desc));
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200529 return;
530 }
531
Dan Carpenterba3efdf2018-05-01 10:36:39 +0300532 if (test_bit(FLAG_IS_HOGGED, &desc->flags))
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200533 return;
534
535 rv = gpiod_hog(desc, hog->line_name, hog->lflags, hog->dflags);
536 if (rv)
Geert Uytterhoeven262b9012020-04-24 16:14:32 +0200537 gpiod_err(desc, "%s: unable to hog GPIO line (%s:%u): %d\n",
538 __func__, gc->label, hog->chip_hwnum, rv);
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200539}
540
Linus Walleija0b66a72020-03-29 16:04:05 +0200541static void machine_gpiochip_add(struct gpio_chip *gc)
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200542{
543 struct gpiod_hog *hog;
544
545 mutex_lock(&gpio_machine_hogs_mutex);
546
547 list_for_each_entry(hog, &gpio_machine_hogs, list) {
Linus Walleija0b66a72020-03-29 16:04:05 +0200548 if (!strcmp(gc->label, hog->chip_label))
549 gpiochip_machine_hog(gc, hog);
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200550 }
551
552 mutex_unlock(&gpio_machine_hogs_mutex);
553}
554
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700555static void gpiochip_setup_devs(void)
556{
557 struct gpio_device *gdev;
Linus Walleijd377f562019-07-16 11:11:45 +0200558 int ret;
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700559
560 list_for_each_entry(gdev, &gpio_devices, list) {
Linus Walleijd377f562019-07-16 11:11:45 +0200561 ret = gpiochip_setup_dev(gdev);
562 if (ret)
Geert Uytterhoeven262b9012020-04-24 16:14:32 +0200563 dev_err(&gdev->dev,
564 "Failed to initialize gpio device (%d)\n", ret);
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700565 }
566}
567
Linus Walleija0b66a72020-03-29 16:04:05 +0200568int gpiochip_add_data_with_key(struct gpio_chip *gc, void *data,
Andrew Lunn39c3fd52017-12-02 18:11:04 +0100569 struct lock_class_key *lock_key,
570 struct lock_class_key *request_key)
David Brownelld2876d02008-02-04 22:28:20 -0800571{
572 unsigned long flags;
Linus Walleijd377f562019-07-16 11:11:45 +0200573 int ret = 0;
Linus Walleijff2b1352015-10-20 11:10:38 +0200574 unsigned i;
Linus Walleija0b66a72020-03-29 16:04:05 +0200575 int base = gc->base;
Linus Walleijff2b1352015-10-20 11:10:38 +0200576 struct gpio_device *gdev;
David Brownelld2876d02008-02-04 22:28:20 -0800577
Linus Walleijff2b1352015-10-20 11:10:38 +0200578 /*
579 * First: allocate and populate the internal stat container, and
580 * set up the struct device.
581 */
Josh Cartwright969f07b2016-02-17 16:44:15 -0600582 gdev = kzalloc(sizeof(*gdev), GFP_KERNEL);
Linus Walleijff2b1352015-10-20 11:10:38 +0200583 if (!gdev)
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900584 return -ENOMEM;
Linus Walleij3c702e92015-10-21 15:29:53 +0200585 gdev->dev.bus = &gpio_bus_type;
Linus Walleija0b66a72020-03-29 16:04:05 +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;
Thierry Redingacc6e332016-07-05 14:11:14 +0200591 }
592
Linus Walleijff2b1352015-10-20 11:10:38 +0200593#ifdef CONFIG_OF_GPIO
594 /* If the gpiochip has an assigned OF node this takes precedence */
Linus Walleija0b66a72020-03-29 16:04:05 +0200595 if (gc->of_node)
596 gdev->dev.of_node = gc->of_node;
Biju Das6ff04972018-08-06 10:48:01 +0100597 else
Linus Walleija0b66a72020-03-29 16:04:05 +0200598 gc->of_node = gdev->dev.of_node;
Linus Walleijff2b1352015-10-20 11:10:38 +0200599#endif
Thierry Redingacc6e332016-07-05 14:11:14 +0200600
Bartosz Golaszewski8d4a85b2020-09-08 15:12:25 +0200601 gdev->id = ida_alloc(&gpio_ida, GFP_KERNEL);
Linus Walleijff2b1352015-10-20 11:10:38 +0200602 if (gdev->id < 0) {
Linus Walleijd377f562019-07-16 11:11:45 +0200603 ret = gdev->id;
Linus Walleijff2b1352015-10-20 11:10:38 +0200604 goto err_free_gdev;
605 }
Geert Uytterhoevenddd88912019-11-27 09:42:47 +0100606 dev_set_name(&gdev->dev, GPIOCHIP_NAME "%d", gdev->id);
Linus Walleijff2b1352015-10-20 11:10:38 +0200607 device_initialize(&gdev->dev);
608 dev_set_drvdata(&gdev->dev, gdev);
Linus Walleija0b66a72020-03-29 16:04:05 +0200609 if (gc->parent && gc->parent->driver)
610 gdev->owner = gc->parent->driver->owner;
611 else if (gc->owner)
Linus Walleijff2b1352015-10-20 11:10:38 +0200612 /* TODO: remove chip->owner */
Linus Walleija0b66a72020-03-29 16:04:05 +0200613 gdev->owner = gc->owner;
Linus Walleijff2b1352015-10-20 11:10:38 +0200614 else
615 gdev->owner = THIS_MODULE;
David Brownelld2876d02008-02-04 22:28:20 -0800616
Linus Walleija0b66a72020-03-29 16:04:05 +0200617 gdev->descs = kcalloc(gc->ngpio, sizeof(gdev->descs[0]), GFP_KERNEL);
Linus Walleij1c3cdb12016-02-09 13:51:59 +0100618 if (!gdev->descs) {
Linus Walleijd377f562019-07-16 11:11:45 +0200619 ret = -ENOMEM;
Vladimir Zapolskiya05a1402018-11-02 15:39:43 +0200620 goto err_free_ida;
Linus Walleijff2b1352015-10-20 11:10:38 +0200621 }
622
Linus Walleija0b66a72020-03-29 16:04:05 +0200623 if (gc->ngpio == 0) {
624 chip_err(gc, "tried to insert a GPIO chip with zero lines\n");
Linus Walleijd377f562019-07-16 11:11:45 +0200625 ret = -EINVAL;
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700626 goto err_free_descs;
Bamvor Jian Zhang5ed41cc2015-11-16 13:02:47 +0800627 }
Linus Walleijdf4878e2016-02-12 14:48:23 +0100628
Linus Walleija0b66a72020-03-29 16:04:05 +0200629 if (gc->ngpio > FASTPATH_NGPIO)
630 chip_warn(gc, "line cnt %u is greater than fast path cnt %u\n",
631 gc->ngpio, FASTPATH_NGPIO);
Laura Abbott30277432018-05-21 10:57:07 -0700632
Linus Walleija0b66a72020-03-29 16:04:05 +0200633 gdev->label = kstrdup_const(gc->label ?: "unknown", GFP_KERNEL);
Linus Walleijdf4878e2016-02-12 14:48:23 +0100634 if (!gdev->label) {
Linus Walleijd377f562019-07-16 11:11:45 +0200635 ret = -ENOMEM;
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700636 goto err_free_descs;
Linus Walleijdf4878e2016-02-12 14:48:23 +0100637 }
638
Linus Walleija0b66a72020-03-29 16:04:05 +0200639 gdev->ngpio = gc->ngpio;
Linus Walleij43c54ec2016-02-11 11:37:48 +0100640 gdev->data = data;
Bamvor Jian Zhang5ed41cc2015-11-16 13:02:47 +0800641
David Brownelld2876d02008-02-04 22:28:20 -0800642 spin_lock_irqsave(&gpio_lock, flags);
643
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100644 /*
645 * TODO: this allocates a Linux GPIO number base in the global
646 * GPIO numberspace for this chip. In the long run we want to
647 * get *rid* of this numberspace and use only descriptors, but
648 * it may be a pipe dream. It will not happen before we get rid
649 * of the sysfs interface anyways.
650 */
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700651 if (base < 0) {
Linus Walleija0b66a72020-03-29 16:04:05 +0200652 base = gpiochip_find_base(gc->ngpio);
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700653 if (base < 0) {
Linus Walleijd377f562019-07-16 11:11:45 +0200654 ret = base;
Johan Hovold225fce82015-01-12 17:12:25 +0100655 spin_unlock_irqrestore(&gpio_lock, flags);
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700656 goto err_free_label;
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700657 }
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100658 /*
659 * TODO: it should not be necessary to reflect the assigned
660 * base outside of the GPIO subsystem. Go over drivers and
661 * see if anyone makes use of this, else drop this and assign
662 * a poison instead.
663 */
Linus Walleija0b66a72020-03-29 16:04:05 +0200664 gc->base = base;
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700665 }
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100666 gdev->base = base;
Anton Vorontsov8d0aab22008-04-28 02:14:46 -0700667
Linus Walleijd377f562019-07-16 11:11:45 +0200668 ret = gpiodev_add_to_list(gdev);
669 if (ret) {
Johan Hovold05aa5202015-01-12 17:12:26 +0100670 spin_unlock_irqrestore(&gpio_lock, flags);
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700671 goto err_free_label;
Johan Hovold05aa5202015-01-12 17:12:26 +0100672 }
Alexandre Courbot1a989d02013-02-03 01:29:24 +0900673
Linus Walleija0b66a72020-03-29 16:04:05 +0200674 for (i = 0; i < gc->ngpio; i++)
Ricardo Ribalda Delgado767cd172018-10-12 08:11:36 +0200675 gdev->descs[i].gdev = gdev;
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900676
Dan Callaghan207270d2020-01-21 10:12:17 +1000677 spin_unlock_irqrestore(&gpio_lock, flags);
678
Kent Gibson6accc372020-07-08 12:15:51 +0800679 BLOCKING_INIT_NOTIFIER_HEAD(&gdev->notifier);
Bartosz Golaszewski51c10642019-11-22 15:19:21 +0100680
Shiraz Hashimf23f1512012-10-27 15:21:36 +0530681#ifdef CONFIG_PINCTRL
Linus Walleij20ec3e32016-02-11 11:03:06 +0100682 INIT_LIST_HEAD(&gdev->pin_ranges);
Shiraz Hashimf23f1512012-10-27 15:21:36 +0530683#endif
684
Bartosz Golaszewski7cba1a42020-09-09 10:54:25 +0200685 if (gc->names)
686 ret = gpiochip_set_desc_names(gc);
687 else
688 ret = devprop_gpiochip_set_names(gc);
Linus Walleijd377f562019-07-16 11:11:45 +0200689 if (ret)
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200690 goto err_remove_from_list;
691
Linus Walleija0b66a72020-03-29 16:04:05 +0200692 ret = gpiochip_alloc_valid_mask(gc);
Linus Walleijd377f562019-07-16 11:11:45 +0200693 if (ret)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300694 goto err_remove_from_list;
695
Linus Walleija0b66a72020-03-29 16:04:05 +0200696 ret = of_gpiochip_add(gc);
Linus Walleijd377f562019-07-16 11:11:45 +0200697 if (ret)
Linus Walleij48057ed2019-08-20 10:05:27 +0200698 goto err_free_gpiochip_mask;
Tomeu Vizoso28355f82015-07-14 10:29:54 +0200699
Linus Walleija0b66a72020-03-29 16:04:05 +0200700 ret = gpiochip_init_valid_mask(gc);
Linus Walleijd377f562019-07-16 11:11:45 +0200701 if (ret)
Geert Uytterhoeven35779892019-04-24 15:59:33 +0200702 goto err_remove_of_chip;
Ricardo Ribalda Delgadof8ec92a2018-10-05 08:52:58 +0200703
Linus Walleija0b66a72020-03-29 16:04:05 +0200704 for (i = 0; i < gc->ngpio; i++) {
Ricardo Ribalda Delgado3edfb7b2018-10-05 08:53:00 +0200705 struct gpio_desc *desc = &gdev->descs[i];
706
Linus Walleija0b66a72020-03-29 16:04:05 +0200707 if (gc->get_direction && gpiochip_line_is_valid(gc, i)) {
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +0200708 assign_bit(FLAG_IS_OUT,
Linus Walleija0b66a72020-03-29 16:04:05 +0200709 &desc->flags, !gc->get_direction(gc, i));
Chris Packhamd95da992019-07-08 08:35:58 +1200710 } else {
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +0200711 assign_bit(FLAG_IS_OUT,
Linus Walleija0b66a72020-03-29 16:04:05 +0200712 &desc->flags, !gc->direction_input);
Chris Packhamd95da992019-07-08 08:35:58 +1200713 }
Ricardo Ribalda Delgado3edfb7b2018-10-05 08:53:00 +0200714 }
715
Linus Walleija0b66a72020-03-29 16:04:05 +0200716 ret = gpiochip_add_pin_ranges(gc);
Andy Shevchenkob056ca12019-11-04 18:09:39 +0200717 if (ret)
718 goto err_remove_of_chip;
719
Linus Walleija0b66a72020-03-29 16:04:05 +0200720 acpi_gpiochip_add(gc);
Anton Vorontsov391c9702010-06-08 07:48:17 -0600721
Linus Walleija0b66a72020-03-29 16:04:05 +0200722 machine_gpiochip_add(gc);
Bartosz Golaszewskia411e812018-04-10 22:30:28 +0200723
Linus Walleija0b66a72020-03-29 16:04:05 +0200724 ret = gpiochip_irqchip_init_valid_mask(gc);
Andy Shevchenko9411e3a2019-10-09 17:34:44 +0300725 if (ret)
726 goto err_remove_acpi_chip;
727
Linus Walleija0b66a72020-03-29 16:04:05 +0200728 ret = gpiochip_irqchip_init_hw(gc);
Linus Walleijfbdf8d42019-09-06 12:05:35 +0200729 if (ret)
Linus Walleij48057ed2019-08-20 10:05:27 +0200730 goto err_remove_acpi_chip;
731
Linus Walleija0b66a72020-03-29 16:04:05 +0200732 ret = gpiochip_add_irqchip(gc, lock_key, request_key);
Linus Walleijfbdf8d42019-09-06 12:05:35 +0200733 if (ret)
Linus Walleij48057ed2019-08-20 10:05:27 +0200734 goto err_remove_irqchip_mask;
735
Linus Walleij3c702e92015-10-21 15:29:53 +0200736 /*
737 * By first adding the chardev, and then adding the device,
738 * we get a device node entry in sysfs under
739 * /sys/bus/gpio/devices/gpiochipN/dev that can be used for
740 * coldplug of device nodes and other udev business.
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700741 * We can do this only if gpiolib has been initialized.
742 * Otherwise, defer until later.
Linus Walleij3c702e92015-10-21 15:29:53 +0200743 */
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700744 if (gpiolib_initialized) {
Linus Walleijd377f562019-07-16 11:11:45 +0200745 ret = gpiochip_setup_dev(gdev);
746 if (ret)
Linus Walleij48057ed2019-08-20 10:05:27 +0200747 goto err_remove_irqchip;
Guenter Roeck159f3cd2016-03-31 08:11:30 -0700748 }
Anton Vorontsovcedb1882010-06-08 07:48:15 -0600749 return 0;
Zhangfei Gao3bae4812013-06-09 11:08:32 +0800750
Linus Walleij48057ed2019-08-20 10:05:27 +0200751err_remove_irqchip:
Linus Walleija0b66a72020-03-29 16:04:05 +0200752 gpiochip_irqchip_remove(gc);
Linus Walleij48057ed2019-08-20 10:05:27 +0200753err_remove_irqchip_mask:
Linus Walleija0b66a72020-03-29 16:04:05 +0200754 gpiochip_irqchip_free_valid_mask(gc);
Geert Uytterhoeven35779892019-04-24 15:59:33 +0200755err_remove_acpi_chip:
Linus Walleija0b66a72020-03-29 16:04:05 +0200756 acpi_gpiochip_remove(gc);
Geert Uytterhoeven35779892019-04-24 15:59:33 +0200757err_remove_of_chip:
Linus Walleija0b66a72020-03-29 16:04:05 +0200758 gpiochip_free_hogs(gc);
759 of_gpiochip_remove(gc);
Geert Uytterhoeven35779892019-04-24 15:59:33 +0200760err_free_gpiochip_mask:
Linus Walleija0b66a72020-03-29 16:04:05 +0200761 gpiochip_remove_pin_ranges(gc);
762 gpiochip_free_valid_mask(gc);
Markus Pargmann5f3ca732015-08-14 16:11:00 +0200763err_remove_from_list:
Johan Hovold225fce82015-01-12 17:12:25 +0100764 spin_lock_irqsave(&gpio_lock, flags);
Linus Walleijff2b1352015-10-20 11:10:38 +0200765 list_del(&gdev->list);
Zhangfei Gao3bae4812013-06-09 11:08:32 +0800766 spin_unlock_irqrestore(&gpio_lock, flags);
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700767err_free_label:
Bartosz Golaszewskifcf273e52017-12-14 15:29:20 +0100768 kfree_const(gdev->label);
Guenter Roeck476e2fc2016-03-31 08:11:29 -0700769err_free_descs:
770 kfree(gdev->descs);
Vladimir Zapolskiya05a1402018-11-02 15:39:43 +0200771err_free_ida:
Bartosz Golaszewski8d4a85b2020-09-08 15:12:25 +0200772 ida_free(&gpio_ida, gdev->id);
Vladimir Zapolskiya05a1402018-11-02 15:39:43 +0200773err_free_gdev:
David Brownelld2876d02008-02-04 22:28:20 -0800774 /* failures here can mean systems won't boot... */
Grygorii Strashko3cc1fb72020-11-18 16:29:17 +0200775 if (ret != -EPROBE_DEFER) {
776 pr_err("%s: GPIOs %d..%d (%s) failed to register, %d\n", __func__,
777 gdev->base, gdev->base + gdev->ngpio - 1,
778 gc->label ? : "generic", ret);
779 }
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100780 kfree(gdev);
Linus Walleijd377f562019-07-16 11:11:45 +0200781 return ret;
David Brownelld2876d02008-02-04 22:28:20 -0800782}
Thierry Reding959bc7b2017-11-07 19:15:59 +0100783EXPORT_SYMBOL_GPL(gpiochip_add_data_with_key);
David Brownelld2876d02008-02-04 22:28:20 -0800784
785/**
Linus Walleij43c54ec2016-02-11 11:37:48 +0100786 * gpiochip_get_data() - get per-subdriver data for the chip
Linus Walleija0b66a72020-03-29 16:04:05 +0200787 * @gc: GPIO chip
Thierry Reding950d55f52017-07-24 16:57:22 +0200788 *
789 * Returns:
790 * The per-subdriver data for the chip.
Linus Walleij43c54ec2016-02-11 11:37:48 +0100791 */
Linus Walleija0b66a72020-03-29 16:04:05 +0200792void *gpiochip_get_data(struct gpio_chip *gc)
Linus Walleij43c54ec2016-02-11 11:37:48 +0100793{
Linus Walleija0b66a72020-03-29 16:04:05 +0200794 return gc->gpiodev->data;
Linus Walleij43c54ec2016-02-11 11:37:48 +0100795}
796EXPORT_SYMBOL_GPL(gpiochip_get_data);
797
798/**
David Brownelld2876d02008-02-04 22:28:20 -0800799 * gpiochip_remove() - unregister a gpio_chip
Linus Walleija0b66a72020-03-29 16:04:05 +0200800 * @gc: the chip to unregister
David Brownelld2876d02008-02-04 22:28:20 -0800801 *
802 * A gpio_chip with any GPIOs still requested may not be removed.
803 */
Linus Walleija0b66a72020-03-29 16:04:05 +0200804void gpiochip_remove(struct gpio_chip *gc)
David Brownelld2876d02008-02-04 22:28:20 -0800805{
Linus Walleija0b66a72020-03-29 16:04:05 +0200806 struct gpio_device *gdev = gc->gpiodev;
David Brownelld2876d02008-02-04 22:28:20 -0800807 unsigned long flags;
Andy Shevchenko869233f2020-02-25 13:47:25 +0200808 unsigned int i;
David Brownelld2876d02008-02-04 22:28:20 -0800809
Linus Walleijff2b1352015-10-20 11:10:38 +0200810 /* FIXME: should the legacy sysfs handling be moved to gpio_device? */
Linus Walleijafbc4f32016-02-09 13:21:06 +0100811 gpiochip_sysfs_unregister(gdev);
Linus Walleija0b66a72020-03-29 16:04:05 +0200812 gpiochip_free_hogs(gc);
Bamvor Jian Zhangbd203bd2016-02-20 13:13:19 +0800813 /* Numb the device, cancelling all outstanding operations */
814 gdev->chip = NULL;
Linus Walleija0b66a72020-03-29 16:04:05 +0200815 gpiochip_irqchip_remove(gc);
816 acpi_gpiochip_remove(gc);
817 of_gpiochip_remove(gc);
818 gpiochip_remove_pin_ranges(gc);
819 gpiochip_free_valid_mask(gc);
Linus Walleij43c54ec2016-02-11 11:37:48 +0100820 /*
821 * We accept no more calls into the driver from this point, so
822 * NULL the driver data pointer
823 */
824 gdev->data = NULL;
Anton Vorontsov391c9702010-06-08 07:48:17 -0600825
Johan Hovold6798aca2015-01-12 17:12:28 +0100826 spin_lock_irqsave(&gpio_lock, flags);
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100827 for (i = 0; i < gdev->ngpio; i++) {
Linus Walleija0b66a72020-03-29 16:04:05 +0200828 if (gpiochip_is_requested(gc, i))
Andy Shevchenko869233f2020-02-25 13:47:25 +0200829 break;
David Brownelld2876d02008-02-04 22:28:20 -0800830 }
David Brownelld2876d02008-02-04 22:28:20 -0800831 spin_unlock_irqrestore(&gpio_lock, flags);
Alexandre Courbot14e85c02014-11-19 16:51:27 +0900832
Geert Uytterhoevenca18a852020-03-02 09:24:48 +0100833 if (i != gdev->ngpio)
Linus Walleijfdeb8e12016-02-10 10:57:36 +0100834 dev_crit(&gdev->dev,
Linus Walleij58383c782015-11-04 09:56:26 +0100835 "REMOVING GPIOCHIP WITH GPIOS STILL REQUESTED\n");
Johan Hovoldfab28b82015-05-04 17:10:27 +0200836
Linus Walleijff2b1352015-10-20 11:10:38 +0200837 /*
838 * The gpiochip side puts its use of the device to rest here:
839 * if there are no userspace clients, the chardev and device will
840 * be removed, else it will be dangling until the last user is
841 * gone.
842 */
Kent Gibson1f5eb8b2020-11-05 18:40:49 +0800843 gcdev_unregister(gdev);
Linus Walleijff2b1352015-10-20 11:10:38 +0200844 put_device(&gdev->dev);
David Brownelld2876d02008-02-04 22:28:20 -0800845}
846EXPORT_SYMBOL_GPL(gpiochip_remove);
847
Laxman Dewangan0cf32922016-02-15 16:32:09 +0530848/**
Grant Likely594fa262010-06-08 07:48:16 -0600849 * gpiochip_find() - iterator for locating a specific gpio_chip
850 * @data: data to pass to match function
Thierry Reding950d55f52017-07-24 16:57:22 +0200851 * @match: Callback function to check gpio_chip
Grant Likely594fa262010-06-08 07:48:16 -0600852 *
853 * Similar to bus_find_device. It returns a reference to a gpio_chip as
854 * determined by a user supplied @match callback. The callback should return
855 * 0 if the device doesn't match and non-zero if it does. If the callback is
856 * non-zero, this function will return to the caller and not iterate over any
857 * more gpio_chips.
858 */
Grant Likely07ce8ec2012-05-18 23:01:05 -0600859struct gpio_chip *gpiochip_find(void *data,
Linus Walleija0b66a72020-03-29 16:04:05 +0200860 int (*match)(struct gpio_chip *gc,
Grant Likely3d0f7cf2012-05-17 13:54:40 -0600861 void *data))
Grant Likely594fa262010-06-08 07:48:16 -0600862{
Linus Walleijff2b1352015-10-20 11:10:38 +0200863 struct gpio_device *gdev;
Linus Walleija0b66a72020-03-29 16:04:05 +0200864 struct gpio_chip *gc = NULL;
Grant Likely594fa262010-06-08 07:48:16 -0600865 unsigned long flags;
Grant Likely594fa262010-06-08 07:48:16 -0600866
867 spin_lock_irqsave(&gpio_lock, flags);
Linus Walleijff2b1352015-10-20 11:10:38 +0200868 list_for_each_entry(gdev, &gpio_devices, list)
Masahiro Yamadaacf06ff2016-08-12 01:21:58 +0900869 if (gdev->chip && match(gdev->chip, data)) {
Linus Walleija0b66a72020-03-29 16:04:05 +0200870 gc = gdev->chip;
Grant Likely594fa262010-06-08 07:48:16 -0600871 break;
Masahiro Yamadaacf06ff2016-08-12 01:21:58 +0900872 }
Linus Walleijff2b1352015-10-20 11:10:38 +0200873
Grant Likely594fa262010-06-08 07:48:16 -0600874 spin_unlock_irqrestore(&gpio_lock, flags);
875
Linus Walleija0b66a72020-03-29 16:04:05 +0200876 return gc;
Grant Likely594fa262010-06-08 07:48:16 -0600877}
Jean Delvare8fa0c9b2011-05-20 00:40:18 -0600878EXPORT_SYMBOL_GPL(gpiochip_find);
David Brownelld2876d02008-02-04 22:28:20 -0800879
Linus Walleija0b66a72020-03-29 16:04:05 +0200880static int gpiochip_match_name(struct gpio_chip *gc, void *data)
Alexandre Courbot79697ef2013-11-16 21:39:32 +0900881{
882 const char *name = data;
883
Linus Walleija0b66a72020-03-29 16:04:05 +0200884 return !strcmp(gc->label, name);
Alexandre Courbot79697ef2013-11-16 21:39:32 +0900885}
886
887static struct gpio_chip *find_chip_by_name(const char *name)
888{
889 return gpiochip_find((void *)name, gpiochip_match_name);
890}
891
Linus Walleij14250522014-03-25 10:40:18 +0100892#ifdef CONFIG_GPIOLIB_IRQCHIP
893
894/*
895 * The following is irqchip helper code for gpiochips.
896 */
897
Andy Shevchenko9411e3a2019-10-09 17:34:44 +0300898static int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
899{
900 struct gpio_irq_chip *girq = &gc->irq;
901
902 if (!girq->init_hw)
903 return 0;
904
905 return girq->init_hw(gc);
906}
907
Linus Walleij5fbe5b52019-09-04 16:01:04 +0200908static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300909{
Linus Walleij5fbe5b52019-09-04 16:01:04 +0200910 struct gpio_irq_chip *girq = &gc->irq;
911
912 if (!girq->init_valid_mask)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300913 return 0;
914
Linus Walleij5fbe5b52019-09-04 16:01:04 +0200915 girq->valid_mask = gpiochip_allocate_mask(gc);
916 if (!girq->valid_mask)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300917 return -ENOMEM;
918
Linus Walleij5fbe5b52019-09-04 16:01:04 +0200919 girq->init_valid_mask(gc, girq->valid_mask, gc->ngpio);
920
Mika Westerberg79b804c2016-09-20 15:15:21 +0300921 return 0;
922}
923
Linus Walleija0b66a72020-03-29 16:04:05 +0200924static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300925{
Linus Walleija0b66a72020-03-29 16:04:05 +0200926 bitmap_free(gc->irq.valid_mask);
927 gc->irq.valid_mask = NULL;
Mika Westerberg79b804c2016-09-20 15:15:21 +0300928}
929
Linus Walleija0b66a72020-03-29 16:04:05 +0200930bool gpiochip_irqchip_irq_valid(const struct gpio_chip *gc,
Stephen Boyd64ff2c82018-01-09 17:58:46 -0800931 unsigned int offset)
Mika Westerberg79b804c2016-09-20 15:15:21 +0300932{
Linus Walleija0b66a72020-03-29 16:04:05 +0200933 if (!gpiochip_line_is_valid(gc, offset))
Stephen Boyd726cb3b2018-03-23 09:34:52 -0700934 return false;
Mika Westerberg79b804c2016-09-20 15:15:21 +0300935 /* No mask means all valid */
Linus Walleija0b66a72020-03-29 16:04:05 +0200936 if (likely(!gc->irq.valid_mask))
Mika Westerberg79b804c2016-09-20 15:15:21 +0300937 return true;
Linus Walleija0b66a72020-03-29 16:04:05 +0200938 return test_bit(offset, gc->irq.valid_mask);
Mika Westerberg79b804c2016-09-20 15:15:21 +0300939}
Stephen Boyd64ff2c82018-01-09 17:58:46 -0800940EXPORT_SYMBOL_GPL(gpiochip_irqchip_irq_valid);
Mika Westerberg79b804c2016-09-20 15:15:21 +0300941
Linus Walleijfdd61a02019-08-08 14:32:37 +0200942#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
943
944/**
945 * gpiochip_set_hierarchical_irqchip() - connects a hierarchical irqchip
946 * to a gpiochip
947 * @gc: the gpiochip to set the irqchip hierarchical handler to
948 * @irqchip: the irqchip to handle this level of the hierarchy, the interrupt
949 * will then percolate up to the parent
950 */
951static void gpiochip_set_hierarchical_irqchip(struct gpio_chip *gc,
952 struct irq_chip *irqchip)
953{
954 /* DT will deal with mapping each IRQ as we go along */
955 if (is_of_node(gc->irq.fwnode))
956 return;
957
958 /*
959 * This is for legacy and boardfile "irqchip" fwnodes: allocate
960 * irqs upfront instead of dynamically since we don't have the
961 * dynamic type of allocation that hardware description languages
962 * provide. Once all GPIO drivers using board files are gone from
963 * the kernel we can delete this code, but for a transitional period
964 * it is necessary to keep this around.
965 */
966 if (is_fwnode_irqchip(gc->irq.fwnode)) {
967 int i;
968 int ret;
969
970 for (i = 0; i < gc->ngpio; i++) {
971 struct irq_fwspec fwspec;
972 unsigned int parent_hwirq;
973 unsigned int parent_type;
974 struct gpio_irq_chip *girq = &gc->irq;
975
976 /*
977 * We call the child to parent translation function
978 * only to check if the child IRQ is valid or not.
979 * Just pick the rising edge type here as that is what
980 * we likely need to support.
981 */
982 ret = girq->child_to_parent_hwirq(gc, i,
983 IRQ_TYPE_EDGE_RISING,
984 &parent_hwirq,
985 &parent_type);
986 if (ret) {
987 chip_err(gc, "skip set-up on hwirq %d\n",
988 i);
989 continue;
990 }
991
992 fwspec.fwnode = gc->irq.fwnode;
993 /* This is the hwirq for the GPIO line side of things */
994 fwspec.param[0] = girq->child_offset_to_irq(gc, i);
995 /* Just pick something */
996 fwspec.param[1] = IRQ_TYPE_EDGE_RISING;
997 fwspec.param_count = 2;
998 ret = __irq_domain_alloc_irqs(gc->irq.domain,
999 /* just pick something */
1000 -1,
1001 1,
1002 NUMA_NO_NODE,
1003 &fwspec,
1004 false,
1005 NULL);
1006 if (ret < 0) {
1007 chip_err(gc,
1008 "can not allocate irq for GPIO line %d parent hwirq %d in hierarchy domain: %d\n",
1009 i, parent_hwirq,
1010 ret);
1011 }
1012 }
1013 }
1014
1015 chip_err(gc, "%s unknown fwnode type proceed anyway\n", __func__);
1016
1017 return;
1018}
1019
1020static int gpiochip_hierarchy_irq_domain_translate(struct irq_domain *d,
1021 struct irq_fwspec *fwspec,
1022 unsigned long *hwirq,
1023 unsigned int *type)
1024{
1025 /* We support standard DT translation */
1026 if (is_of_node(fwspec->fwnode) && fwspec->param_count == 2) {
1027 return irq_domain_translate_twocell(d, fwspec, hwirq, type);
1028 }
1029
1030 /* This is for board files and others not using DT */
1031 if (is_fwnode_irqchip(fwspec->fwnode)) {
1032 int ret;
1033
1034 ret = irq_domain_translate_twocell(d, fwspec, hwirq, type);
1035 if (ret)
1036 return ret;
1037 WARN_ON(*type == IRQ_TYPE_NONE);
1038 return 0;
1039 }
1040 return -EINVAL;
1041}
1042
1043static int gpiochip_hierarchy_irq_domain_alloc(struct irq_domain *d,
1044 unsigned int irq,
1045 unsigned int nr_irqs,
1046 void *data)
1047{
1048 struct gpio_chip *gc = d->host_data;
1049 irq_hw_number_t hwirq;
1050 unsigned int type = IRQ_TYPE_NONE;
1051 struct irq_fwspec *fwspec = data;
Kevin Hao24258762020-01-14 16:28:19 +08001052 void *parent_arg;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001053 unsigned int parent_hwirq;
1054 unsigned int parent_type;
1055 struct gpio_irq_chip *girq = &gc->irq;
1056 int ret;
1057
1058 /*
1059 * The nr_irqs parameter is always one except for PCI multi-MSI
1060 * so this should not happen.
1061 */
1062 WARN_ON(nr_irqs != 1);
1063
1064 ret = gc->irq.child_irq_domain_ops.translate(d, fwspec, &hwirq, &type);
1065 if (ret)
1066 return ret;
1067
Kevin Hao366950e2020-01-20 17:56:25 +08001068 chip_dbg(gc, "allocate IRQ %d, hwirq %lu\n", irq, hwirq);
Linus Walleijfdd61a02019-08-08 14:32:37 +02001069
1070 ret = girq->child_to_parent_hwirq(gc, hwirq, type,
1071 &parent_hwirq, &parent_type);
1072 if (ret) {
1073 chip_err(gc, "can't look up hwirq %lu\n", hwirq);
1074 return ret;
1075 }
Kevin Hao366950e2020-01-20 17:56:25 +08001076 chip_dbg(gc, "found parent hwirq %u\n", parent_hwirq);
Linus Walleijfdd61a02019-08-08 14:32:37 +02001077
1078 /*
1079 * We set handle_bad_irq because the .set_type() should
1080 * always be invoked and set the right type of handler.
1081 */
1082 irq_domain_set_info(d,
1083 irq,
1084 hwirq,
1085 gc->irq.chip,
1086 gc,
1087 girq->handler,
1088 NULL, NULL);
1089 irq_set_probe(irq);
1090
Linus Walleijfdd61a02019-08-08 14:32:37 +02001091 /* This parent only handles asserted level IRQs */
Kevin Hao24258762020-01-14 16:28:19 +08001092 parent_arg = girq->populate_parent_alloc_arg(gc, parent_hwirq, parent_type);
1093 if (!parent_arg)
1094 return -ENOMEM;
1095
Kevin Hao366950e2020-01-20 17:56:25 +08001096 chip_dbg(gc, "alloc_irqs_parent for %d parent hwirq %d\n",
Linus Walleijfdd61a02019-08-08 14:32:37 +02001097 irq, parent_hwirq);
Stephen Boydc34f6dc2020-01-14 15:11:03 -08001098 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
Kevin Hao24258762020-01-14 16:28:19 +08001099 ret = irq_domain_alloc_irqs_parent(d, irq, 1, parent_arg);
Kevin Hao880b7cf2020-01-14 16:28:20 +08001100 /*
1101 * If the parent irqdomain is msi, the interrupts have already
1102 * been allocated, so the EEXIST is good.
1103 */
1104 if (irq_domain_is_msi(d->parent) && (ret == -EEXIST))
1105 ret = 0;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001106 if (ret)
1107 chip_err(gc,
1108 "failed to allocate parent hwirq %d for hwirq %lu\n",
1109 parent_hwirq, hwirq);
1110
Kevin Hao24258762020-01-14 16:28:19 +08001111 kfree(parent_arg);
Linus Walleijfdd61a02019-08-08 14:32:37 +02001112 return ret;
1113}
1114
Linus Walleija0b66a72020-03-29 16:04:05 +02001115static unsigned int gpiochip_child_offset_to_irq_noop(struct gpio_chip *gc,
Linus Walleijfdd61a02019-08-08 14:32:37 +02001116 unsigned int offset)
1117{
1118 return offset;
1119}
1120
1121static void gpiochip_hierarchy_setup_domain_ops(struct irq_domain_ops *ops)
1122{
1123 ops->activate = gpiochip_irq_domain_activate;
1124 ops->deactivate = gpiochip_irq_domain_deactivate;
1125 ops->alloc = gpiochip_hierarchy_irq_domain_alloc;
1126 ops->free = irq_domain_free_irqs_common;
1127
1128 /*
1129 * We only allow overriding the translate() function for
1130 * hierarchical chips, and this should only be done if the user
1131 * really need something other than 1:1 translation.
1132 */
1133 if (!ops->translate)
1134 ops->translate = gpiochip_hierarchy_irq_domain_translate;
1135}
1136
1137static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1138{
1139 if (!gc->irq.child_to_parent_hwirq ||
1140 !gc->irq.fwnode) {
1141 chip_err(gc, "missing irqdomain vital data\n");
1142 return -EINVAL;
1143 }
1144
1145 if (!gc->irq.child_offset_to_irq)
1146 gc->irq.child_offset_to_irq = gpiochip_child_offset_to_irq_noop;
1147
Kevin Hao24258762020-01-14 16:28:19 +08001148 if (!gc->irq.populate_parent_alloc_arg)
1149 gc->irq.populate_parent_alloc_arg =
Linus Walleijfdd61a02019-08-08 14:32:37 +02001150 gpiochip_populate_parent_fwspec_twocell;
1151
1152 gpiochip_hierarchy_setup_domain_ops(&gc->irq.child_irq_domain_ops);
1153
1154 gc->irq.domain = irq_domain_create_hierarchy(
1155 gc->irq.parent_domain,
1156 0,
1157 gc->ngpio,
1158 gc->irq.fwnode,
1159 &gc->irq.child_irq_domain_ops,
1160 gc);
1161
1162 if (!gc->irq.domain)
1163 return -ENOMEM;
1164
1165 gpiochip_set_hierarchical_irqchip(gc, gc->irq.chip);
1166
1167 return 0;
1168}
1169
1170static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1171{
1172 return !!gc->irq.parent_domain;
1173}
1174
Linus Walleija0b66a72020-03-29 16:04:05 +02001175void *gpiochip_populate_parent_fwspec_twocell(struct gpio_chip *gc,
Linus Walleijfdd61a02019-08-08 14:32:37 +02001176 unsigned int parent_hwirq,
1177 unsigned int parent_type)
1178{
Kevin Hao24258762020-01-14 16:28:19 +08001179 struct irq_fwspec *fwspec;
1180
1181 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1182 if (!fwspec)
1183 return NULL;
1184
Linus Walleija0b66a72020-03-29 16:04:05 +02001185 fwspec->fwnode = gc->irq.parent_domain->fwnode;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001186 fwspec->param_count = 2;
1187 fwspec->param[0] = parent_hwirq;
1188 fwspec->param[1] = parent_type;
Kevin Hao24258762020-01-14 16:28:19 +08001189
1190 return fwspec;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001191}
1192EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_twocell);
1193
Linus Walleija0b66a72020-03-29 16:04:05 +02001194void *gpiochip_populate_parent_fwspec_fourcell(struct gpio_chip *gc,
Linus Walleijfdd61a02019-08-08 14:32:37 +02001195 unsigned int parent_hwirq,
1196 unsigned int parent_type)
1197{
Kevin Hao24258762020-01-14 16:28:19 +08001198 struct irq_fwspec *fwspec;
1199
1200 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1201 if (!fwspec)
1202 return NULL;
1203
Linus Walleija0b66a72020-03-29 16:04:05 +02001204 fwspec->fwnode = gc->irq.parent_domain->fwnode;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001205 fwspec->param_count = 4;
1206 fwspec->param[0] = 0;
1207 fwspec->param[1] = parent_hwirq;
1208 fwspec->param[2] = 0;
1209 fwspec->param[3] = parent_type;
Kevin Hao24258762020-01-14 16:28:19 +08001210
1211 return fwspec;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001212}
1213EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_fourcell);
1214
1215#else
1216
1217static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1218{
1219 return -EINVAL;
1220}
1221
1222static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1223{
1224 return false;
1225}
1226
1227#endif /* CONFIG_IRQ_DOMAIN_HIERARCHY */
1228
Linus Walleijd245b3f2016-11-24 10:57:25 +01001229/**
Linus Walleij14250522014-03-25 10:40:18 +01001230 * gpiochip_irq_map() - maps an IRQ into a GPIO irqchip
1231 * @d: the irqdomain used by this irqchip
1232 * @irq: the global irq number used by this GPIO irqchip irq
1233 * @hwirq: the local IRQ/GPIO line offset on this gpiochip
1234 *
1235 * This function will set up the mapping for a certain IRQ line on a
1236 * gpiochip by assigning the gpiochip as chip data, and using the irqchip
1237 * stored inside the gpiochip.
1238 */
Thierry Reding1b95b4e2017-11-07 19:15:55 +01001239int gpiochip_irq_map(struct irq_domain *d, unsigned int irq,
1240 irq_hw_number_t hwirq)
Linus Walleij14250522014-03-25 10:40:18 +01001241{
Linus Walleija0b66a72020-03-29 16:04:05 +02001242 struct gpio_chip *gc = d->host_data;
Linus Walleijd377f562019-07-16 11:11:45 +02001243 int ret = 0;
Linus Walleij14250522014-03-25 10:40:18 +01001244
Linus Walleija0b66a72020-03-29 16:04:05 +02001245 if (!gpiochip_irqchip_irq_valid(gc, hwirq))
Grygorii Strashkodc749a02017-07-21 11:49:00 -05001246 return -ENXIO;
1247
Linus Walleija0b66a72020-03-29 16:04:05 +02001248 irq_set_chip_data(irq, gc);
Grygorii Strashkoa0a8bcf2015-08-17 15:35:23 +03001249 /*
1250 * This lock class tells lockdep that GPIO irqs are in a different
1251 * category than their parents, so it won't report false recursion.
1252 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001253 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
1254 irq_set_chip_and_handler(irq, gc->irq.chip, gc->irq.handler);
Linus Walleijd245b3f2016-11-24 10:57:25 +01001255 /* Chips that use nested thread handlers have them marked */
Linus Walleija0b66a72020-03-29 16:04:05 +02001256 if (gc->irq.threaded)
Linus Walleij1c8732b2014-04-09 13:34:39 +02001257 irq_set_nested_thread(irq, 1);
Linus Walleij14250522014-03-25 10:40:18 +01001258 irq_set_noprobe(irq);
Rob Herring23393d42015-07-27 15:55:16 -05001259
Linus Walleija0b66a72020-03-29 16:04:05 +02001260 if (gc->irq.num_parents == 1)
1261 ret = irq_set_parent(irq, gc->irq.parents[0]);
1262 else if (gc->irq.map)
1263 ret = irq_set_parent(irq, gc->irq.map[hwirq]);
Thierry Redinge0d89722017-11-07 19:15:54 +01001264
Linus Walleijd377f562019-07-16 11:11:45 +02001265 if (ret < 0)
1266 return ret;
Thierry Redinge0d89722017-11-07 19:15:54 +01001267
Linus Walleij1333b902014-04-23 16:45:12 +02001268 /*
1269 * No set-up of the hardware will happen if IRQ_TYPE_NONE
1270 * is passed as default type.
1271 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001272 if (gc->irq.default_type != IRQ_TYPE_NONE)
1273 irq_set_irq_type(irq, gc->irq.default_type);
Linus Walleij14250522014-03-25 10:40:18 +01001274
1275 return 0;
1276}
Thierry Reding1b95b4e2017-11-07 19:15:55 +01001277EXPORT_SYMBOL_GPL(gpiochip_irq_map);
Linus Walleij14250522014-03-25 10:40:18 +01001278
Thierry Reding1b95b4e2017-11-07 19:15:55 +01001279void gpiochip_irq_unmap(struct irq_domain *d, unsigned int irq)
Linus Walleijc3626fd2014-03-28 20:42:01 +01001280{
Linus Walleija0b66a72020-03-29 16:04:05 +02001281 struct gpio_chip *gc = d->host_data;
Linus Walleij1c8732b2014-04-09 13:34:39 +02001282
Linus Walleija0b66a72020-03-29 16:04:05 +02001283 if (gc->irq.threaded)
Linus Walleij1c8732b2014-04-09 13:34:39 +02001284 irq_set_nested_thread(irq, 0);
Linus Walleijc3626fd2014-03-28 20:42:01 +01001285 irq_set_chip_and_handler(irq, NULL, NULL);
1286 irq_set_chip_data(irq, NULL);
1287}
Thierry Reding1b95b4e2017-11-07 19:15:55 +01001288EXPORT_SYMBOL_GPL(gpiochip_irq_unmap);
Linus Walleijc3626fd2014-03-28 20:42:01 +01001289
Linus Walleij14250522014-03-25 10:40:18 +01001290static const struct irq_domain_ops gpiochip_domain_ops = {
1291 .map = gpiochip_irq_map,
Linus Walleijc3626fd2014-03-28 20:42:01 +01001292 .unmap = gpiochip_irq_unmap,
Linus Walleij14250522014-03-25 10:40:18 +01001293 /* Virtually all GPIO irqchips are twocell:ed */
1294 .xlate = irq_domain_xlate_twocell,
1295};
1296
Linus Walleijfdd61a02019-08-08 14:32:37 +02001297/*
1298 * TODO: move these activate/deactivate in under the hierarchicial
1299 * irqchip implementation as static once SPMI and SSBI (all external
1300 * users) are phased over.
1301 */
Brian Masneyef74f702019-01-19 15:42:42 -05001302/**
1303 * gpiochip_irq_domain_activate() - Lock a GPIO to be used as an IRQ
1304 * @domain: The IRQ domain used by this IRQ chip
1305 * @data: Outermost irq_data associated with the IRQ
1306 * @reserve: If set, only reserve an interrupt vector instead of assigning one
1307 *
1308 * This function is a wrapper that calls gpiochip_lock_as_irq() and is to be
1309 * used as the activate function for the &struct irq_domain_ops. The host_data
1310 * for the IRQ domain must be the &struct gpio_chip.
1311 */
1312int gpiochip_irq_domain_activate(struct irq_domain *domain,
1313 struct irq_data *data, bool reserve)
1314{
Linus Walleija0b66a72020-03-29 16:04:05 +02001315 struct gpio_chip *gc = domain->host_data;
Brian Masneyef74f702019-01-19 15:42:42 -05001316
Linus Walleija0b66a72020-03-29 16:04:05 +02001317 return gpiochip_lock_as_irq(gc, data->hwirq);
Brian Masneyef74f702019-01-19 15:42:42 -05001318}
1319EXPORT_SYMBOL_GPL(gpiochip_irq_domain_activate);
1320
1321/**
1322 * gpiochip_irq_domain_deactivate() - Unlock a GPIO used as an IRQ
1323 * @domain: The IRQ domain used by this IRQ chip
1324 * @data: Outermost irq_data associated with the IRQ
1325 *
1326 * This function is a wrapper that will call gpiochip_unlock_as_irq() and is to
1327 * be used as the deactivate function for the &struct irq_domain_ops. The
1328 * host_data for the IRQ domain must be the &struct gpio_chip.
1329 */
1330void gpiochip_irq_domain_deactivate(struct irq_domain *domain,
1331 struct irq_data *data)
1332{
Linus Walleija0b66a72020-03-29 16:04:05 +02001333 struct gpio_chip *gc = domain->host_data;
Brian Masneyef74f702019-01-19 15:42:42 -05001334
Linus Walleija0b66a72020-03-29 16:04:05 +02001335 return gpiochip_unlock_as_irq(gc, data->hwirq);
Brian Masneyef74f702019-01-19 15:42:42 -05001336}
1337EXPORT_SYMBOL_GPL(gpiochip_irq_domain_deactivate);
1338
Andy Shevchenko13daf482020-11-09 22:53:16 +02001339static int gpiochip_to_irq(struct gpio_chip *gc, unsigned int offset)
Linus Walleij14250522014-03-25 10:40:18 +01001340{
Linus Walleija0b66a72020-03-29 16:04:05 +02001341 struct irq_domain *domain = gc->irq.domain;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001342
Linus Walleija0b66a72020-03-29 16:04:05 +02001343 if (!gpiochip_irqchip_irq_valid(gc, offset))
Grygorii Strashkodc749a02017-07-21 11:49:00 -05001344 return -ENXIO;
Thierry Redinge0d89722017-11-07 19:15:54 +01001345
Linus Walleijfdd61a02019-08-08 14:32:37 +02001346#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1347 if (irq_domain_is_hierarchy(domain)) {
1348 struct irq_fwspec spec;
1349
1350 spec.fwnode = domain->fwnode;
1351 spec.param_count = 2;
Linus Walleija0b66a72020-03-29 16:04:05 +02001352 spec.param[0] = gc->irq.child_offset_to_irq(gc, offset);
Linus Walleijfdd61a02019-08-08 14:32:37 +02001353 spec.param[1] = IRQ_TYPE_NONE;
1354
1355 return irq_create_fwspec_mapping(&spec);
1356 }
1357#endif
1358
1359 return irq_create_mapping(domain, offset);
Linus Walleij14250522014-03-25 10:40:18 +01001360}
1361
Hans Verkuil4e6b8232018-09-08 11:23:14 +02001362static int gpiochip_irq_reqres(struct irq_data *d)
1363{
Linus Walleija0b66a72020-03-29 16:04:05 +02001364 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02001365
Linus Walleija0b66a72020-03-29 16:04:05 +02001366 return gpiochip_reqres_irq(gc, d->hwirq);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02001367}
1368
1369static void gpiochip_irq_relres(struct irq_data *d)
1370{
Linus Walleija0b66a72020-03-29 16:04:05 +02001371 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02001372
Linus Walleija0b66a72020-03-29 16:04:05 +02001373 gpiochip_relres_irq(gc, d->hwirq);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02001374}
1375
Maulik Shaha8173822020-05-23 22:41:10 +05301376static void gpiochip_irq_mask(struct irq_data *d)
1377{
1378 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1379
1380 if (gc->irq.irq_mask)
1381 gc->irq.irq_mask(d);
1382 gpiochip_disable_irq(gc, d->hwirq);
1383}
1384
1385static void gpiochip_irq_unmask(struct irq_data *d)
1386{
1387 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1388
1389 gpiochip_enable_irq(gc, d->hwirq);
1390 if (gc->irq.irq_unmask)
1391 gc->irq.irq_unmask(d);
1392}
1393
Hans Verkuil461c1a72018-09-08 11:23:17 +02001394static void gpiochip_irq_enable(struct irq_data *d)
1395{
Linus Walleija0b66a72020-03-29 16:04:05 +02001396 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Hans Verkuil461c1a72018-09-08 11:23:17 +02001397
Linus Walleija0b66a72020-03-29 16:04:05 +02001398 gpiochip_enable_irq(gc, d->hwirq);
Maulik Shaha8173822020-05-23 22:41:10 +05301399 gc->irq.irq_enable(d);
Hans Verkuil461c1a72018-09-08 11:23:17 +02001400}
1401
1402static void gpiochip_irq_disable(struct irq_data *d)
1403{
Linus Walleija0b66a72020-03-29 16:04:05 +02001404 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
Hans Verkuil461c1a72018-09-08 11:23:17 +02001405
Maulik Shaha8173822020-05-23 22:41:10 +05301406 gc->irq.irq_disable(d);
Linus Walleija0b66a72020-03-29 16:04:05 +02001407 gpiochip_disable_irq(gc, d->hwirq);
Hans Verkuil461c1a72018-09-08 11:23:17 +02001408}
1409
Linus Walleija0b66a72020-03-29 16:04:05 +02001410static void gpiochip_set_irq_hooks(struct gpio_chip *gc)
Hans Verkuilca620f22018-09-08 11:23:15 +02001411{
Linus Walleija0b66a72020-03-29 16:04:05 +02001412 struct irq_chip *irqchip = gc->irq.chip;
Hans Verkuilca620f22018-09-08 11:23:15 +02001413
1414 if (!irqchip->irq_request_resources &&
1415 !irqchip->irq_release_resources) {
1416 irqchip->irq_request_resources = gpiochip_irq_reqres;
1417 irqchip->irq_release_resources = gpiochip_irq_relres;
1418 }
Linus Walleija0b66a72020-03-29 16:04:05 +02001419 if (WARN_ON(gc->irq.irq_enable))
Hans Verkuil461c1a72018-09-08 11:23:17 +02001420 return;
Hans Verkuil171948e2018-09-14 10:36:39 +02001421 /* Check if the irqchip already has this hook... */
Nikita Shubin9d552212020-12-10 10:05:14 +03001422 if (irqchip->irq_enable == gpiochip_irq_enable ||
1423 irqchip->irq_mask == gpiochip_irq_mask) {
Hans Verkuil171948e2018-09-14 10:36:39 +02001424 /*
1425 * ...and if so, give a gentle warning that this is bad
1426 * practice.
1427 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001428 chip_info(gc,
Hans Verkuil171948e2018-09-14 10:36:39 +02001429 "detected irqchip that is shared with multiple gpiochips: please fix the driver.\n");
1430 return;
1431 }
Maulik Shaha8173822020-05-23 22:41:10 +05301432
1433 if (irqchip->irq_disable) {
1434 gc->irq.irq_disable = irqchip->irq_disable;
1435 irqchip->irq_disable = gpiochip_irq_disable;
1436 } else {
1437 gc->irq.irq_mask = irqchip->irq_mask;
1438 irqchip->irq_mask = gpiochip_irq_mask;
1439 }
1440
1441 if (irqchip->irq_enable) {
1442 gc->irq.irq_enable = irqchip->irq_enable;
1443 irqchip->irq_enable = gpiochip_irq_enable;
1444 } else {
1445 gc->irq.irq_unmask = irqchip->irq_unmask;
1446 irqchip->irq_unmask = gpiochip_irq_unmask;
1447 }
Hans Verkuilca620f22018-09-08 11:23:15 +02001448}
1449
Linus Walleij14250522014-03-25 10:40:18 +01001450/**
Thierry Redinge0d89722017-11-07 19:15:54 +01001451 * gpiochip_add_irqchip() - adds an IRQ chip to a GPIO chip
Linus Walleija0b66a72020-03-29 16:04:05 +02001452 * @gc: the GPIO chip to add the IRQ chip to
Andrew Lunn39c3fd52017-12-02 18:11:04 +01001453 * @lock_key: lockdep class for IRQ lock
1454 * @request_key: lockdep class for IRQ request
Thierry Redinge0d89722017-11-07 19:15:54 +01001455 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001456static int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Lunn39c3fd52017-12-02 18:11:04 +01001457 struct lock_class_key *lock_key,
1458 struct lock_class_key *request_key)
Thierry Redinge0d89722017-11-07 19:15:54 +01001459{
Linus Walleija0b66a72020-03-29 16:04:05 +02001460 struct irq_chip *irqchip = gc->irq.chip;
Linus Walleijfdd61a02019-08-08 14:32:37 +02001461 const struct irq_domain_ops *ops = NULL;
Thierry Redinge0d89722017-11-07 19:15:54 +01001462 struct device_node *np;
1463 unsigned int type;
1464 unsigned int i;
1465
1466 if (!irqchip)
1467 return 0;
1468
Linus Walleija0b66a72020-03-29 16:04:05 +02001469 if (gc->irq.parent_handler && gc->can_sleep) {
1470 chip_err(gc, "you cannot have chained interrupts on a chip that may sleep\n");
Thierry Redinge0d89722017-11-07 19:15:54 +01001471 return -EINVAL;
1472 }
1473
Linus Walleija0b66a72020-03-29 16:04:05 +02001474 np = gc->gpiodev->dev.of_node;
1475 type = gc->irq.default_type;
Thierry Redinge0d89722017-11-07 19:15:54 +01001476
1477 /*
1478 * Specifying a default trigger is a terrible idea if DT or ACPI is
1479 * used to configure the interrupts, as you may end up with
1480 * conflicting triggers. Tell the user, and reset to NONE.
1481 */
1482 if (WARN(np && type != IRQ_TYPE_NONE,
1483 "%s: Ignoring %u default trigger\n", np->full_name, type))
1484 type = IRQ_TYPE_NONE;
1485
Linus Walleija0b66a72020-03-29 16:04:05 +02001486 if (has_acpi_companion(gc->parent) && type != IRQ_TYPE_NONE) {
1487 acpi_handle_warn(ACPI_HANDLE(gc->parent),
Thierry Redinge0d89722017-11-07 19:15:54 +01001488 "Ignoring %u default trigger\n", type);
1489 type = IRQ_TYPE_NONE;
1490 }
1491
Linus Walleija0b66a72020-03-29 16:04:05 +02001492 gc->to_irq = gpiochip_to_irq;
1493 gc->irq.default_type = type;
1494 gc->irq.lock_key = lock_key;
1495 gc->irq.request_key = request_key;
Thierry Redinge0d89722017-11-07 19:15:54 +01001496
Linus Walleijfdd61a02019-08-08 14:32:37 +02001497 /* If a parent irqdomain is provided, let's build a hierarchy */
Linus Walleija0b66a72020-03-29 16:04:05 +02001498 if (gpiochip_hierarchy_is_hierarchical(gc)) {
1499 int ret = gpiochip_hierarchy_add_domain(gc);
Linus Walleijfdd61a02019-08-08 14:32:37 +02001500 if (ret)
1501 return ret;
1502 } else {
1503 /* Some drivers provide custom irqdomain ops */
Linus Walleija0b66a72020-03-29 16:04:05 +02001504 if (gc->irq.domain_ops)
1505 ops = gc->irq.domain_ops;
Thierry Redinge0d89722017-11-07 19:15:54 +01001506
Linus Walleijfdd61a02019-08-08 14:32:37 +02001507 if (!ops)
1508 ops = &gpiochip_domain_ops;
Linus Walleija0b66a72020-03-29 16:04:05 +02001509 gc->irq.domain = irq_domain_add_simple(np,
1510 gc->ngpio,
1511 gc->irq.first,
1512 ops, gc);
1513 if (!gc->irq.domain)
Linus Walleijfdd61a02019-08-08 14:32:37 +02001514 return -EINVAL;
1515 }
Thierry Redinge0d89722017-11-07 19:15:54 +01001516
Linus Walleija0b66a72020-03-29 16:04:05 +02001517 if (gc->irq.parent_handler) {
1518 void *data = gc->irq.parent_handler_data ?: gc;
Thierry Redinge0d89722017-11-07 19:15:54 +01001519
Linus Walleija0b66a72020-03-29 16:04:05 +02001520 for (i = 0; i < gc->irq.num_parents; i++) {
Thierry Redinge0d89722017-11-07 19:15:54 +01001521 /*
1522 * The parent IRQ chip is already using the chip_data
1523 * for this IRQ chip, so our callbacks simply use the
1524 * handler_data.
1525 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001526 irq_set_chained_handler_and_data(gc->irq.parents[i],
1527 gc->irq.parent_handler,
Thierry Redinge0d89722017-11-07 19:15:54 +01001528 data);
1529 }
Thierry Redinge0d89722017-11-07 19:15:54 +01001530 }
1531
Linus Walleija0b66a72020-03-29 16:04:05 +02001532 gpiochip_set_irq_hooks(gc);
Hans Verkuilca620f22018-09-08 11:23:15 +02001533
Linus Walleija0b66a72020-03-29 16:04:05 +02001534 acpi_gpiochip_request_interrupts(gc);
Thierry Redinge0d89722017-11-07 19:15:54 +01001535
1536 return 0;
1537}
1538
1539/**
Linus Walleij14250522014-03-25 10:40:18 +01001540 * gpiochip_irqchip_remove() - removes an irqchip added to a gpiochip
Linus Walleija0b66a72020-03-29 16:04:05 +02001541 * @gc: the gpiochip to remove the irqchip from
Linus Walleij14250522014-03-25 10:40:18 +01001542 *
1543 * This is called only from gpiochip_remove()
1544 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001545static void gpiochip_irqchip_remove(struct gpio_chip *gc)
Linus Walleij14250522014-03-25 10:40:18 +01001546{
Linus Walleija0b66a72020-03-29 16:04:05 +02001547 struct irq_chip *irqchip = gc->irq.chip;
Thierry Reding39e5f092017-11-07 19:15:50 +01001548 unsigned int offset;
Linus Walleijc3626fd2014-03-28 20:42:01 +01001549
Linus Walleija0b66a72020-03-29 16:04:05 +02001550 acpi_gpiochip_free_interrupts(gc);
Mika Westerbergafa82fa2014-07-25 09:54:48 +03001551
Linus Walleija0b66a72020-03-29 16:04:05 +02001552 if (irqchip && gc->irq.parent_handler) {
1553 struct gpio_irq_chip *irq = &gc->irq;
Thierry Reding39e5f092017-11-07 19:15:50 +01001554 unsigned int i;
1555
1556 for (i = 0; i < irq->num_parents; i++)
1557 irq_set_chained_handler_and_data(irq->parents[i],
1558 NULL, NULL);
Dmitry Eremin-Solenikov25e4fe92015-05-12 20:12:23 +03001559 }
1560
Linus Walleijc3626fd2014-03-28 20:42:01 +01001561 /* Remove all IRQ mappings and delete the domain */
Linus Walleija0b66a72020-03-29 16:04:05 +02001562 if (gc->irq.domain) {
Thierry Reding39e5f092017-11-07 19:15:50 +01001563 unsigned int irq;
1564
Linus Walleija0b66a72020-03-29 16:04:05 +02001565 for (offset = 0; offset < gc->ngpio; offset++) {
1566 if (!gpiochip_irqchip_irq_valid(gc, offset))
Mika Westerberg79b804c2016-09-20 15:15:21 +03001567 continue;
Thierry Redingf0fbe7b2017-11-07 19:15:47 +01001568
Linus Walleija0b66a72020-03-29 16:04:05 +02001569 irq = irq_find_mapping(gc->irq.domain, offset);
Thierry Redingf0fbe7b2017-11-07 19:15:47 +01001570 irq_dispose_mapping(irq);
Mika Westerberg79b804c2016-09-20 15:15:21 +03001571 }
Thierry Redingf0fbe7b2017-11-07 19:15:47 +01001572
Linus Walleija0b66a72020-03-29 16:04:05 +02001573 irq_domain_remove(gc->irq.domain);
Linus Walleijc3626fd2014-03-28 20:42:01 +01001574 }
Linus Walleij14250522014-03-25 10:40:18 +01001575
Hans Verkuil461c1a72018-09-08 11:23:17 +02001576 if (irqchip) {
1577 if (irqchip->irq_request_resources == gpiochip_irq_reqres) {
1578 irqchip->irq_request_resources = NULL;
1579 irqchip->irq_release_resources = NULL;
1580 }
1581 if (irqchip->irq_enable == gpiochip_irq_enable) {
Linus Walleija0b66a72020-03-29 16:04:05 +02001582 irqchip->irq_enable = gc->irq.irq_enable;
1583 irqchip->irq_disable = gc->irq.irq_disable;
Hans Verkuil461c1a72018-09-08 11:23:17 +02001584 }
Linus Walleij14250522014-03-25 10:40:18 +01001585 }
Linus Walleija0b66a72020-03-29 16:04:05 +02001586 gc->irq.irq_enable = NULL;
1587 gc->irq.irq_disable = NULL;
1588 gc->irq.chip = NULL;
Mika Westerberg79b804c2016-09-20 15:15:21 +03001589
Linus Walleija0b66a72020-03-29 16:04:05 +02001590 gpiochip_irqchip_free_valid_mask(gc);
Linus Walleij14250522014-03-25 10:40:18 +01001591}
1592
1593/**
Michael Walle6a45b0e2020-05-28 16:58:43 +02001594 * gpiochip_irqchip_add_domain() - adds an irqdomain to a gpiochip
1595 * @gc: the gpiochip to add the irqchip to
1596 * @domain: the irqdomain to add to the gpiochip
1597 *
1598 * This function adds an IRQ domain to the gpiochip.
1599 */
1600int gpiochip_irqchip_add_domain(struct gpio_chip *gc,
1601 struct irq_domain *domain)
1602{
1603 if (!domain)
1604 return -EINVAL;
1605
1606 gc->to_irq = gpiochip_to_irq;
1607 gc->irq.domain = domain;
1608
1609 return 0;
1610}
1611EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_domain);
1612
Linus Walleij14250522014-03-25 10:40:18 +01001613#else /* CONFIG_GPIOLIB_IRQCHIP */
1614
Linus Walleija0b66a72020-03-29 16:04:05 +02001615static inline int gpiochip_add_irqchip(struct gpio_chip *gc,
Andrew Lunn39c3fd52017-12-02 18:11:04 +01001616 struct lock_class_key *lock_key,
1617 struct lock_class_key *request_key)
Thierry Redinge0d89722017-11-07 19:15:54 +01001618{
1619 return 0;
1620}
Linus Walleija0b66a72020-03-29 16:04:05 +02001621static void gpiochip_irqchip_remove(struct gpio_chip *gc) {}
Andy Shevchenko9411e3a2019-10-09 17:34:44 +03001622
Linus Walleija0b66a72020-03-29 16:04:05 +02001623static inline int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
Andy Shevchenko9411e3a2019-10-09 17:34:44 +03001624{
1625 return 0;
1626}
1627
Linus Walleija0b66a72020-03-29 16:04:05 +02001628static inline int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
Mika Westerberg79b804c2016-09-20 15:15:21 +03001629{
1630 return 0;
1631}
Linus Walleija0b66a72020-03-29 16:04:05 +02001632static inline void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
Mika Westerberg79b804c2016-09-20 15:15:21 +03001633{ }
Linus Walleij14250522014-03-25 10:40:18 +01001634
1635#endif /* CONFIG_GPIOLIB_IRQCHIP */
1636
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001637/**
1638 * gpiochip_generic_request() - request the gpio function for a pin
Linus Walleija0b66a72020-03-29 16:04:05 +02001639 * @gc: the gpiochip owning the GPIO
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001640 * @offset: the offset of the GPIO to request for GPIO function
1641 */
Andy Shevchenko13daf482020-11-09 22:53:16 +02001642int gpiochip_generic_request(struct gpio_chip *gc, unsigned int offset)
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001643{
Thierry Reding89ad5562020-03-30 11:02:57 +02001644#ifdef CONFIG_PINCTRL
Linus Walleija0b66a72020-03-29 16:04:05 +02001645 if (list_empty(&gc->gpiodev->pin_ranges))
Thierry Reding89ad5562020-03-30 11:02:57 +02001646 return 0;
1647#endif
Thierry Reding2ab73c62020-03-19 13:27:29 +01001648
Linus Walleija0b66a72020-03-29 16:04:05 +02001649 return pinctrl_gpio_request(gc->gpiodev->base + offset);
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001650}
1651EXPORT_SYMBOL_GPL(gpiochip_generic_request);
1652
1653/**
1654 * gpiochip_generic_free() - free the gpio function from a pin
Linus Walleija0b66a72020-03-29 16:04:05 +02001655 * @gc: the gpiochip to request the gpio function for
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001656 * @offset: the offset of the GPIO to free from GPIO function
1657 */
Andy Shevchenko13daf482020-11-09 22:53:16 +02001658void gpiochip_generic_free(struct gpio_chip *gc, unsigned int offset)
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001659{
Linus Walleija0b66a72020-03-29 16:04:05 +02001660 pinctrl_gpio_free(gc->gpiodev->base + offset);
Jonas Gorskic771c2f2015-10-11 17:34:15 +02001661}
1662EXPORT_SYMBOL_GPL(gpiochip_generic_free);
1663
Mika Westerberg2956b5d2017-01-23 15:34:34 +03001664/**
1665 * gpiochip_generic_config() - apply configuration for a pin
Linus Walleija0b66a72020-03-29 16:04:05 +02001666 * @gc: the gpiochip owning the GPIO
Mika Westerberg2956b5d2017-01-23 15:34:34 +03001667 * @offset: the offset of the GPIO to apply the configuration
1668 * @config: the configuration to be applied
1669 */
Andy Shevchenko13daf482020-11-09 22:53:16 +02001670int gpiochip_generic_config(struct gpio_chip *gc, unsigned int offset,
Mika Westerberg2956b5d2017-01-23 15:34:34 +03001671 unsigned long config)
1672{
Linus Walleija0b66a72020-03-29 16:04:05 +02001673 return pinctrl_gpio_set_config(gc->gpiodev->base + offset, config);
Mika Westerberg2956b5d2017-01-23 15:34:34 +03001674}
1675EXPORT_SYMBOL_GPL(gpiochip_generic_config);
1676
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301677#ifdef CONFIG_PINCTRL
Linus Walleij165adc92012-11-06 14:49:39 +01001678
Linus Walleij3f0f8672012-11-20 12:40:15 +01001679/**
Christian Ruppert586a87e2013-10-15 15:37:54 +02001680 * gpiochip_add_pingroup_range() - add a range for GPIO <-> pin mapping
Linus Walleija0b66a72020-03-29 16:04:05 +02001681 * @gc: the gpiochip to add the range for
Tomeu Vizosod32651f2015-06-17 15:42:11 +02001682 * @pctldev: the pin controller to map to
Christian Ruppert586a87e2013-10-15 15:37:54 +02001683 * @gpio_offset: the start offset in the current gpio_chip number space
1684 * @pin_group: name of the pin group inside the pin controller
Christian Lamparter973c1712018-05-21 22:57:39 +02001685 *
1686 * Calling this function directly from a DeviceTree-supported
1687 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1688 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1689 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
Christian Ruppert586a87e2013-10-15 15:37:54 +02001690 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001691int gpiochip_add_pingroup_range(struct gpio_chip *gc,
Christian Ruppert586a87e2013-10-15 15:37:54 +02001692 struct pinctrl_dev *pctldev,
1693 unsigned int gpio_offset, const char *pin_group)
1694{
1695 struct gpio_pin_range *pin_range;
Linus Walleija0b66a72020-03-29 16:04:05 +02001696 struct gpio_device *gdev = gc->gpiodev;
Christian Ruppert586a87e2013-10-15 15:37:54 +02001697 int ret;
1698
1699 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1700 if (!pin_range) {
Linus Walleija0b66a72020-03-29 16:04:05 +02001701 chip_err(gc, "failed to allocate pin ranges\n");
Christian Ruppert586a87e2013-10-15 15:37:54 +02001702 return -ENOMEM;
1703 }
1704
1705 /* Use local offset as range ID */
1706 pin_range->range.id = gpio_offset;
Linus Walleija0b66a72020-03-29 16:04:05 +02001707 pin_range->range.gc = gc;
1708 pin_range->range.name = gc->label;
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001709 pin_range->range.base = gdev->base + gpio_offset;
Christian Ruppert586a87e2013-10-15 15:37:54 +02001710 pin_range->pctldev = pctldev;
1711
1712 ret = pinctrl_get_group_pins(pctldev, pin_group,
1713 &pin_range->range.pins,
1714 &pin_range->range.npins);
Michal Nazarewicz61c63752013-11-13 21:20:39 +01001715 if (ret < 0) {
1716 kfree(pin_range);
Christian Ruppert586a87e2013-10-15 15:37:54 +02001717 return ret;
Michal Nazarewicz61c63752013-11-13 21:20:39 +01001718 }
Christian Ruppert586a87e2013-10-15 15:37:54 +02001719
1720 pinctrl_add_gpio_range(pctldev, &pin_range->range);
1721
Linus Walleija0b66a72020-03-29 16:04:05 +02001722 chip_dbg(gc, "created GPIO range %d->%d ==> %s PINGRP %s\n",
Andy Shevchenko1a2a99c2013-12-05 11:26:24 +02001723 gpio_offset, gpio_offset + pin_range->range.npins - 1,
Christian Ruppert586a87e2013-10-15 15:37:54 +02001724 pinctrl_dev_get_devname(pctldev), pin_group);
1725
Linus Walleij20ec3e32016-02-11 11:03:06 +01001726 list_add_tail(&pin_range->node, &gdev->pin_ranges);
Christian Ruppert586a87e2013-10-15 15:37:54 +02001727
1728 return 0;
1729}
1730EXPORT_SYMBOL_GPL(gpiochip_add_pingroup_range);
1731
1732/**
Linus Walleij3f0f8672012-11-20 12:40:15 +01001733 * gpiochip_add_pin_range() - add a range for GPIO <-> pin mapping
Linus Walleija0b66a72020-03-29 16:04:05 +02001734 * @gc: the gpiochip to add the range for
Thierry Reding950d55f52017-07-24 16:57:22 +02001735 * @pinctl_name: the dev_name() of the pin controller to map to
Linus Walleij316511c2012-11-21 08:48:09 +01001736 * @gpio_offset: the start offset in the current gpio_chip number space
1737 * @pin_offset: the start offset in the pin controller number space
Linus Walleij3f0f8672012-11-20 12:40:15 +01001738 * @npins: the number of pins from the offset of each pin space (GPIO and
1739 * pin controller) to accumulate in this range
Thierry Reding950d55f52017-07-24 16:57:22 +02001740 *
1741 * Returns:
1742 * 0 on success, or a negative error-code on failure.
Christian Lamparter973c1712018-05-21 22:57:39 +02001743 *
1744 * Calling this function directly from a DeviceTree-supported
1745 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1746 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1747 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
Linus Walleij3f0f8672012-11-20 12:40:15 +01001748 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001749int gpiochip_add_pin_range(struct gpio_chip *gc, const char *pinctl_name,
Linus Walleij316511c2012-11-21 08:48:09 +01001750 unsigned int gpio_offset, unsigned int pin_offset,
Linus Walleij3f0f8672012-11-20 12:40:15 +01001751 unsigned int npins)
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301752{
1753 struct gpio_pin_range *pin_range;
Linus Walleija0b66a72020-03-29 16:04:05 +02001754 struct gpio_device *gdev = gc->gpiodev;
Axel Linb4d4b1f2012-11-21 14:33:56 +08001755 int ret;
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301756
Linus Walleij3f0f8672012-11-20 12:40:15 +01001757 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301758 if (!pin_range) {
Linus Walleija0b66a72020-03-29 16:04:05 +02001759 chip_err(gc, "failed to allocate pin ranges\n");
Linus Walleij1e63d7b2012-11-06 16:03:35 +01001760 return -ENOMEM;
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301761 }
1762
Linus Walleij3f0f8672012-11-20 12:40:15 +01001763 /* Use local offset as range ID */
Linus Walleij316511c2012-11-21 08:48:09 +01001764 pin_range->range.id = gpio_offset;
Linus Walleija0b66a72020-03-29 16:04:05 +02001765 pin_range->range.gc = gc;
1766 pin_range->range.name = gc->label;
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001767 pin_range->range.base = gdev->base + gpio_offset;
Linus Walleij316511c2012-11-21 08:48:09 +01001768 pin_range->range.pin_base = pin_offset;
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301769 pin_range->range.npins = npins;
Linus Walleij192c3692012-11-20 14:03:37 +01001770 pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301771 &pin_range->range);
Linus Walleij8f23ca12012-11-20 14:56:25 +01001772 if (IS_ERR(pin_range->pctldev)) {
Axel Linb4d4b1f2012-11-21 14:33:56 +08001773 ret = PTR_ERR(pin_range->pctldev);
Linus Walleija0b66a72020-03-29 16:04:05 +02001774 chip_err(gc, "could not create pin range\n");
Linus Walleij3f0f8672012-11-20 12:40:15 +01001775 kfree(pin_range);
Axel Linb4d4b1f2012-11-21 14:33:56 +08001776 return ret;
Linus Walleij3f0f8672012-11-20 12:40:15 +01001777 }
Linus Walleija0b66a72020-03-29 16:04:05 +02001778 chip_dbg(gc, "created GPIO range %d->%d ==> %s PIN %d->%d\n",
Andy Shevchenko1a2a99c2013-12-05 11:26:24 +02001779 gpio_offset, gpio_offset + npins - 1,
Linus Walleij316511c2012-11-21 08:48:09 +01001780 pinctl_name,
1781 pin_offset, pin_offset + npins - 1);
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301782
Linus Walleij20ec3e32016-02-11 11:03:06 +01001783 list_add_tail(&pin_range->node, &gdev->pin_ranges);
Linus Walleij1e63d7b2012-11-06 16:03:35 +01001784
1785 return 0;
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301786}
Linus Walleij165adc92012-11-06 14:49:39 +01001787EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301788
Linus Walleij3f0f8672012-11-20 12:40:15 +01001789/**
1790 * gpiochip_remove_pin_ranges() - remove all the GPIO <-> pin mappings
Linus Walleija0b66a72020-03-29 16:04:05 +02001791 * @gc: the chip to remove all the mappings for
Linus Walleij3f0f8672012-11-20 12:40:15 +01001792 */
Linus Walleija0b66a72020-03-29 16:04:05 +02001793void gpiochip_remove_pin_ranges(struct gpio_chip *gc)
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301794{
1795 struct gpio_pin_range *pin_range, *tmp;
Linus Walleija0b66a72020-03-29 16:04:05 +02001796 struct gpio_device *gdev = gc->gpiodev;
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301797
Linus Walleij20ec3e32016-02-11 11:03:06 +01001798 list_for_each_entry_safe(pin_range, tmp, &gdev->pin_ranges, node) {
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301799 list_del(&pin_range->node);
1800 pinctrl_remove_gpio_range(pin_range->pctldev,
1801 &pin_range->range);
Linus Walleij3f0f8672012-11-20 12:40:15 +01001802 kfree(pin_range);
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301803 }
1804}
Linus Walleij165adc92012-11-06 14:49:39 +01001805EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
1806
1807#endif /* CONFIG_PINCTRL */
Shiraz Hashimf23f1512012-10-27 15:21:36 +05301808
David Brownelld2876d02008-02-04 22:28:20 -08001809/* These "optional" allocation calls help prevent drivers from stomping
1810 * on each other, and help provide better diagnostics in debugfs.
1811 * They're called even less than the "set direction" calls.
1812 */
Linus Walleijfac9d882017-09-26 20:58:28 +02001813static int gpiod_request_commit(struct gpio_desc *desc, const char *label)
David Brownelld2876d02008-02-04 22:28:20 -08001814{
Linus Walleija0b66a72020-03-29 16:04:05 +02001815 struct gpio_chip *gc = desc->gdev->chip;
Linus Walleijd377f562019-07-16 11:11:45 +02001816 int ret;
David Brownelld2876d02008-02-04 22:28:20 -08001817 unsigned long flags;
Biju Das3789f5a2018-08-07 08:15:18 +01001818 unsigned offset;
David Brownelld2876d02008-02-04 22:28:20 -08001819
Muchun Song18534df2018-11-01 21:12:50 +08001820 if (label) {
1821 label = kstrdup_const(label, GFP_KERNEL);
1822 if (!label)
1823 return -ENOMEM;
1824 }
1825
David Brownelld2876d02008-02-04 22:28:20 -08001826 spin_lock_irqsave(&gpio_lock, flags);
1827
David Brownelld2876d02008-02-04 22:28:20 -08001828 /* NOTE: gpio_request() can be called in early boot,
David Brownell35e8bb52008-10-15 22:03:16 -07001829 * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
David Brownelld2876d02008-02-04 22:28:20 -08001830 */
1831
1832 if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
1833 desc_set_label(desc, label ? : "?");
Guennadi Liakhovetski438d8902008-04-28 02:14:44 -07001834 } else {
Linus Walleijd377f562019-07-16 11:11:45 +02001835 ret = -EBUSY;
Andy Shevchenko95d9f842020-10-21 14:25:37 +03001836 goto out_free_unlock;
David Brownell35e8bb52008-10-15 22:03:16 -07001837 }
1838
Linus Walleija0b66a72020-03-29 16:04:05 +02001839 if (gc->request) {
1840 /* gc->request may sleep */
David Brownell35e8bb52008-10-15 22:03:16 -07001841 spin_unlock_irqrestore(&gpio_lock, flags);
Biju Das3789f5a2018-08-07 08:15:18 +01001842 offset = gpio_chip_hwgpio(desc);
Linus Walleija0b66a72020-03-29 16:04:05 +02001843 if (gpiochip_line_is_valid(gc, offset))
1844 ret = gc->request(gc, offset);
Biju Das3789f5a2018-08-07 08:15:18 +01001845 else
Linus Walleijd377f562019-07-16 11:11:45 +02001846 ret = -EINVAL;
David Brownell35e8bb52008-10-15 22:03:16 -07001847 spin_lock_irqsave(&gpio_lock, flags);
1848
Andy Shevchenko8bbff392020-10-21 14:25:36 +03001849 if (ret) {
David Brownell35e8bb52008-10-15 22:03:16 -07001850 desc_set_label(desc, NULL);
David Brownell35e8bb52008-10-15 22:03:16 -07001851 clear_bit(FLAG_REQUESTED, &desc->flags);
Andy Shevchenko95d9f842020-10-21 14:25:37 +03001852 goto out_free_unlock;
David Brownell35e8bb52008-10-15 22:03:16 -07001853 }
Guennadi Liakhovetski438d8902008-04-28 02:14:44 -07001854 }
Linus Walleija0b66a72020-03-29 16:04:05 +02001855 if (gc->get_direction) {
1856 /* gc->get_direction may sleep */
Mathias Nyman80b0a602012-10-24 17:25:27 +03001857 spin_unlock_irqrestore(&gpio_lock, flags);
Alexandre Courbot372e7222013-02-03 01:29:29 +09001858 gpiod_get_direction(desc);
Mathias Nyman80b0a602012-10-24 17:25:27 +03001859 spin_lock_irqsave(&gpio_lock, flags);
1860 }
Mika Westerberg77c2d792014-03-10 14:54:50 +02001861 spin_unlock_irqrestore(&gpio_lock, flags);
Andy Shevchenko95d9f842020-10-21 14:25:37 +03001862 return 0;
1863
1864out_free_unlock:
1865 spin_unlock_irqrestore(&gpio_lock, flags);
1866 kfree_const(label);
Linus Walleijd377f562019-07-16 11:11:45 +02001867 return ret;
Mika Westerberg77c2d792014-03-10 14:54:50 +02001868}
1869
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001870/*
1871 * This descriptor validation needs to be inserted verbatim into each
1872 * function taking a descriptor, so we need to use a preprocessor
Linus Walleij54d77192016-05-30 16:48:39 +02001873 * macro to avoid endless duplication. If the desc is NULL it is an
1874 * optional GPIO and calls should just bail out.
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001875 */
Rasmus Villemoesa746a232017-12-21 01:27:04 +01001876static int validate_desc(const struct gpio_desc *desc, const char *func)
1877{
1878 if (!desc)
1879 return 0;
1880 if (IS_ERR(desc)) {
1881 pr_warn("%s: invalid GPIO (errorpointer)\n", func);
1882 return PTR_ERR(desc);
1883 }
1884 if (!desc->gdev) {
1885 pr_warn("%s: invalid GPIO (no device)\n", func);
1886 return -EINVAL;
1887 }
1888 if (!desc->gdev->chip) {
1889 dev_warn(&desc->gdev->dev,
1890 "%s: backing chip is gone\n", func);
1891 return 0;
1892 }
1893 return 1;
1894}
1895
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001896#define VALIDATE_DESC(desc) do { \
Rasmus Villemoesa746a232017-12-21 01:27:04 +01001897 int __valid = validate_desc(desc, __func__); \
1898 if (__valid <= 0) \
1899 return __valid; \
1900 } while (0)
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001901
1902#define VALIDATE_DESC_VOID(desc) do { \
Rasmus Villemoesa746a232017-12-21 01:27:04 +01001903 int __valid = validate_desc(desc, __func__); \
1904 if (__valid <= 0) \
Linus Walleij54d77192016-05-30 16:48:39 +02001905 return; \
Rasmus Villemoesa746a232017-12-21 01:27:04 +01001906 } while (0)
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001907
Alexandre Courbot0eb4c6c2014-07-01 14:45:15 +09001908int gpiod_request(struct gpio_desc *desc, const char *label)
Mika Westerberg77c2d792014-03-10 14:54:50 +02001909{
Linus Walleijd377f562019-07-16 11:11:45 +02001910 int ret = -EPROBE_DEFER;
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001911 struct gpio_device *gdev;
Mika Westerberg77c2d792014-03-10 14:54:50 +02001912
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001913 VALIDATE_DESC(desc);
1914 gdev = desc->gdev;
Mika Westerberg77c2d792014-03-10 14:54:50 +02001915
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001916 if (try_module_get(gdev->owner)) {
Linus Walleijd377f562019-07-16 11:11:45 +02001917 ret = gpiod_request_commit(desc, label);
Andy Shevchenko8bbff392020-10-21 14:25:36 +03001918 if (ret)
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001919 module_put(gdev->owner);
Linus Walleij33a68e82016-02-11 10:28:44 +01001920 else
1921 get_device(&gdev->dev);
Mika Westerberg77c2d792014-03-10 14:54:50 +02001922 }
1923
Linus Walleijd377f562019-07-16 11:11:45 +02001924 if (ret)
1925 gpiod_dbg(desc, "%s: status %d\n", __func__, ret);
Mika Westerberg77c2d792014-03-10 14:54:50 +02001926
Linus Walleijd377f562019-07-16 11:11:45 +02001927 return ret;
David Brownelld2876d02008-02-04 22:28:20 -08001928}
Alexandre Courbot372e7222013-02-03 01:29:29 +09001929
Linus Walleijfac9d882017-09-26 20:58:28 +02001930static bool gpiod_free_commit(struct gpio_desc *desc)
David Brownelld2876d02008-02-04 22:28:20 -08001931{
Mika Westerberg77c2d792014-03-10 14:54:50 +02001932 bool ret = false;
David Brownelld2876d02008-02-04 22:28:20 -08001933 unsigned long flags;
Linus Walleija0b66a72020-03-29 16:04:05 +02001934 struct gpio_chip *gc;
David Brownelld2876d02008-02-04 22:28:20 -08001935
Uwe Kleine-König3d599d12008-10-15 22:03:12 -07001936 might_sleep();
1937
Alexandre Courbot372e7222013-02-03 01:29:29 +09001938 gpiod_unexport(desc);
David Brownelld8f388d82008-07-25 01:46:07 -07001939
David Brownelld2876d02008-02-04 22:28:20 -08001940 spin_lock_irqsave(&gpio_lock, flags);
1941
Linus Walleija0b66a72020-03-29 16:04:05 +02001942 gc = desc->gdev->chip;
1943 if (gc && test_bit(FLAG_REQUESTED, &desc->flags)) {
1944 if (gc->free) {
David Brownell35e8bb52008-10-15 22:03:16 -07001945 spin_unlock_irqrestore(&gpio_lock, flags);
Linus Walleija0b66a72020-03-29 16:04:05 +02001946 might_sleep_if(gc->can_sleep);
1947 gc->free(gc, gpio_chip_hwgpio(desc));
David Brownell35e8bb52008-10-15 22:03:16 -07001948 spin_lock_irqsave(&gpio_lock, flags);
1949 }
Muchun Song18534df2018-11-01 21:12:50 +08001950 kfree_const(desc->label);
David Brownelld2876d02008-02-04 22:28:20 -08001951 desc_set_label(desc, NULL);
Jani Nikula07697462009-12-15 16:46:20 -08001952 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
David Brownell35e8bb52008-10-15 22:03:16 -07001953 clear_bit(FLAG_REQUESTED, &desc->flags);
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05301954 clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
Laxman Dewangan25553ff2012-02-17 20:26:22 +05301955 clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
Drew Fustini9225d512019-11-05 10:04:23 +08001956 clear_bit(FLAG_PULL_UP, &desc->flags);
1957 clear_bit(FLAG_PULL_DOWN, &desc->flags);
Kent Gibson2148ad72019-11-05 10:04:25 +08001958 clear_bit(FLAG_BIAS_DISABLE, &desc->flags);
Kent Gibson73e03412020-09-28 08:27:56 +08001959 clear_bit(FLAG_EDGE_RISING, &desc->flags);
1960 clear_bit(FLAG_EDGE_FALLING, &desc->flags);
Benoit Parrotf625d462015-02-02 11:44:44 -06001961 clear_bit(FLAG_IS_HOGGED, &desc->flags);
Geert Uytterhoeven63636d92020-02-20 14:01:49 +01001962#ifdef CONFIG_OF_DYNAMIC
1963 desc->hog = NULL;
1964#endif
Kent Gibson65cff702020-09-28 08:27:59 +08001965#ifdef CONFIG_GPIO_CDEV
1966 WRITE_ONCE(desc->debounce_period_us, 0);
1967#endif
Mika Westerberg77c2d792014-03-10 14:54:50 +02001968 ret = true;
1969 }
David Brownelld2876d02008-02-04 22:28:20 -08001970
1971 spin_unlock_irqrestore(&gpio_lock, flags);
Kent Gibson6accc372020-07-08 12:15:51 +08001972 blocking_notifier_call_chain(&desc->gdev->notifier,
1973 GPIOLINE_CHANGED_RELEASED, desc);
Bartosz Golaszewski51c10642019-11-22 15:19:21 +01001974
Mika Westerberg77c2d792014-03-10 14:54:50 +02001975 return ret;
1976}
1977
Alexandre Courbot0eb4c6c2014-07-01 14:45:15 +09001978void gpiod_free(struct gpio_desc *desc)
Mika Westerberg77c2d792014-03-10 14:54:50 +02001979{
Linus Walleijfac9d882017-09-26 20:58:28 +02001980 if (desc && desc->gdev && gpiod_free_commit(desc)) {
Linus Walleijfdeb8e12016-02-10 10:57:36 +01001981 module_put(desc->gdev->owner);
Linus Walleij33a68e82016-02-11 10:28:44 +01001982 put_device(&desc->gdev->dev);
1983 } else {
Mika Westerberg77c2d792014-03-10 14:54:50 +02001984 WARN_ON(extra_checks);
Linus Walleij33a68e82016-02-11 10:28:44 +01001985 }
David Brownelld2876d02008-02-04 22:28:20 -08001986}
Alexandre Courbot372e7222013-02-03 01:29:29 +09001987
David Brownelld2876d02008-02-04 22:28:20 -08001988/**
1989 * gpiochip_is_requested - return string iff signal was requested
Linus Walleija0b66a72020-03-29 16:04:05 +02001990 * @gc: controller managing the signal
David Brownelld2876d02008-02-04 22:28:20 -08001991 * @offset: of signal within controller's 0..(ngpio - 1) range
1992 *
1993 * Returns NULL if the GPIO is not currently requested, else a string.
Alexandre Courbot9c8318f2014-07-01 14:45:14 +09001994 * The string returned is the label passed to gpio_request(); if none has been
1995 * passed it is a meaningless, non-NULL constant.
David Brownelld2876d02008-02-04 22:28:20 -08001996 *
1997 * This function is for use by GPIO controller drivers. The label can
1998 * help with diagnostics, and knowing that the signal is used as a GPIO
1999 * can help avoid accidentally multiplexing it to another controller.
2000 */
Andy Shevchenko13daf482020-11-09 22:53:16 +02002001const char *gpiochip_is_requested(struct gpio_chip *gc, unsigned int offset)
David Brownelld2876d02008-02-04 22:28:20 -08002002{
Alexandre Courbot6c0b4e62013-02-03 01:29:30 +09002003 struct gpio_desc *desc;
David Brownelld2876d02008-02-04 22:28:20 -08002004
Linus Walleija0b66a72020-03-29 16:04:05 +02002005 if (offset >= gc->ngpio)
David Brownelld2876d02008-02-04 22:28:20 -08002006 return NULL;
Alexandre Courbot6c0b4e62013-02-03 01:29:30 +09002007
Linus Walleija0b66a72020-03-29 16:04:05 +02002008 desc = gpiochip_get_desc(gc, offset);
Bartosz Golaszewski1739a2d2020-02-19 10:47:02 +01002009 if (IS_ERR(desc))
2010 return NULL;
Alexandre Courbot6c0b4e62013-02-03 01:29:30 +09002011
Alexandre Courbot372e7222013-02-03 01:29:29 +09002012 if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
David Brownelld2876d02008-02-04 22:28:20 -08002013 return NULL;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002014 return desc->label;
David Brownelld2876d02008-02-04 22:28:20 -08002015}
2016EXPORT_SYMBOL_GPL(gpiochip_is_requested);
2017
Mika Westerberg77c2d792014-03-10 14:54:50 +02002018/**
2019 * gpiochip_request_own_desc - Allow GPIO chip to request its own descriptor
Linus Walleija0b66a72020-03-29 16:04:05 +02002020 * @gc: GPIO chip
Thierry Reding950d55f52017-07-24 16:57:22 +02002021 * @hwnum: hardware number of the GPIO for which to request the descriptor
Mika Westerberg77c2d792014-03-10 14:54:50 +02002022 * @label: label for the GPIO
Linus Walleij5923ea62019-04-26 14:40:18 +02002023 * @lflags: lookup flags for this GPIO or 0 if default, this can be used to
2024 * specify things like line inversion semantics with the machine flags
2025 * such as GPIO_OUT_LOW
2026 * @dflags: descriptor request flags for this GPIO or 0 if default, this
2027 * can be used to specify consumer semantics such as open drain
Mika Westerberg77c2d792014-03-10 14:54:50 +02002028 *
2029 * Function allows GPIO chip drivers to request and use their own GPIO
2030 * descriptors via gpiolib API. Difference to gpiod_request() is that this
2031 * function will not increase reference count of the GPIO chip module. This
2032 * allows the GPIO chip module to be unloaded as needed (we assume that the
2033 * GPIO chip driver handles freeing the GPIOs it has requested).
Thierry Reding950d55f52017-07-24 16:57:22 +02002034 *
2035 * Returns:
2036 * A pointer to the GPIO descriptor, or an ERR_PTR()-encoded negative error
2037 * code on failure.
Mika Westerberg77c2d792014-03-10 14:54:50 +02002038 */
Linus Walleija0b66a72020-03-29 16:04:05 +02002039struct gpio_desc *gpiochip_request_own_desc(struct gpio_chip *gc,
Bartosz Golaszewski06863622019-12-24 13:06:59 +01002040 unsigned int hwnum,
Linus Walleij21abf102018-09-04 13:31:45 +02002041 const char *label,
Linus Walleij5923ea62019-04-26 14:40:18 +02002042 enum gpio_lookup_flags lflags,
2043 enum gpiod_flags dflags)
Mika Westerberg77c2d792014-03-10 14:54:50 +02002044{
Linus Walleija0b66a72020-03-29 16:04:05 +02002045 struct gpio_desc *desc = gpiochip_get_desc(gc, hwnum);
Linus Walleijd377f562019-07-16 11:11:45 +02002046 int ret;
Mika Westerberg77c2d792014-03-10 14:54:50 +02002047
Alexandre Courbotabdc08a2014-08-19 10:06:09 -07002048 if (IS_ERR(desc)) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002049 chip_err(gc, "failed to get GPIO descriptor\n");
Alexandre Courbotabdc08a2014-08-19 10:06:09 -07002050 return desc;
2051 }
2052
Linus Walleijd377f562019-07-16 11:11:45 +02002053 ret = gpiod_request_commit(desc, label);
2054 if (ret < 0)
2055 return ERR_PTR(ret);
Alexandre Courbotabdc08a2014-08-19 10:06:09 -07002056
Linus Walleijd377f562019-07-16 11:11:45 +02002057 ret = gpiod_configure_flags(desc, label, lflags, dflags);
2058 if (ret) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002059 chip_err(gc, "setup of own GPIO %s failed\n", label);
Linus Walleij21abf102018-09-04 13:31:45 +02002060 gpiod_free_commit(desc);
Linus Walleijd377f562019-07-16 11:11:45 +02002061 return ERR_PTR(ret);
Linus Walleij21abf102018-09-04 13:31:45 +02002062 }
2063
Alexandre Courbotabdc08a2014-08-19 10:06:09 -07002064 return desc;
Mika Westerberg77c2d792014-03-10 14:54:50 +02002065}
Guenter Roeckf7d4ad92014-07-22 08:01:01 -07002066EXPORT_SYMBOL_GPL(gpiochip_request_own_desc);
Mika Westerberg77c2d792014-03-10 14:54:50 +02002067
2068/**
2069 * gpiochip_free_own_desc - Free GPIO requested by the chip driver
2070 * @desc: GPIO descriptor to free
2071 *
2072 * Function frees the given GPIO requested previously with
2073 * gpiochip_request_own_desc().
2074 */
2075void gpiochip_free_own_desc(struct gpio_desc *desc)
2076{
2077 if (desc)
Linus Walleijfac9d882017-09-26 20:58:28 +02002078 gpiod_free_commit(desc);
Mika Westerberg77c2d792014-03-10 14:54:50 +02002079}
Guenter Roeckf7d4ad92014-07-22 08:01:01 -07002080EXPORT_SYMBOL_GPL(gpiochip_free_own_desc);
David Brownelld2876d02008-02-04 22:28:20 -08002081
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002082/*
2083 * Drivers MUST set GPIO direction before making get/set calls. In
David Brownelld2876d02008-02-04 22:28:20 -08002084 * some cases this is done in early boot, before IRQs are enabled.
2085 *
2086 * As a rule these aren't called more than once (except for drivers
2087 * using the open-drain emulation idiom) so these are natural places
2088 * to accumulate extra debugging checks. Note that we can't (yet)
2089 * rely on gpio_request() having been called beforehand.
2090 */
2091
Bartosz Golaszewskid99f8872020-02-03 14:03:37 +01002092static int gpio_do_set_config(struct gpio_chip *gc, unsigned int offset,
Bartosz Golaszewski62adc6f2020-02-03 14:16:16 +01002093 unsigned long config)
Thomas Petazzoni71479782019-02-07 17:28:56 +01002094{
Bartosz Golaszewskid90f3682019-12-24 13:06:58 +01002095 if (!gc->set_config)
2096 return -ENOTSUPP;
Thomas Petazzoni71479782019-02-07 17:28:56 +01002097
Bartosz Golaszewski62adc6f2020-02-03 14:16:16 +01002098 return gc->set_config(gc, offset, config);
Thomas Petazzoni71479782019-02-07 17:28:56 +01002099}
2100
Andy Shevchenko0c4d8662020-11-09 22:53:20 +02002101static int gpio_set_config_with_argument(struct gpio_desc *desc,
2102 enum pin_config_param mode,
2103 u32 argument)
Bartosz Golaszewskid99f8872020-02-03 14:03:37 +01002104{
Linus Walleija0b66a72020-03-29 16:04:05 +02002105 struct gpio_chip *gc = desc->gdev->chip;
Bartosz Golaszewski91b4ea52020-02-03 14:03:47 +01002106 unsigned long config;
Andy Shevchenko0c4d8662020-11-09 22:53:20 +02002107
2108 config = pinconf_to_config_packed(mode, argument);
2109 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
2110}
2111
Andy Shevchenkobaca3b12020-11-11 20:49:30 +02002112static int gpio_set_config_with_argument_optional(struct gpio_desc *desc,
2113 enum pin_config_param mode,
2114 u32 argument)
2115{
2116 struct device *dev = &desc->gdev->dev;
2117 int gpio = gpio_chip_hwgpio(desc);
2118 int ret;
2119
2120 ret = gpio_set_config_with_argument(desc, mode, argument);
2121 if (ret != -ENOTSUPP)
2122 return ret;
2123
2124 switch (mode) {
2125 case PIN_CONFIG_PERSIST_STATE:
2126 dev_dbg(dev, "Persistence not supported for GPIO %d\n", gpio);
2127 break;
2128 default:
2129 break;
2130 }
2131
2132 return 0;
2133}
2134
Andy Shevchenko0c4d8662020-11-09 22:53:20 +02002135static int gpio_set_config(struct gpio_desc *desc, enum pin_config_param mode)
2136{
Andy Shevchenko6aa32ad2020-11-09 22:53:21 +02002137 return gpio_set_config_with_argument(desc, mode, 0);
Bartosz Golaszewskid99f8872020-02-03 14:03:37 +01002138}
2139
Geert Uytterhoeven5f4bf172020-03-25 11:04:39 +01002140static int gpio_set_bias(struct gpio_desc *desc)
Kent Gibson2148ad72019-11-05 10:04:25 +08002141{
Andy Shevchenko9ef62932020-10-09 21:43:59 +03002142 enum pin_config_param bias;
Andy Shevchenko6aa32ad2020-11-09 22:53:21 +02002143 unsigned int arg;
Kent Gibson2148ad72019-11-05 10:04:25 +08002144
2145 if (test_bit(FLAG_BIAS_DISABLE, &desc->flags))
2146 bias = PIN_CONFIG_BIAS_DISABLE;
2147 else if (test_bit(FLAG_PULL_UP, &desc->flags))
2148 bias = PIN_CONFIG_BIAS_PULL_UP;
2149 else if (test_bit(FLAG_PULL_DOWN, &desc->flags))
2150 bias = PIN_CONFIG_BIAS_PULL_DOWN;
Andy Shevchenko9ef62932020-10-09 21:43:59 +03002151 else
2152 return 0;
Kent Gibson2148ad72019-11-05 10:04:25 +08002153
Andy Shevchenko6aa32ad2020-11-09 22:53:21 +02002154 switch (bias) {
2155 case PIN_CONFIG_BIAS_PULL_DOWN:
2156 case PIN_CONFIG_BIAS_PULL_UP:
2157 arg = 1;
2158 break;
2159
2160 default:
2161 arg = 0;
2162 break;
2163 }
2164
Andy Shevchenkobaca3b12020-11-11 20:49:30 +02002165 return gpio_set_config_with_argument_optional(desc, bias, arg);
Kent Gibson2148ad72019-11-05 10:04:25 +08002166}
2167
Andy Shevchenkof725edd2020-11-09 22:53:23 +02002168int gpio_set_debounce_timeout(struct gpio_desc *desc, unsigned int debounce)
2169{
2170 return gpio_set_config_with_argument_optional(desc,
2171 PIN_CONFIG_INPUT_DEBOUNCE,
2172 debounce);
2173}
2174
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002175/**
2176 * gpiod_direction_input - set the GPIO direction to input
2177 * @desc: GPIO to set to input
2178 *
2179 * Set the direction of the passed GPIO to input, such as gpiod_get_value() can
2180 * be called safely on it.
2181 *
2182 * Return 0 in case of success, else an error code.
2183 */
2184int gpiod_direction_input(struct gpio_desc *desc)
David Brownelld2876d02008-02-04 22:28:20 -08002185{
Linus Walleija0b66a72020-03-29 16:04:05 +02002186 struct gpio_chip *gc;
Linus Walleijd377f562019-07-16 11:11:45 +02002187 int ret = 0;
David Brownelld2876d02008-02-04 22:28:20 -08002188
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002189 VALIDATE_DESC(desc);
Linus Walleija0b66a72020-03-29 16:04:05 +02002190 gc = desc->gdev->chip;
Alexandre Courbotbcabdef2013-02-15 14:46:14 +09002191
Linus Walleije48d1942018-09-25 09:54:14 +02002192 /*
2193 * It is legal to have no .get() and .direction_input() specified if
2194 * the chip is output-only, but you can't specify .direction_input()
2195 * and not support the .get() operation, that doesn't make sense.
2196 */
Linus Walleija0b66a72020-03-29 16:04:05 +02002197 if (!gc->get && gc->direction_input) {
Mark Brown6424de52013-09-09 10:33:49 +01002198 gpiod_warn(desc,
Linus Walleije48d1942018-09-25 09:54:14 +02002199 "%s: missing get() but have direction_input()\n",
2200 __func__);
Linus Walleijbe1a4b12013-08-30 09:41:45 +02002201 return -EIO;
2202 }
2203
Linus Walleije48d1942018-09-25 09:54:14 +02002204 /*
2205 * If we have a .direction_input() callback, things are simple,
2206 * just call it. Else we are some input-only chip so try to check the
2207 * direction (if .get_direction() is supported) else we silently
2208 * assume we are in input mode after this.
2209 */
Linus Walleija0b66a72020-03-29 16:04:05 +02002210 if (gc->direction_input) {
2211 ret = gc->direction_input(gc, gpio_chip_hwgpio(desc));
2212 } else if (gc->get_direction &&
2213 (gc->get_direction(gc, gpio_chip_hwgpio(desc)) != 1)) {
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002214 gpiod_warn(desc,
Linus Walleije48d1942018-09-25 09:54:14 +02002215 "%s: missing direction_input() operation and line is output\n",
2216 __func__);
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002217 return -EIO;
2218 }
Kent Gibson2148ad72019-11-05 10:04:25 +08002219 if (ret == 0) {
David Brownelld2876d02008-02-04 22:28:20 -08002220 clear_bit(FLAG_IS_OUT, &desc->flags);
Geert Uytterhoeven5f4bf172020-03-25 11:04:39 +01002221 ret = gpio_set_bias(desc);
Kent Gibson2148ad72019-11-05 10:04:25 +08002222 }
Thomas Petazzonid4499912019-02-07 17:28:58 +01002223
Linus Walleijd377f562019-07-16 11:11:45 +02002224 trace_gpio_direction(desc_to_gpio(desc), 1, ret);
Alexandre Courbotd82da792014-07-22 16:17:43 +09002225
Linus Walleijd377f562019-07-16 11:11:45 +02002226 return ret;
David Brownelld2876d02008-02-04 22:28:20 -08002227}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002228EXPORT_SYMBOL_GPL(gpiod_direction_input);
Alexandre Courbot372e7222013-02-03 01:29:29 +09002229
Linus Walleijfac9d882017-09-26 20:58:28 +02002230static int gpiod_direction_output_raw_commit(struct gpio_desc *desc, int value)
David Brownelld2876d02008-02-04 22:28:20 -08002231{
Linus Walleijc663e5f2016-03-22 10:51:16 +01002232 struct gpio_chip *gc = desc->gdev->chip;
Linus Walleijad177312016-11-13 23:02:44 +01002233 int val = !!value;
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002234 int ret = 0;
David Brownelld2876d02008-02-04 22:28:20 -08002235
Linus Walleije48d1942018-09-25 09:54:14 +02002236 /*
2237 * It's OK not to specify .direction_output() if the gpiochip is
2238 * output-only, but if there is then not even a .set() operation it
2239 * is pretty tricky to drive the output line.
2240 */
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002241 if (!gc->set && !gc->direction_output) {
Mark Brown6424de52013-09-09 10:33:49 +01002242 gpiod_warn(desc,
Linus Walleije48d1942018-09-25 09:54:14 +02002243 "%s: missing set() and direction_output() operations\n",
2244 __func__);
Linus Walleijbe1a4b12013-08-30 09:41:45 +02002245 return -EIO;
2246 }
2247
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002248 if (gc->direction_output) {
2249 ret = gc->direction_output(gc, gpio_chip_hwgpio(desc), val);
2250 } else {
Linus Walleije48d1942018-09-25 09:54:14 +02002251 /* Check that we are in output mode if we can */
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002252 if (gc->get_direction &&
2253 gc->get_direction(gc, gpio_chip_hwgpio(desc))) {
2254 gpiod_warn(desc,
2255 "%s: missing direction_output() operation\n",
2256 __func__);
2257 return -EIO;
2258 }
Linus Walleije48d1942018-09-25 09:54:14 +02002259 /*
2260 * If we can't actively set the direction, we are some
2261 * output-only chip, so just drive the output as desired.
2262 */
Ricardo Ribalda Delgadoae9847f2018-09-21 12:36:03 +02002263 gc->set(gc, gpio_chip_hwgpio(desc), val);
2264 }
2265
Linus Walleijc663e5f2016-03-22 10:51:16 +01002266 if (!ret)
David Brownelld2876d02008-02-04 22:28:20 -08002267 set_bit(FLAG_IS_OUT, &desc->flags);
Linus Walleijad177312016-11-13 23:02:44 +01002268 trace_gpio_value(desc_to_gpio(desc), 0, val);
Linus Walleijc663e5f2016-03-22 10:51:16 +01002269 trace_gpio_direction(desc_to_gpio(desc), 0, ret);
2270 return ret;
David Brownelld2876d02008-02-04 22:28:20 -08002271}
Philipp Zabelef70bbe2014-01-07 12:34:11 +01002272
2273/**
2274 * gpiod_direction_output_raw - set the GPIO direction to output
2275 * @desc: GPIO to set to output
2276 * @value: initial output value of the GPIO
2277 *
2278 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2279 * be called safely on it. The initial value of the output must be specified
2280 * as raw value on the physical line without regard for the ACTIVE_LOW status.
2281 *
2282 * Return 0 in case of success, else an error code.
2283 */
2284int gpiod_direction_output_raw(struct gpio_desc *desc, int value)
2285{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002286 VALIDATE_DESC(desc);
Linus Walleijfac9d882017-09-26 20:58:28 +02002287 return gpiod_direction_output_raw_commit(desc, value);
Philipp Zabelef70bbe2014-01-07 12:34:11 +01002288}
2289EXPORT_SYMBOL_GPL(gpiod_direction_output_raw);
2290
2291/**
Rahul Bedarkar90df4fe2014-02-08 11:55:25 +05302292 * gpiod_direction_output - set the GPIO direction to output
Philipp Zabelef70bbe2014-01-07 12:34:11 +01002293 * @desc: GPIO to set to output
2294 * @value: initial output value of the GPIO
2295 *
2296 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2297 * be called safely on it. The initial value of the output must be specified
2298 * as the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
2299 * account.
2300 *
2301 * Return 0 in case of success, else an error code.
2302 */
2303int gpiod_direction_output(struct gpio_desc *desc, int value)
2304{
Linus Walleij02e47982017-09-26 21:20:23 +02002305 int ret;
2306
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002307 VALIDATE_DESC(desc);
Philipp Zabelef70bbe2014-01-07 12:34:11 +01002308 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2309 value = !value;
Linus Walleijad177312016-11-13 23:02:44 +01002310 else
2311 value = !!value;
Linus Walleij02e47982017-09-26 21:20:23 +02002312
Hans Verkuil4e9439d2018-09-08 11:23:16 +02002313 /* GPIOs used for enabled IRQs shall not be set as output */
2314 if (test_bit(FLAG_USED_AS_IRQ, &desc->flags) &&
2315 test_bit(FLAG_IRQ_IS_ENABLED, &desc->flags)) {
Linus Walleij02e47982017-09-26 21:20:23 +02002316 gpiod_err(desc,
2317 "%s: tried to set a GPIO tied to an IRQ as output\n",
2318 __func__);
2319 return -EIO;
2320 }
2321
2322 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
2323 /* First see if we can enable open drain in hardware */
Geert Uytterhoeven83522352020-03-25 11:04:38 +01002324 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_DRAIN);
Linus Walleij02e47982017-09-26 21:20:23 +02002325 if (!ret)
2326 goto set_output_value;
2327 /* Emulate open drain by not actively driving the line high */
Bartosz Golaszewskie7352442019-10-01 11:44:53 +02002328 if (value) {
2329 ret = gpiod_direction_input(desc);
2330 goto set_output_flag;
2331 }
Linus Walleij02e47982017-09-26 21:20:23 +02002332 }
2333 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
Geert Uytterhoeven83522352020-03-25 11:04:38 +01002334 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_SOURCE);
Linus Walleij02e47982017-09-26 21:20:23 +02002335 if (!ret)
2336 goto set_output_value;
2337 /* Emulate open source by not actively driving the line low */
Bartosz Golaszewskie7352442019-10-01 11:44:53 +02002338 if (!value) {
2339 ret = gpiod_direction_input(desc);
2340 goto set_output_flag;
2341 }
Linus Walleij02e47982017-09-26 21:20:23 +02002342 } else {
Geert Uytterhoeven83522352020-03-25 11:04:38 +01002343 gpio_set_config(desc, PIN_CONFIG_DRIVE_PUSH_PULL);
Linus Walleij02e47982017-09-26 21:20:23 +02002344 }
2345
2346set_output_value:
Geert Uytterhoeven5f4bf172020-03-25 11:04:39 +01002347 ret = gpio_set_bias(desc);
Kent Gibson2821ae52019-11-05 10:04:26 +08002348 if (ret)
2349 return ret;
Linus Walleijfac9d882017-09-26 20:58:28 +02002350 return gpiod_direction_output_raw_commit(desc, value);
Bartosz Golaszewskie7352442019-10-01 11:44:53 +02002351
2352set_output_flag:
2353 /*
2354 * When emulating open-source or open-drain functionalities by not
2355 * actively driving the line (setting mode to input) we still need to
2356 * set the IS_OUT flag or otherwise we won't be able to set the line
2357 * value anymore.
2358 */
2359 if (ret == 0)
2360 set_bit(FLAG_IS_OUT, &desc->flags);
2361 return ret;
Philipp Zabelef70bbe2014-01-07 12:34:11 +01002362}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002363EXPORT_SYMBOL_GPL(gpiod_direction_output);
David Brownelld2876d02008-02-04 22:28:20 -08002364
Felipe Balbic4b5be92010-05-26 14:42:23 -07002365/**
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002366 * gpiod_set_config - sets @config for a GPIO
2367 * @desc: descriptor of the GPIO for which to set the configuration
2368 * @config: Same packed config format as generic pinconf
2369 *
2370 * Returns:
2371 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2372 * configuration.
2373 */
2374int gpiod_set_config(struct gpio_desc *desc, unsigned long config)
2375{
Linus Walleija0b66a72020-03-29 16:04:05 +02002376 struct gpio_chip *gc;
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002377
2378 VALIDATE_DESC(desc);
Linus Walleija0b66a72020-03-29 16:04:05 +02002379 gc = desc->gdev->chip;
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002380
Linus Walleija0b66a72020-03-29 16:04:05 +02002381 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002382}
2383EXPORT_SYMBOL_GPL(gpiod_set_config);
2384
2385/**
Thierry Reding950d55f52017-07-24 16:57:22 +02002386 * gpiod_set_debounce - sets @debounce time for a GPIO
2387 * @desc: descriptor of the GPIO for which to set debounce time
2388 * @debounce: debounce time in microseconds
Linus Walleij65d87652013-09-04 14:17:08 +02002389 *
Thierry Reding950d55f52017-07-24 16:57:22 +02002390 * Returns:
2391 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2392 * debounce time.
Felipe Balbic4b5be92010-05-26 14:42:23 -07002393 */
Andy Shevchenko13daf482020-11-09 22:53:16 +02002394int gpiod_set_debounce(struct gpio_desc *desc, unsigned int debounce)
Felipe Balbic4b5be92010-05-26 14:42:23 -07002395{
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002396 unsigned long config;
Linus Walleijbe1a4b12013-08-30 09:41:45 +02002397
Mika Westerberg2956b5d2017-01-23 15:34:34 +03002398 config = pinconf_to_config_packed(PIN_CONFIG_INPUT_DEBOUNCE, debounce);
Geert Uytterhoeven8ced32f2020-03-24 14:56:50 +01002399 return gpiod_set_config(desc, config);
Felipe Balbic4b5be92010-05-26 14:42:23 -07002400}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002401EXPORT_SYMBOL_GPL(gpiod_set_debounce);
Alexandre Courbot372e7222013-02-03 01:29:29 +09002402
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002403/**
Andrew Jefferye10f72b2017-11-30 14:25:24 +10302404 * gpiod_set_transitory - Lose or retain GPIO state on suspend or reset
2405 * @desc: descriptor of the GPIO for which to configure persistence
2406 * @transitory: True to lose state on suspend or reset, false for persistence
2407 *
2408 * Returns:
2409 * 0 on success, otherwise a negative error code.
2410 */
2411int gpiod_set_transitory(struct gpio_desc *desc, bool transitory)
2412{
Vladimir Zapolskiy156dd392017-12-21 18:37:35 +02002413 VALIDATE_DESC(desc);
Andrew Jefferye10f72b2017-11-30 14:25:24 +10302414 /*
2415 * Handle FLAG_TRANSITORY first, enabling queries to gpiolib for
2416 * persistence state.
2417 */
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +02002418 assign_bit(FLAG_TRANSITORY, &desc->flags, transitory);
Andrew Jefferye10f72b2017-11-30 14:25:24 +10302419
2420 /* If the driver supports it, set the persistence state now */
Andy Shevchenkobaca3b12020-11-11 20:49:30 +02002421 return gpio_set_config_with_argument_optional(desc,
2422 PIN_CONFIG_PERSIST_STATE,
2423 !transitory);
Andrew Jefferye10f72b2017-11-30 14:25:24 +10302424}
2425EXPORT_SYMBOL_GPL(gpiod_set_transitory);
2426
2427/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002428 * gpiod_is_active_low - test whether a GPIO is active-low or not
2429 * @desc: the gpio descriptor to test
2430 *
2431 * Returns 1 if the GPIO is active-low, 0 otherwise.
2432 */
2433int gpiod_is_active_low(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +09002434{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002435 VALIDATE_DESC(desc);
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002436 return test_bit(FLAG_ACTIVE_LOW, &desc->flags);
Alexandre Courbot372e7222013-02-03 01:29:29 +09002437}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002438EXPORT_SYMBOL_GPL(gpiod_is_active_low);
David Brownelld2876d02008-02-04 22:28:20 -08002439
Michał Mirosławd3a5bcb2019-12-11 03:40:55 +01002440/**
2441 * gpiod_toggle_active_low - toggle whether a GPIO is active-low or not
2442 * @desc: the gpio descriptor to change
2443 */
2444void gpiod_toggle_active_low(struct gpio_desc *desc)
2445{
2446 VALIDATE_DESC_VOID(desc);
2447 change_bit(FLAG_ACTIVE_LOW, &desc->flags);
2448}
2449EXPORT_SYMBOL_GPL(gpiod_toggle_active_low);
2450
David Brownelld2876d02008-02-04 22:28:20 -08002451/* I/O calls are only valid after configuration completed; the relevant
2452 * "is this a valid GPIO" error checks should already have been done.
2453 *
2454 * "Get" operations are often inlinable as reading a pin value register,
2455 * and masking the relevant bit in that register.
2456 *
2457 * When "set" operations are inlinable, they involve writing that mask to
2458 * one register to set a low value, or a different register to set it high.
2459 * Otherwise locking is needed, so there may be little value to inlining.
2460 *
2461 *------------------------------------------------------------------------
2462 *
2463 * IMPORTANT!!! The hot paths -- get/set value -- assume that callers
2464 * have requested the GPIO. That can include implicit requesting by
2465 * a direction setting call. Marking a gpio as requested locks its chip
2466 * in memory, guaranteeing that these table lookups need no more locking
2467 * and that gpiochip_remove() will fail.
2468 *
2469 * REVISIT when debugging, consider adding some instrumentation to ensure
2470 * that the GPIO was actually requested.
2471 */
2472
Linus Walleijfac9d882017-09-26 20:58:28 +02002473static int gpiod_get_raw_value_commit(const struct gpio_desc *desc)
David Brownelld2876d02008-02-04 22:28:20 -08002474{
Linus Walleija0b66a72020-03-29 16:04:05 +02002475 struct gpio_chip *gc;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002476 int offset;
Bjorn Anderssone20538b2015-08-28 09:44:18 -07002477 int value;
David Brownelld2876d02008-02-04 22:28:20 -08002478
Linus Walleija0b66a72020-03-29 16:04:05 +02002479 gc = desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002480 offset = gpio_chip_hwgpio(desc);
Linus Walleija0b66a72020-03-29 16:04:05 +02002481 value = gc->get ? gc->get(gc, offset) : -EIO;
Linus Walleij723a6302015-12-21 23:10:12 +01002482 value = value < 0 ? value : !!value;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002483 trace_gpio_value(desc_to_gpio(desc), 1, value);
Uwe Kleine-König3f397c212011-05-20 00:40:19 -06002484 return value;
David Brownelld2876d02008-02-04 22:28:20 -08002485}
Alexandre Courbot372e7222013-02-03 01:29:29 +09002486
Linus Walleija0b66a72020-03-29 16:04:05 +02002487static int gpio_chip_get_multiple(struct gpio_chip *gc,
Lukas Wunnereec1d562017-10-12 12:40:10 +02002488 unsigned long *mask, unsigned long *bits)
2489{
Linus Walleija0b66a72020-03-29 16:04:05 +02002490 if (gc->get_multiple) {
2491 return gc->get_multiple(gc, mask, bits);
2492 } else if (gc->get) {
Lukas Wunnereec1d562017-10-12 12:40:10 +02002493 int i, value;
2494
Linus Walleija0b66a72020-03-29 16:04:05 +02002495 for_each_set_bit(i, mask, gc->ngpio) {
2496 value = gc->get(gc, i);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002497 if (value < 0)
2498 return value;
2499 __assign_bit(i, bits, value);
2500 }
2501 return 0;
2502 }
2503 return -EIO;
2504}
2505
2506int gpiod_get_array_value_complex(bool raw, bool can_sleep,
2507 unsigned int array_size,
2508 struct gpio_desc **desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002509 struct gpio_array *array_info,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002510 unsigned long *value_bitmap)
Lukas Wunnereec1d562017-10-12 12:40:10 +02002511{
Linus Walleijd377f562019-07-16 11:11:45 +02002512 int ret, i = 0;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002513
2514 /*
2515 * Validate array_info against desc_array and its size.
2516 * It should immediately follow desc_array if both
2517 * have been obtained from the same gpiod_get_array() call.
2518 */
2519 if (array_info && array_info->desc == desc_array &&
2520 array_size <= array_info->size &&
2521 (void *)array_info == desc_array + array_info->size) {
2522 if (!can_sleep)
2523 WARN_ON(array_info->chip->can_sleep);
2524
Linus Walleijd377f562019-07-16 11:11:45 +02002525 ret = gpio_chip_get_multiple(array_info->chip,
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002526 array_info->get_mask,
2527 value_bitmap);
Linus Walleijd377f562019-07-16 11:11:45 +02002528 if (ret)
2529 return ret;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002530
2531 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2532 bitmap_xor(value_bitmap, value_bitmap,
2533 array_info->invert_mask, array_size);
2534
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002535 i = find_first_zero_bit(array_info->get_mask, array_size);
Andy Shevchenkoae66eca2020-06-30 12:21:46 +03002536 if (i == array_size)
2537 return 0;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002538 } else {
2539 array_info = NULL;
2540 }
Lukas Wunnereec1d562017-10-12 12:40:10 +02002541
2542 while (i < array_size) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002543 struct gpio_chip *gc = desc_array[i]->gdev->chip;
Laura Abbott30277432018-05-21 10:57:07 -07002544 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2545 unsigned long *mask, *bits;
Lukas Wunnereec1d562017-10-12 12:40:10 +02002546 int first, j, ret;
2547
Linus Walleija0b66a72020-03-29 16:04:05 +02002548 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
Laura Abbott30277432018-05-21 10:57:07 -07002549 mask = fastpath;
2550 } else {
Linus Walleija0b66a72020-03-29 16:04:05 +02002551 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
Laura Abbott30277432018-05-21 10:57:07 -07002552 sizeof(*mask),
2553 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2554 if (!mask)
2555 return -ENOMEM;
2556 }
2557
Linus Walleija0b66a72020-03-29 16:04:05 +02002558 bits = mask + BITS_TO_LONGS(gc->ngpio);
2559 bitmap_zero(mask, gc->ngpio);
Laura Abbott30277432018-05-21 10:57:07 -07002560
Lukas Wunnereec1d562017-10-12 12:40:10 +02002561 if (!can_sleep)
Linus Walleija0b66a72020-03-29 16:04:05 +02002562 WARN_ON(gc->can_sleep);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002563
2564 /* collect all inputs belonging to the same chip */
2565 first = i;
Lukas Wunnereec1d562017-10-12 12:40:10 +02002566 do {
2567 const struct gpio_desc *desc = desc_array[i];
2568 int hwgpio = gpio_chip_hwgpio(desc);
2569
2570 __set_bit(hwgpio, mask);
2571 i++;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002572
2573 if (array_info)
Janusz Krzysztofik35ae7f92018-09-24 01:53:35 +02002574 i = find_next_zero_bit(array_info->get_mask,
2575 array_size, i);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002576 } while ((i < array_size) &&
Linus Walleija0b66a72020-03-29 16:04:05 +02002577 (desc_array[i]->gdev->chip == gc));
Lukas Wunnereec1d562017-10-12 12:40:10 +02002578
Linus Walleija0b66a72020-03-29 16:04:05 +02002579 ret = gpio_chip_get_multiple(gc, mask, bits);
Laura Abbott30277432018-05-21 10:57:07 -07002580 if (ret) {
2581 if (mask != fastpath)
2582 kfree(mask);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002583 return ret;
Laura Abbott30277432018-05-21 10:57:07 -07002584 }
Lukas Wunnereec1d562017-10-12 12:40:10 +02002585
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002586 for (j = first; j < i; ) {
Lukas Wunnereec1d562017-10-12 12:40:10 +02002587 const struct gpio_desc *desc = desc_array[j];
2588 int hwgpio = gpio_chip_hwgpio(desc);
2589 int value = test_bit(hwgpio, bits);
2590
2591 if (!raw && test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2592 value = !value;
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002593 __assign_bit(j, value_bitmap, value);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002594 trace_gpio_value(desc_to_gpio(desc), 1, value);
Janusz Krzysztofik799d5eb2018-09-29 14:20:22 +02002595 j++;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002596
2597 if (array_info)
Janusz Krzysztofik35ae7f92018-09-24 01:53:35 +02002598 j = find_next_zero_bit(array_info->get_mask, i,
2599 j);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002600 }
Laura Abbott30277432018-05-21 10:57:07 -07002601
2602 if (mask != fastpath)
2603 kfree(mask);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002604 }
2605 return 0;
2606}
2607
David Brownelld2876d02008-02-04 22:28:20 -08002608/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002609 * gpiod_get_raw_value() - return a gpio's raw value
2610 * @desc: gpio whose value will be returned
David Brownelld2876d02008-02-04 22:28:20 -08002611 *
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002612 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
Bjorn Anderssone20538b2015-08-28 09:44:18 -07002613 * its ACTIVE_LOW status, or negative errno on failure.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002614 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002615 * This function can be called from contexts where we cannot sleep, and will
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002616 * complain if the GPIO chip functions potentially sleep.
David Brownelld2876d02008-02-04 22:28:20 -08002617 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002618int gpiod_get_raw_value(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +09002619{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002620 VALIDATE_DESC(desc);
Geert Uytterhoeven3285170f2019-07-01 16:27:38 +02002621 /* Should be using gpiod_get_raw_value_cansleep() */
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002622 WARN_ON(desc->gdev->chip->can_sleep);
Linus Walleijfac9d882017-09-26 20:58:28 +02002623 return gpiod_get_raw_value_commit(desc);
Alexandre Courbot372e7222013-02-03 01:29:29 +09002624}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002625EXPORT_SYMBOL_GPL(gpiod_get_raw_value);
David Brownelld2876d02008-02-04 22:28:20 -08002626
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002627/**
2628 * gpiod_get_value() - return a gpio's value
2629 * @desc: gpio whose value will be returned
2630 *
2631 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
Bjorn Anderssone20538b2015-08-28 09:44:18 -07002632 * account, or negative errno on failure.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002633 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002634 * This function can be called from contexts where we cannot sleep, and will
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002635 * complain if the GPIO chip functions potentially sleep.
2636 */
2637int gpiod_get_value(const struct gpio_desc *desc)
David Brownelld2876d02008-02-04 22:28:20 -08002638{
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002639 int value;
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002640
2641 VALIDATE_DESC(desc);
Geert Uytterhoeven3285170f2019-07-01 16:27:38 +02002642 /* Should be using gpiod_get_value_cansleep() */
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002643 WARN_ON(desc->gdev->chip->can_sleep);
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002644
Linus Walleijfac9d882017-09-26 20:58:28 +02002645 value = gpiod_get_raw_value_commit(desc);
Bjorn Anderssone20538b2015-08-28 09:44:18 -07002646 if (value < 0)
2647 return value;
2648
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002649 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2650 value = !value;
2651
2652 return value;
David Brownelld2876d02008-02-04 22:28:20 -08002653}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002654EXPORT_SYMBOL_GPL(gpiod_get_value);
David Brownelld2876d02008-02-04 22:28:20 -08002655
Lukas Wunnereec1d562017-10-12 12:40:10 +02002656/**
2657 * gpiod_get_raw_array_value() - read raw values from an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002658 * @array_size: number of elements in the descriptor array / value bitmap
Lukas Wunnereec1d562017-10-12 12:40:10 +02002659 * @desc_array: array of GPIO descriptors whose values will be read
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002660 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002661 * @value_bitmap: bitmap to store the read values
Lukas Wunnereec1d562017-10-12 12:40:10 +02002662 *
2663 * Read the raw values of the GPIOs, i.e. the values of the physical lines
2664 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
2665 * else an error code.
2666 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002667 * This function can be called from contexts where we cannot sleep,
Lukas Wunnereec1d562017-10-12 12:40:10 +02002668 * and it will complain if the GPIO chip functions potentially sleep.
2669 */
2670int gpiod_get_raw_array_value(unsigned int array_size,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002671 struct gpio_desc **desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002672 struct gpio_array *array_info,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002673 unsigned long *value_bitmap)
Lukas Wunnereec1d562017-10-12 12:40:10 +02002674{
2675 if (!desc_array)
2676 return -EINVAL;
2677 return gpiod_get_array_value_complex(true, false, array_size,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002678 desc_array, array_info,
2679 value_bitmap);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002680}
2681EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value);
2682
2683/**
2684 * gpiod_get_array_value() - read values from an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002685 * @array_size: number of elements in the descriptor array / value bitmap
Lukas Wunnereec1d562017-10-12 12:40:10 +02002686 * @desc_array: array of GPIO descriptors whose values will be read
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002687 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002688 * @value_bitmap: bitmap to store the read values
Lukas Wunnereec1d562017-10-12 12:40:10 +02002689 *
2690 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
2691 * into account. Return 0 in case of success, else an error code.
2692 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002693 * This function can be called from contexts where we cannot sleep,
Lukas Wunnereec1d562017-10-12 12:40:10 +02002694 * and it will complain if the GPIO chip functions potentially sleep.
2695 */
2696int gpiod_get_array_value(unsigned int array_size,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002697 struct gpio_desc **desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002698 struct gpio_array *array_info,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002699 unsigned long *value_bitmap)
Lukas Wunnereec1d562017-10-12 12:40:10 +02002700{
2701 if (!desc_array)
2702 return -EINVAL;
2703 return gpiod_get_array_value_complex(false, false, array_size,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002704 desc_array, array_info,
2705 value_bitmap);
Lukas Wunnereec1d562017-10-12 12:40:10 +02002706}
2707EXPORT_SYMBOL_GPL(gpiod_get_array_value);
2708
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302709/*
Linus Walleijfac9d882017-09-26 20:58:28 +02002710 * gpio_set_open_drain_value_commit() - Set the open drain gpio's value.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002711 * @desc: gpio descriptor whose state need to be set.
Colin Cronin20a8a962015-05-18 11:41:43 -07002712 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302713 */
Linus Walleijfac9d882017-09-26 20:58:28 +02002714static void gpio_set_open_drain_value_commit(struct gpio_desc *desc, bool value)
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302715{
Linus Walleijd377f562019-07-16 11:11:45 +02002716 int ret = 0;
Linus Walleija0b66a72020-03-29 16:04:05 +02002717 struct gpio_chip *gc = desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002718 int offset = gpio_chip_hwgpio(desc);
2719
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302720 if (value) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002721 ret = gc->direction_input(gc, offset);
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302722 } else {
Linus Walleija0b66a72020-03-29 16:04:05 +02002723 ret = gc->direction_output(gc, offset, 0);
Linus Walleijd377f562019-07-16 11:11:45 +02002724 if (!ret)
Alexandre Courbot372e7222013-02-03 01:29:29 +09002725 set_bit(FLAG_IS_OUT, &desc->flags);
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302726 }
Linus Walleijd377f562019-07-16 11:11:45 +02002727 trace_gpio_direction(desc_to_gpio(desc), value, ret);
2728 if (ret < 0)
Mark Brown6424de52013-09-09 10:33:49 +01002729 gpiod_err(desc,
2730 "%s: Error in set_value for open drain err %d\n",
Linus Walleijd377f562019-07-16 11:11:45 +02002731 __func__, ret);
Laxman Dewanganaca5ce12012-02-17 20:26:21 +05302732}
2733
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302734/*
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002735 * _gpio_set_open_source_value() - Set the open source gpio's value.
2736 * @desc: gpio descriptor whose state need to be set.
Colin Cronin20a8a962015-05-18 11:41:43 -07002737 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302738 */
Linus Walleijfac9d882017-09-26 20:58:28 +02002739static void gpio_set_open_source_value_commit(struct gpio_desc *desc, bool value)
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302740{
Linus Walleijd377f562019-07-16 11:11:45 +02002741 int ret = 0;
Linus Walleija0b66a72020-03-29 16:04:05 +02002742 struct gpio_chip *gc = desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002743 int offset = gpio_chip_hwgpio(desc);
2744
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302745 if (value) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002746 ret = gc->direction_output(gc, offset, 1);
Linus Walleijd377f562019-07-16 11:11:45 +02002747 if (!ret)
Alexandre Courbot372e7222013-02-03 01:29:29 +09002748 set_bit(FLAG_IS_OUT, &desc->flags);
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302749 } else {
Linus Walleija0b66a72020-03-29 16:04:05 +02002750 ret = gc->direction_input(gc, offset);
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302751 }
Linus Walleijd377f562019-07-16 11:11:45 +02002752 trace_gpio_direction(desc_to_gpio(desc), !value, ret);
2753 if (ret < 0)
Mark Brown6424de52013-09-09 10:33:49 +01002754 gpiod_err(desc,
2755 "%s: Error in set_value for open source err %d\n",
Linus Walleijd377f562019-07-16 11:11:45 +02002756 __func__, ret);
Laxman Dewangan25553ff2012-02-17 20:26:22 +05302757}
2758
Linus Walleijfac9d882017-09-26 20:58:28 +02002759static void gpiod_set_raw_value_commit(struct gpio_desc *desc, bool value)
David Brownelld2876d02008-02-04 22:28:20 -08002760{
Linus Walleija0b66a72020-03-29 16:04:05 +02002761 struct gpio_chip *gc;
David Brownelld2876d02008-02-04 22:28:20 -08002762
Linus Walleija0b66a72020-03-29 16:04:05 +02002763 gc = desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +09002764 trace_gpio_value(desc_to_gpio(desc), 0, value);
Linus Walleija0b66a72020-03-29 16:04:05 +02002765 gc->set(gc, gpio_chip_hwgpio(desc), value);
Alexandre Courbot372e7222013-02-03 01:29:29 +09002766}
2767
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002768/*
2769 * set multiple outputs on the same chip;
2770 * use the chip's set_multiple function if available;
2771 * otherwise set the outputs sequentially;
Linus Walleija0b66a72020-03-29 16:04:05 +02002772 * @chip: the GPIO chip we operate on
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002773 * @mask: bit mask array; one bit per output; BITS_PER_LONG bits per word
2774 * defines which outputs are to be changed
2775 * @bits: bit value array; one bit per output; BITS_PER_LONG bits per word
2776 * defines the values the outputs specified by mask are to be set to
2777 */
Linus Walleija0b66a72020-03-29 16:04:05 +02002778static void gpio_chip_set_multiple(struct gpio_chip *gc,
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002779 unsigned long *mask, unsigned long *bits)
2780{
Linus Walleija0b66a72020-03-29 16:04:05 +02002781 if (gc->set_multiple) {
2782 gc->set_multiple(gc, mask, bits);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002783 } else {
Andy Shevchenko5e4e6fb2017-01-03 19:01:17 +02002784 unsigned int i;
2785
2786 /* set outputs if the corresponding mask bit is set */
Linus Walleija0b66a72020-03-29 16:04:05 +02002787 for_each_set_bit(i, mask, gc->ngpio)
2788 gc->set(gc, i, test_bit(i, bits));
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002789 }
2790}
2791
Laura Abbott30277432018-05-21 10:57:07 -07002792int gpiod_set_array_value_complex(bool raw, bool can_sleep,
Geert Uytterhoeven3c940662018-09-27 13:38:10 +02002793 unsigned int array_size,
2794 struct gpio_desc **desc_array,
2795 struct gpio_array *array_info,
2796 unsigned long *value_bitmap)
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002797{
2798 int i = 0;
2799
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002800 /*
2801 * Validate array_info against desc_array and its size.
2802 * It should immediately follow desc_array if both
2803 * have been obtained from the same gpiod_get_array() call.
2804 */
2805 if (array_info && array_info->desc == desc_array &&
2806 array_size <= array_info->size &&
2807 (void *)array_info == desc_array + array_info->size) {
2808 if (!can_sleep)
2809 WARN_ON(array_info->chip->can_sleep);
2810
2811 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2812 bitmap_xor(value_bitmap, value_bitmap,
2813 array_info->invert_mask, array_size);
2814
2815 gpio_chip_set_multiple(array_info->chip, array_info->set_mask,
2816 value_bitmap);
2817
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002818 i = find_first_zero_bit(array_info->set_mask, array_size);
Andy Shevchenkoae66eca2020-06-30 12:21:46 +03002819 if (i == array_size)
2820 return 0;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002821 } else {
2822 array_info = NULL;
2823 }
2824
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002825 while (i < array_size) {
Linus Walleija0b66a72020-03-29 16:04:05 +02002826 struct gpio_chip *gc = desc_array[i]->gdev->chip;
Laura Abbott30277432018-05-21 10:57:07 -07002827 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2828 unsigned long *mask, *bits;
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002829 int count = 0;
2830
Linus Walleija0b66a72020-03-29 16:04:05 +02002831 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
Laura Abbott30277432018-05-21 10:57:07 -07002832 mask = fastpath;
2833 } else {
Linus Walleija0b66a72020-03-29 16:04:05 +02002834 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
Laura Abbott30277432018-05-21 10:57:07 -07002835 sizeof(*mask),
2836 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2837 if (!mask)
2838 return -ENOMEM;
2839 }
2840
Linus Walleija0b66a72020-03-29 16:04:05 +02002841 bits = mask + BITS_TO_LONGS(gc->ngpio);
2842 bitmap_zero(mask, gc->ngpio);
Laura Abbott30277432018-05-21 10:57:07 -07002843
Daniel Lockyer38e003f2015-06-10 14:26:27 +01002844 if (!can_sleep)
Linus Walleija0b66a72020-03-29 16:04:05 +02002845 WARN_ON(gc->can_sleep);
Daniel Lockyer38e003f2015-06-10 14:26:27 +01002846
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002847 do {
2848 struct gpio_desc *desc = desc_array[i];
2849 int hwgpio = gpio_chip_hwgpio(desc);
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002850 int value = test_bit(i, value_bitmap);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002851
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002852 /*
2853 * Pins applicable for fast input but not for
2854 * fast output processing may have been already
2855 * inverted inside the fast path, skip them.
2856 */
2857 if (!raw && !(array_info &&
2858 test_bit(i, array_info->invert_mask)) &&
2859 test_bit(FLAG_ACTIVE_LOW, &desc->flags))
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002860 value = !value;
2861 trace_gpio_value(desc_to_gpio(desc), 0, value);
2862 /*
2863 * collect all normal outputs belonging to the same chip
2864 * open drain and open source outputs are set individually
2865 */
Linus Walleij02e47982017-09-26 21:20:23 +02002866 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) && !raw) {
Linus Walleijfac9d882017-09-26 20:58:28 +02002867 gpio_set_open_drain_value_commit(desc, value);
Linus Walleij02e47982017-09-26 21:20:23 +02002868 } else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags) && !raw) {
Linus Walleijfac9d882017-09-26 20:58:28 +02002869 gpio_set_open_source_value_commit(desc, value);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002870 } else {
2871 __set_bit(hwgpio, mask);
Andy Shevchenko4fc5bfe2019-12-04 21:42:29 +02002872 __assign_bit(hwgpio, bits, value);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002873 count++;
2874 }
2875 i++;
Janusz Krzysztofikb17566a2018-09-05 23:50:08 +02002876
2877 if (array_info)
Janusz Krzysztofik35ae7f92018-09-24 01:53:35 +02002878 i = find_next_zero_bit(array_info->set_mask,
2879 array_size, i);
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002880 } while ((i < array_size) &&
Linus Walleija0b66a72020-03-29 16:04:05 +02002881 (desc_array[i]->gdev->chip == gc));
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002882 /* push collected bits to outputs */
Daniel Lockyer38e003f2015-06-10 14:26:27 +01002883 if (count != 0)
Linus Walleija0b66a72020-03-29 16:04:05 +02002884 gpio_chip_set_multiple(gc, mask, bits);
Laura Abbott30277432018-05-21 10:57:07 -07002885
2886 if (mask != fastpath)
2887 kfree(mask);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002888 }
Laura Abbott30277432018-05-21 10:57:07 -07002889 return 0;
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002890}
2891
David Brownelld2876d02008-02-04 22:28:20 -08002892/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002893 * gpiod_set_raw_value() - assign a gpio's raw value
2894 * @desc: gpio whose value will be assigned
David Brownelld2876d02008-02-04 22:28:20 -08002895 * @value: value to assign
David Brownelld2876d02008-02-04 22:28:20 -08002896 *
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002897 * Set the raw value of the GPIO, i.e. the value of its physical line without
2898 * regard for its ACTIVE_LOW status.
2899 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002900 * This function can be called from contexts where we cannot sleep, and will
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002901 * complain if the GPIO chip functions potentially sleep.
David Brownelld2876d02008-02-04 22:28:20 -08002902 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002903void gpiod_set_raw_value(struct gpio_desc *desc, int value)
Alexandre Courbot372e7222013-02-03 01:29:29 +09002904{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002905 VALIDATE_DESC_VOID(desc);
Geert Uytterhoeven3285170f2019-07-01 16:27:38 +02002906 /* Should be using gpiod_set_raw_value_cansleep() */
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002907 WARN_ON(desc->gdev->chip->can_sleep);
Linus Walleijfac9d882017-09-26 20:58:28 +02002908 gpiod_set_raw_value_commit(desc, value);
David Brownelld2876d02008-02-04 22:28:20 -08002909}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002910EXPORT_SYMBOL_GPL(gpiod_set_raw_value);
David Brownelld2876d02008-02-04 22:28:20 -08002911
2912/**
Geert Uytterhoeven1e77fc82018-01-09 19:08:21 +01002913 * gpiod_set_value_nocheck() - set a GPIO line value without checking
2914 * @desc: the descriptor to set the value on
2915 * @value: value to set
2916 *
2917 * This sets the value of a GPIO line backing a descriptor, applying
2918 * different semantic quirks like active low and open drain/source
2919 * handling.
2920 */
2921static void gpiod_set_value_nocheck(struct gpio_desc *desc, int value)
2922{
2923 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2924 value = !value;
2925 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
2926 gpio_set_open_drain_value_commit(desc, value);
2927 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
2928 gpio_set_open_source_value_commit(desc, value);
2929 else
2930 gpiod_set_raw_value_commit(desc, value);
2931}
2932
2933/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002934 * gpiod_set_value() - assign a gpio's value
2935 * @desc: gpio whose value will be assigned
2936 * @value: value to assign
David Brownelld2876d02008-02-04 22:28:20 -08002937 *
Linus Walleij02e47982017-09-26 21:20:23 +02002938 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW,
2939 * OPEN_DRAIN and OPEN_SOURCE flags into account.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002940 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002941 * This function can be called from contexts where we cannot sleep, and will
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002942 * complain if the GPIO chip functions potentially sleep.
David Brownelld2876d02008-02-04 22:28:20 -08002943 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002944void gpiod_set_value(struct gpio_desc *desc, int value)
2945{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002946 VALIDATE_DESC_VOID(desc);
Geert Uytterhoeven3285170f2019-07-01 16:27:38 +02002947 /* Should be using gpiod_set_value_cansleep() */
Linus Walleijfdeb8e12016-02-10 10:57:36 +01002948 WARN_ON(desc->gdev->chip->can_sleep);
Geert Uytterhoeven1e77fc82018-01-09 19:08:21 +01002949 gpiod_set_value_nocheck(desc, value);
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07002950}
2951EXPORT_SYMBOL_GPL(gpiod_set_value);
2952
2953/**
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02002954 * gpiod_set_raw_array_value() - assign values to an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002955 * @array_size: number of elements in the descriptor array / value bitmap
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002956 * @desc_array: array of GPIO descriptors whose values will be assigned
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002957 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002958 * @value_bitmap: bitmap of values to assign
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002959 *
2960 * Set the raw values of the GPIOs, i.e. the values of the physical lines
2961 * without regard for their ACTIVE_LOW status.
2962 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002963 * This function can be called from contexts where we cannot sleep, and will
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002964 * complain if the GPIO chip functions potentially sleep.
2965 */
Laura Abbott30277432018-05-21 10:57:07 -07002966int gpiod_set_raw_array_value(unsigned int array_size,
Geert Uytterhoeven3c940662018-09-27 13:38:10 +02002967 struct gpio_desc **desc_array,
2968 struct gpio_array *array_info,
2969 unsigned long *value_bitmap)
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002970{
2971 if (!desc_array)
Laura Abbott30277432018-05-21 10:57:07 -07002972 return -EINVAL;
2973 return gpiod_set_array_value_complex(true, false, array_size,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002974 desc_array, array_info, value_bitmap);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002975}
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02002976EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002977
2978/**
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02002979 * gpiod_set_array_value() - assign values to an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002980 * @array_size: number of elements in the descriptor array / value bitmap
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002981 * @desc_array: array of GPIO descriptors whose values will be assigned
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02002982 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02002983 * @value_bitmap: bitmap of values to assign
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002984 *
2985 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
2986 * into account.
2987 *
Geert Uytterhoeven827a9b82019-07-01 16:28:09 +02002988 * This function can be called from contexts where we cannot sleep, and will
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002989 * complain if the GPIO chip functions potentially sleep.
2990 */
Geert Uytterhoevencf9af0d2018-09-27 13:38:09 +02002991int gpiod_set_array_value(unsigned int array_size,
2992 struct gpio_desc **desc_array,
2993 struct gpio_array *array_info,
2994 unsigned long *value_bitmap)
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01002995{
2996 if (!desc_array)
Geert Uytterhoevencf9af0d2018-09-27 13:38:09 +02002997 return -EINVAL;
2998 return gpiod_set_array_value_complex(false, false, array_size,
2999 desc_array, array_info,
3000 value_bitmap);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003001}
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02003002EXPORT_SYMBOL_GPL(gpiod_set_array_value);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003003
3004/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003005 * gpiod_cansleep() - report whether gpio value access may sleep
3006 * @desc: gpio to check
3007 *
3008 */
3009int gpiod_cansleep(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +09003010{
Linus Walleijfdeb8e12016-02-10 10:57:36 +01003011 VALIDATE_DESC(desc);
3012 return desc->gdev->chip->can_sleep;
Alexandre Courbot372e7222013-02-03 01:29:29 +09003013}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003014EXPORT_SYMBOL_GPL(gpiod_cansleep);
David Brownelld2876d02008-02-04 22:28:20 -08003015
David Brownell0f6d5042008-10-15 22:03:14 -07003016/**
Linus Walleij90b39402e2018-06-01 13:21:27 +02003017 * gpiod_set_consumer_name() - set the consumer name for the descriptor
3018 * @desc: gpio to set the consumer name on
3019 * @name: the new consumer name
3020 */
Muchun Song18534df2018-11-01 21:12:50 +08003021int gpiod_set_consumer_name(struct gpio_desc *desc, const char *name)
Linus Walleij90b39402e2018-06-01 13:21:27 +02003022{
Muchun Song18534df2018-11-01 21:12:50 +08003023 VALIDATE_DESC(desc);
3024 if (name) {
3025 name = kstrdup_const(name, GFP_KERNEL);
3026 if (!name)
3027 return -ENOMEM;
3028 }
3029
3030 kfree_const(desc->label);
3031 desc_set_label(desc, name);
3032
3033 return 0;
Linus Walleij90b39402e2018-06-01 13:21:27 +02003034}
3035EXPORT_SYMBOL_GPL(gpiod_set_consumer_name);
3036
3037/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003038 * gpiod_to_irq() - return the IRQ corresponding to a GPIO
3039 * @desc: gpio whose IRQ will be returned (already requested)
David Brownell0f6d5042008-10-15 22:03:14 -07003040 *
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003041 * Return the IRQ corresponding to the passed GPIO, or an error code in case of
3042 * error.
David Brownell0f6d5042008-10-15 22:03:14 -07003043 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003044int gpiod_to_irq(const struct gpio_desc *desc)
David Brownell0f6d5042008-10-15 22:03:14 -07003045{
Linus Walleija0b66a72020-03-29 16:04:05 +02003046 struct gpio_chip *gc;
Linus Walleij4c37ce82016-05-02 13:13:10 +02003047 int offset;
David Brownell0f6d5042008-10-15 22:03:14 -07003048
Linus Walleij79bb71b2016-06-15 22:57:38 +02003049 /*
3050 * Cannot VALIDATE_DESC() here as gpiod_to_irq() consumer semantics
3051 * requires this function to not return zero on an invalid descriptor
3052 * but rather a negative error number.
3053 */
Linus Walleijbfbbe442016-06-16 11:55:55 +02003054 if (!desc || IS_ERR(desc) || !desc->gdev || !desc->gdev->chip)
Linus Walleij79bb71b2016-06-15 22:57:38 +02003055 return -EINVAL;
3056
Linus Walleija0b66a72020-03-29 16:04:05 +02003057 gc = desc->gdev->chip;
Alexandre Courbot372e7222013-02-03 01:29:29 +09003058 offset = gpio_chip_hwgpio(desc);
Linus Walleija0b66a72020-03-29 16:04:05 +02003059 if (gc->to_irq) {
3060 int retirq = gc->to_irq(gc, offset);
Linus Walleij4c37ce82016-05-02 13:13:10 +02003061
3062 /* Zero means NO_IRQ */
3063 if (!retirq)
3064 return -ENXIO;
3065
3066 return retirq;
3067 }
3068 return -ENXIO;
Alexandre Courbot372e7222013-02-03 01:29:29 +09003069}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003070EXPORT_SYMBOL_GPL(gpiod_to_irq);
Alexandre Courbot372e7222013-02-03 01:29:29 +09003071
Linus Walleijd468bf92013-09-24 11:54:38 +02003072/**
Alexandre Courbote3a2e872014-10-23 17:27:07 +09003073 * gpiochip_lock_as_irq() - lock a GPIO to be used as IRQ
Linus Walleija0b66a72020-03-29 16:04:05 +02003074 * @gc: the chip the GPIO to lock belongs to
Alexandre Courbotd74be6d2014-07-22 16:17:42 +09003075 * @offset: the offset of the GPIO to lock as IRQ
Linus Walleijd468bf92013-09-24 11:54:38 +02003076 *
3077 * This is used directly by GPIO drivers that want to lock down
Linus Walleijf438acd2014-03-07 10:12:49 +08003078 * a certain GPIO line to be used for IRQs.
David Brownelld2876d02008-02-04 22:28:20 -08003079 */
Linus Walleija0b66a72020-03-29 16:04:05 +02003080int gpiochip_lock_as_irq(struct gpio_chip *gc, unsigned int offset)
David Brownelld2876d02008-02-04 22:28:20 -08003081{
Linus Walleij9c102802016-05-25 10:56:03 +02003082 struct gpio_desc *desc;
Linus Walleijd468bf92013-09-24 11:54:38 +02003083
Linus Walleija0b66a72020-03-29 16:04:05 +02003084 desc = gpiochip_get_desc(gc, offset);
Linus Walleij9c102802016-05-25 10:56:03 +02003085 if (IS_ERR(desc))
3086 return PTR_ERR(desc);
3087
Linus Walleij60f83392016-11-12 15:01:09 +01003088 /*
3089 * If it's fast: flush the direction setting if something changed
3090 * behind our back
3091 */
Linus Walleija0b66a72020-03-29 16:04:05 +02003092 if (!gc->can_sleep && gc->get_direction) {
Andy Shevchenko80956792018-07-09 21:47:21 +03003093 int dir = gpiod_get_direction(desc);
Linus Walleij9c102802016-05-25 10:56:03 +02003094
Andy Shevchenko36b31272018-07-03 03:38:31 +03003095 if (dir < 0) {
Linus Walleija0b66a72020-03-29 16:04:05 +02003096 chip_err(gc, "%s: cannot get GPIO direction\n",
Andy Shevchenko36b31272018-07-03 03:38:31 +03003097 __func__);
3098 return dir;
3099 }
Linus Walleij9c102802016-05-25 10:56:03 +02003100 }
3101
Linus Walleije9bdf7e2020-05-27 16:07:58 +02003102 /* To be valid for IRQ the line needs to be input or open drain */
3103 if (test_bit(FLAG_IS_OUT, &desc->flags) &&
3104 !test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
Linus Walleija0b66a72020-03-29 16:04:05 +02003105 chip_err(gc,
Andy Shevchenkob1911712018-07-03 03:39:03 +03003106 "%s: tried to flag a GPIO set as output for IRQ\n",
3107 __func__);
Linus Walleijd468bf92013-09-24 11:54:38 +02003108 return -EIO;
3109 }
3110
Linus Walleij9c102802016-05-25 10:56:03 +02003111 set_bit(FLAG_USED_AS_IRQ, &desc->flags);
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003112 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
Linus Walleij3940c342016-11-14 00:09:07 +01003113
3114 /*
3115 * If the consumer has not set up a label (such as when the
3116 * IRQ is referenced from .to_irq()) we set up a label here
3117 * so it is clear this is used as an interrupt.
3118 */
3119 if (!desc->label)
3120 desc_set_label(desc, "interrupt");
3121
Linus Walleijd468bf92013-09-24 11:54:38 +02003122 return 0;
3123}
Alexandre Courbote3a2e872014-10-23 17:27:07 +09003124EXPORT_SYMBOL_GPL(gpiochip_lock_as_irq);
Linus Walleijd468bf92013-09-24 11:54:38 +02003125
Linus Walleijd468bf92013-09-24 11:54:38 +02003126/**
Alexandre Courbote3a2e872014-10-23 17:27:07 +09003127 * gpiochip_unlock_as_irq() - unlock a GPIO used as IRQ
Linus Walleija0b66a72020-03-29 16:04:05 +02003128 * @gc: the chip the GPIO to lock belongs to
Alexandre Courbotd74be6d2014-07-22 16:17:42 +09003129 * @offset: the offset of the GPIO to lock as IRQ
Linus Walleijd468bf92013-09-24 11:54:38 +02003130 *
3131 * This is used directly by GPIO drivers that want to indicate
3132 * that a certain GPIO is no longer used exclusively for IRQ.
3133 */
Linus Walleija0b66a72020-03-29 16:04:05 +02003134void gpiochip_unlock_as_irq(struct gpio_chip *gc, unsigned int offset)
Linus Walleijd468bf92013-09-24 11:54:38 +02003135{
Linus Walleij3940c342016-11-14 00:09:07 +01003136 struct gpio_desc *desc;
3137
Linus Walleija0b66a72020-03-29 16:04:05 +02003138 desc = gpiochip_get_desc(gc, offset);
Linus Walleij3940c342016-11-14 00:09:07 +01003139 if (IS_ERR(desc))
Linus Walleijd468bf92013-09-24 11:54:38 +02003140 return;
3141
Linus Walleij3940c342016-11-14 00:09:07 +01003142 clear_bit(FLAG_USED_AS_IRQ, &desc->flags);
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003143 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
Linus Walleij3940c342016-11-14 00:09:07 +01003144
3145 /* If we only had this marking, erase it */
3146 if (desc->label && !strcmp(desc->label, "interrupt"))
3147 desc_set_label(desc, NULL);
Linus Walleijd468bf92013-09-24 11:54:38 +02003148}
Alexandre Courbote3a2e872014-10-23 17:27:07 +09003149EXPORT_SYMBOL_GPL(gpiochip_unlock_as_irq);
Linus Walleijd468bf92013-09-24 11:54:38 +02003150
Linus Walleija0b66a72020-03-29 16:04:05 +02003151void gpiochip_disable_irq(struct gpio_chip *gc, unsigned int offset)
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003152{
Linus Walleija0b66a72020-03-29 16:04:05 +02003153 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003154
3155 if (!IS_ERR(desc) &&
3156 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags)))
3157 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3158}
3159EXPORT_SYMBOL_GPL(gpiochip_disable_irq);
3160
Linus Walleija0b66a72020-03-29 16:04:05 +02003161void gpiochip_enable_irq(struct gpio_chip *gc, unsigned int offset)
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003162{
Linus Walleija0b66a72020-03-29 16:04:05 +02003163 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003164
3165 if (!IS_ERR(desc) &&
3166 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags))) {
Linus Walleije9bdf7e2020-05-27 16:07:58 +02003167 /*
3168 * We must not be output when using IRQ UNLESS we are
3169 * open drain.
3170 */
3171 WARN_ON(test_bit(FLAG_IS_OUT, &desc->flags) &&
3172 !test_bit(FLAG_OPEN_DRAIN, &desc->flags));
Hans Verkuil4e9439d2018-09-08 11:23:16 +02003173 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3174 }
3175}
3176EXPORT_SYMBOL_GPL(gpiochip_enable_irq);
3177
Linus Walleija0b66a72020-03-29 16:04:05 +02003178bool gpiochip_line_is_irq(struct gpio_chip *gc, unsigned int offset)
Linus Walleij6cee3822016-02-11 20:16:45 +01003179{
Linus Walleija0b66a72020-03-29 16:04:05 +02003180 if (offset >= gc->ngpio)
Linus Walleij6cee3822016-02-11 20:16:45 +01003181 return false;
3182
Linus Walleija0b66a72020-03-29 16:04:05 +02003183 return test_bit(FLAG_USED_AS_IRQ, &gc->gpiodev->descs[offset].flags);
Linus Walleij6cee3822016-02-11 20:16:45 +01003184}
3185EXPORT_SYMBOL_GPL(gpiochip_line_is_irq);
3186
Linus Walleija0b66a72020-03-29 16:04:05 +02003187int gpiochip_reqres_irq(struct gpio_chip *gc, unsigned int offset)
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003188{
3189 int ret;
3190
Linus Walleija0b66a72020-03-29 16:04:05 +02003191 if (!try_module_get(gc->gpiodev->owner))
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003192 return -ENODEV;
3193
Linus Walleija0b66a72020-03-29 16:04:05 +02003194 ret = gpiochip_lock_as_irq(gc, offset);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003195 if (ret) {
Linus Walleija0b66a72020-03-29 16:04:05 +02003196 chip_err(gc, "unable to lock HW IRQ %u for IRQ\n", offset);
3197 module_put(gc->gpiodev->owner);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003198 return ret;
3199 }
3200 return 0;
3201}
3202EXPORT_SYMBOL_GPL(gpiochip_reqres_irq);
3203
Linus Walleija0b66a72020-03-29 16:04:05 +02003204void gpiochip_relres_irq(struct gpio_chip *gc, unsigned int offset)
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003205{
Linus Walleija0b66a72020-03-29 16:04:05 +02003206 gpiochip_unlock_as_irq(gc, offset);
3207 module_put(gc->gpiodev->owner);
Hans Verkuil4e6b8232018-09-08 11:23:14 +02003208}
3209EXPORT_SYMBOL_GPL(gpiochip_relres_irq);
3210
Linus Walleija0b66a72020-03-29 16:04:05 +02003211bool gpiochip_line_is_open_drain(struct gpio_chip *gc, unsigned int offset)
Linus Walleij143b65d2016-02-16 15:41:42 +01003212{
Linus Walleija0b66a72020-03-29 16:04:05 +02003213 if (offset >= gc->ngpio)
Linus Walleij143b65d2016-02-16 15:41:42 +01003214 return false;
3215
Linus Walleija0b66a72020-03-29 16:04:05 +02003216 return test_bit(FLAG_OPEN_DRAIN, &gc->gpiodev->descs[offset].flags);
Linus Walleij143b65d2016-02-16 15:41:42 +01003217}
3218EXPORT_SYMBOL_GPL(gpiochip_line_is_open_drain);
3219
Linus Walleija0b66a72020-03-29 16:04:05 +02003220bool gpiochip_line_is_open_source(struct gpio_chip *gc, unsigned int offset)
Linus Walleij143b65d2016-02-16 15:41:42 +01003221{
Linus Walleija0b66a72020-03-29 16:04:05 +02003222 if (offset >= gc->ngpio)
Linus Walleij143b65d2016-02-16 15:41:42 +01003223 return false;
3224
Linus Walleija0b66a72020-03-29 16:04:05 +02003225 return test_bit(FLAG_OPEN_SOURCE, &gc->gpiodev->descs[offset].flags);
Linus Walleij143b65d2016-02-16 15:41:42 +01003226}
3227EXPORT_SYMBOL_GPL(gpiochip_line_is_open_source);
3228
Linus Walleija0b66a72020-03-29 16:04:05 +02003229bool gpiochip_line_is_persistent(struct gpio_chip *gc, unsigned int offset)
Charles Keepax05f479b2017-05-23 15:47:29 +01003230{
Linus Walleija0b66a72020-03-29 16:04:05 +02003231 if (offset >= gc->ngpio)
Charles Keepax05f479b2017-05-23 15:47:29 +01003232 return false;
3233
Linus Walleija0b66a72020-03-29 16:04:05 +02003234 return !test_bit(FLAG_TRANSITORY, &gc->gpiodev->descs[offset].flags);
Charles Keepax05f479b2017-05-23 15:47:29 +01003235}
3236EXPORT_SYMBOL_GPL(gpiochip_line_is_persistent);
3237
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003238/**
3239 * gpiod_get_raw_value_cansleep() - return a gpio's raw value
3240 * @desc: gpio whose value will be returned
3241 *
3242 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
Bjorn Anderssone20538b2015-08-28 09:44:18 -07003243 * its ACTIVE_LOW status, or negative errno on failure.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003244 *
3245 * This function is to be called from contexts that can sleep.
David Brownelld2876d02008-02-04 22:28:20 -08003246 */
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003247int gpiod_get_raw_value_cansleep(const struct gpio_desc *desc)
David Brownelld2876d02008-02-04 22:28:20 -08003248{
David Brownelld2876d02008-02-04 22:28:20 -08003249 might_sleep_if(extra_checks);
Linus Walleijfdeb8e12016-02-10 10:57:36 +01003250 VALIDATE_DESC(desc);
Linus Walleijfac9d882017-09-26 20:58:28 +02003251 return gpiod_get_raw_value_commit(desc);
David Brownelld2876d02008-02-04 22:28:20 -08003252}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003253EXPORT_SYMBOL_GPL(gpiod_get_raw_value_cansleep);
Alexandre Courbot372e7222013-02-03 01:29:29 +09003254
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003255/**
3256 * gpiod_get_value_cansleep() - return a gpio's value
3257 * @desc: gpio whose value will be returned
3258 *
3259 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
Bjorn Anderssone20538b2015-08-28 09:44:18 -07003260 * account, or negative errno on failure.
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003261 *
3262 * This function is to be called from contexts that can sleep.
3263 */
3264int gpiod_get_value_cansleep(const struct gpio_desc *desc)
Alexandre Courbot372e7222013-02-03 01:29:29 +09003265{
David Brownelld2876d02008-02-04 22:28:20 -08003266 int value;
David Brownelld2876d02008-02-04 22:28:20 -08003267
3268 might_sleep_if(extra_checks);
Linus Walleijfdeb8e12016-02-10 10:57:36 +01003269 VALIDATE_DESC(desc);
Linus Walleijfac9d882017-09-26 20:58:28 +02003270 value = gpiod_get_raw_value_commit(desc);
Bjorn Anderssone20538b2015-08-28 09:44:18 -07003271 if (value < 0)
3272 return value;
3273
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003274 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3275 value = !value;
3276
David Brownelld2876d02008-02-04 22:28:20 -08003277 return value;
3278}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003279EXPORT_SYMBOL_GPL(gpiod_get_value_cansleep);
Alexandre Courbot372e7222013-02-03 01:29:29 +09003280
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003281/**
Lukas Wunnereec1d562017-10-12 12:40:10 +02003282 * gpiod_get_raw_array_value_cansleep() - read raw values from an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003283 * @array_size: number of elements in the descriptor array / value bitmap
Lukas Wunnereec1d562017-10-12 12:40:10 +02003284 * @desc_array: array of GPIO descriptors whose values will be read
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003285 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003286 * @value_bitmap: bitmap to store the read values
Lukas Wunnereec1d562017-10-12 12:40:10 +02003287 *
3288 * Read the raw values of the GPIOs, i.e. the values of the physical lines
3289 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
3290 * else an error code.
3291 *
3292 * This function is to be called from contexts that can sleep.
3293 */
3294int gpiod_get_raw_array_value_cansleep(unsigned int array_size,
3295 struct gpio_desc **desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003296 struct gpio_array *array_info,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003297 unsigned long *value_bitmap)
Lukas Wunnereec1d562017-10-12 12:40:10 +02003298{
3299 might_sleep_if(extra_checks);
3300 if (!desc_array)
3301 return -EINVAL;
3302 return gpiod_get_array_value_complex(true, true, array_size,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003303 desc_array, array_info,
3304 value_bitmap);
Lukas Wunnereec1d562017-10-12 12:40:10 +02003305}
3306EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value_cansleep);
3307
3308/**
3309 * gpiod_get_array_value_cansleep() - read values from an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003310 * @array_size: number of elements in the descriptor array / value bitmap
Lukas Wunnereec1d562017-10-12 12:40:10 +02003311 * @desc_array: array of GPIO descriptors whose values will be read
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003312 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003313 * @value_bitmap: bitmap to store the read values
Lukas Wunnereec1d562017-10-12 12:40:10 +02003314 *
3315 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3316 * into account. Return 0 in case of success, else an error code.
3317 *
3318 * This function is to be called from contexts that can sleep.
3319 */
3320int gpiod_get_array_value_cansleep(unsigned int array_size,
3321 struct gpio_desc **desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003322 struct gpio_array *array_info,
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003323 unsigned long *value_bitmap)
Lukas Wunnereec1d562017-10-12 12:40:10 +02003324{
3325 might_sleep_if(extra_checks);
3326 if (!desc_array)
3327 return -EINVAL;
3328 return gpiod_get_array_value_complex(false, true, array_size,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003329 desc_array, array_info,
3330 value_bitmap);
Lukas Wunnereec1d562017-10-12 12:40:10 +02003331}
3332EXPORT_SYMBOL_GPL(gpiod_get_array_value_cansleep);
3333
3334/**
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003335 * gpiod_set_raw_value_cansleep() - assign a gpio's raw value
3336 * @desc: gpio whose value will be assigned
3337 * @value: value to assign
3338 *
3339 * Set the raw value of the GPIO, i.e. the value of its physical line without
3340 * regard for its ACTIVE_LOW status.
3341 *
3342 * This function is to be called from contexts that can sleep.
3343 */
3344void gpiod_set_raw_value_cansleep(struct gpio_desc *desc, int value)
Alexandre Courbot372e7222013-02-03 01:29:29 +09003345{
David Brownelld2876d02008-02-04 22:28:20 -08003346 might_sleep_if(extra_checks);
Linus Walleijfdeb8e12016-02-10 10:57:36 +01003347 VALIDATE_DESC_VOID(desc);
Linus Walleijfac9d882017-09-26 20:58:28 +02003348 gpiod_set_raw_value_commit(desc, value);
Alexandre Courbot372e7222013-02-03 01:29:29 +09003349}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003350EXPORT_SYMBOL_GPL(gpiod_set_raw_value_cansleep);
Alexandre Courbot372e7222013-02-03 01:29:29 +09003351
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003352/**
3353 * gpiod_set_value_cansleep() - assign a gpio's value
3354 * @desc: gpio whose value will be assigned
3355 * @value: value to assign
3356 *
3357 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
3358 * account
3359 *
3360 * This function is to be called from contexts that can sleep.
3361 */
3362void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
Alexandre Courbot372e7222013-02-03 01:29:29 +09003363{
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003364 might_sleep_if(extra_checks);
Linus Walleijfdeb8e12016-02-10 10:57:36 +01003365 VALIDATE_DESC_VOID(desc);
Geert Uytterhoeven1e77fc82018-01-09 19:08:21 +01003366 gpiod_set_value_nocheck(desc, value);
David Brownelld2876d02008-02-04 22:28:20 -08003367}
Alexandre Courbot79a9bec2013-10-17 10:21:36 -07003368EXPORT_SYMBOL_GPL(gpiod_set_value_cansleep);
David Brownelld2876d02008-02-04 22:28:20 -08003369
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003370/**
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02003371 * gpiod_set_raw_array_value_cansleep() - assign values to an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003372 * @array_size: number of elements in the descriptor array / value bitmap
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003373 * @desc_array: array of GPIO descriptors whose values will be assigned
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003374 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003375 * @value_bitmap: bitmap of values to assign
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003376 *
3377 * Set the raw values of the GPIOs, i.e. the values of the physical lines
3378 * without regard for their ACTIVE_LOW status.
3379 *
3380 * This function is to be called from contexts that can sleep.
3381 */
Laura Abbott30277432018-05-21 10:57:07 -07003382int gpiod_set_raw_array_value_cansleep(unsigned int array_size,
Geert Uytterhoeven3c940662018-09-27 13:38:10 +02003383 struct gpio_desc **desc_array,
3384 struct gpio_array *array_info,
3385 unsigned long *value_bitmap)
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003386{
3387 might_sleep_if(extra_checks);
3388 if (!desc_array)
Laura Abbott30277432018-05-21 10:57:07 -07003389 return -EINVAL;
3390 return gpiod_set_array_value_complex(true, true, array_size, desc_array,
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003391 array_info, value_bitmap);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003392}
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02003393EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value_cansleep);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003394
3395/**
Dmitry Torokhov3946d182017-08-14 21:59:55 -07003396 * gpiod_add_lookup_tables() - register GPIO device consumers
3397 * @tables: list of tables of consumers to register
3398 * @n: number of tables in the list
3399 */
3400void gpiod_add_lookup_tables(struct gpiod_lookup_table **tables, size_t n)
3401{
3402 unsigned int i;
3403
3404 mutex_lock(&gpio_lookup_lock);
3405
3406 for (i = 0; i < n; i++)
3407 list_add_tail(&tables[i]->list, &gpio_lookup_list);
3408
3409 mutex_unlock(&gpio_lookup_lock);
3410}
3411
3412/**
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02003413 * gpiod_set_array_value_cansleep() - assign values to an array of GPIOs
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003414 * @array_size: number of elements in the descriptor array / value bitmap
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003415 * @desc_array: array of GPIO descriptors whose values will be assigned
Janusz Krzysztofik77588c12018-09-05 23:50:07 +02003416 * @array_info: information on applicability of fast bitmap processing path
Janusz Krzysztofikb9762be2018-09-05 23:50:05 +02003417 * @value_bitmap: bitmap of values to assign
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003418 *
3419 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3420 * into account.
3421 *
3422 * This function is to be called from contexts that can sleep.
3423 */
Geert Uytterhoevencf9af0d2018-09-27 13:38:09 +02003424int gpiod_set_array_value_cansleep(unsigned int array_size,
3425 struct gpio_desc **desc_array,
3426 struct gpio_array *array_info,
3427 unsigned long *value_bitmap)
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003428{
3429 might_sleep_if(extra_checks);
3430 if (!desc_array)
Geert Uytterhoevencf9af0d2018-09-27 13:38:09 +02003431 return -EINVAL;
3432 return gpiod_set_array_value_complex(false, true, array_size,
3433 desc_array, array_info,
3434 value_bitmap);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003435}
Rojhalat Ibrahim3fff99b2015-05-13 11:04:56 +02003436EXPORT_SYMBOL_GPL(gpiod_set_array_value_cansleep);
Rojhalat Ibrahim5f424242014-11-04 17:12:06 +01003437
3438/**
Alexandre Courbotad824782013-12-03 12:20:11 +09003439 * gpiod_add_lookup_table() - register GPIO device consumers
3440 * @table: table of consumers to register
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003441 */
Alexandre Courbotad824782013-12-03 12:20:11 +09003442void gpiod_add_lookup_table(struct gpiod_lookup_table *table)
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003443{
3444 mutex_lock(&gpio_lookup_lock);
3445
Alexandre Courbotad824782013-12-03 12:20:11 +09003446 list_add_tail(&table->list, &gpio_lookup_list);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003447
3448 mutex_unlock(&gpio_lookup_lock);
David Brownelld2876d02008-02-04 22:28:20 -08003449}
Anatolij Gustschin226b2242017-04-20 23:23:20 +02003450EXPORT_SYMBOL_GPL(gpiod_add_lookup_table);
David Brownelld2876d02008-02-04 22:28:20 -08003451
Shobhit Kumarbe9015a2015-06-26 14:32:04 +05303452/**
3453 * gpiod_remove_lookup_table() - unregister GPIO device consumers
3454 * @table: table of consumers to unregister
3455 */
3456void gpiod_remove_lookup_table(struct gpiod_lookup_table *table)
3457{
3458 mutex_lock(&gpio_lookup_lock);
3459
3460 list_del(&table->list);
3461
3462 mutex_unlock(&gpio_lookup_lock);
3463}
Anatolij Gustschin226b2242017-04-20 23:23:20 +02003464EXPORT_SYMBOL_GPL(gpiod_remove_lookup_table);
Shobhit Kumarbe9015a2015-06-26 14:32:04 +05303465
Bartosz Golaszewskia411e812018-04-10 22:30:28 +02003466/**
3467 * gpiod_add_hogs() - register a set of GPIO hogs from machine code
3468 * @hogs: table of gpio hog entries with a zeroed sentinel at the end
3469 */
3470void gpiod_add_hogs(struct gpiod_hog *hogs)
3471{
Linus Walleija0b66a72020-03-29 16:04:05 +02003472 struct gpio_chip *gc;
Bartosz Golaszewskia411e812018-04-10 22:30:28 +02003473 struct gpiod_hog *hog;
3474
3475 mutex_lock(&gpio_machine_hogs_mutex);
3476
3477 for (hog = &hogs[0]; hog->chip_label; hog++) {
3478 list_add_tail(&hog->list, &gpio_machine_hogs);
3479
3480 /*
3481 * The chip may have been registered earlier, so check if it
3482 * exists and, if so, try to hog the line now.
3483 */
Linus Walleija0b66a72020-03-29 16:04:05 +02003484 gc = find_chip_by_name(hog->chip_label);
3485 if (gc)
3486 gpiochip_machine_hog(gc, hog);
Bartosz Golaszewskia411e812018-04-10 22:30:28 +02003487 }
3488
3489 mutex_unlock(&gpio_machine_hogs_mutex);
3490}
3491EXPORT_SYMBOL_GPL(gpiod_add_hogs);
3492
Alexandre Courbotad824782013-12-03 12:20:11 +09003493static struct gpiod_lookup_table *gpiod_find_lookup_table(struct device *dev)
3494{
3495 const char *dev_id = dev ? dev_name(dev) : NULL;
3496 struct gpiod_lookup_table *table;
3497
3498 mutex_lock(&gpio_lookup_lock);
3499
3500 list_for_each_entry(table, &gpio_lookup_list, list) {
3501 if (table->dev_id && dev_id) {
3502 /*
3503 * Valid strings on both ends, must be identical to have
3504 * a match
3505 */
3506 if (!strcmp(table->dev_id, dev_id))
3507 goto found;
3508 } else {
3509 /*
3510 * One of the pointers is NULL, so both must be to have
3511 * a match
3512 */
3513 if (dev_id == table->dev_id)
3514 goto found;
3515 }
3516 }
3517 table = NULL;
3518
3519found:
3520 mutex_unlock(&gpio_lookup_lock);
3521 return table;
3522}
3523
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003524static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id,
Andy Shevchenkofed70262019-04-10 18:39:16 +03003525 unsigned int idx, unsigned long *flags)
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003526{
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003527 struct gpio_desc *desc = ERR_PTR(-ENOENT);
Alexandre Courbotad824782013-12-03 12:20:11 +09003528 struct gpiod_lookup_table *table;
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003529 struct gpiod_lookup *p;
3530
Alexandre Courbotad824782013-12-03 12:20:11 +09003531 table = gpiod_find_lookup_table(dev);
3532 if (!table)
3533 return desc;
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003534
Geert Uytterhoeven4c033b52020-05-11 16:52:54 +02003535 for (p = &table->table[0]; p->key; p++) {
Linus Walleija0b66a72020-03-29 16:04:05 +02003536 struct gpio_chip *gc;
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003537
Alexandre Courbotad824782013-12-03 12:20:11 +09003538 /* idx must always match exactly */
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003539 if (p->idx != idx)
3540 continue;
3541
Alexandre Courbotad824782013-12-03 12:20:11 +09003542 /* If the lookup entry has a con_id, require exact match */
3543 if (p->con_id && (!con_id || strcmp(p->con_id, con_id)))
3544 continue;
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003545
Geert Uytterhoeven4c033b52020-05-11 16:52:54 +02003546 if (p->chip_hwnum == U16_MAX) {
3547 desc = gpio_name_to_desc(p->key);
3548 if (desc) {
3549 *flags = p->flags;
3550 return desc;
3551 }
3552
3553 dev_warn(dev, "cannot find GPIO line %s, deferring\n",
3554 p->key);
3555 return ERR_PTR(-EPROBE_DEFER);
3556 }
3557
3558 gc = find_chip_by_name(p->key);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003559
Linus Walleija0b66a72020-03-29 16:04:05 +02003560 if (!gc) {
Janusz Krzysztofik8853daf2018-07-04 00:18:19 +02003561 /*
3562 * As the lookup table indicates a chip with
Geert Uytterhoeven4c033b52020-05-11 16:52:54 +02003563 * p->key should exist, assume it may
Janusz Krzysztofik8853daf2018-07-04 00:18:19 +02003564 * still appear later and let the interested
3565 * consumer be probed again or let the Deferred
3566 * Probe infrastructure handle the error.
3567 */
3568 dev_warn(dev, "cannot find GPIO chip %s, deferring\n",
Geert Uytterhoeven4c033b52020-05-11 16:52:54 +02003569 p->key);
Janusz Krzysztofik8853daf2018-07-04 00:18:19 +02003570 return ERR_PTR(-EPROBE_DEFER);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003571 }
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003572
Linus Walleija0b66a72020-03-29 16:04:05 +02003573 if (gc->ngpio <= p->chip_hwnum) {
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003574 dev_err(dev,
Geert Uytterhoevend935bd52019-11-27 10:59:19 +01003575 "requested GPIO %u (%u) is out of range [0..%u] for chip %s\n",
Linus Walleija0b66a72020-03-29 16:04:05 +02003576 idx, p->chip_hwnum, gc->ngpio - 1,
3577 gc->label);
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003578 return ERR_PTR(-EINVAL);
Alexandre Courbotad824782013-12-03 12:20:11 +09003579 }
3580
Linus Walleija0b66a72020-03-29 16:04:05 +02003581 desc = gpiochip_get_desc(gc, p->chip_hwnum);
Alexandre Courbotad824782013-12-03 12:20:11 +09003582 *flags = p->flags;
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003583
3584 return desc;
Alexandre Courbotad824782013-12-03 12:20:11 +09003585 }
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003586
3587 return desc;
3588}
3589
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01003590static int platform_gpio_count(struct device *dev, const char *con_id)
3591{
3592 struct gpiod_lookup_table *table;
3593 struct gpiod_lookup *p;
3594 unsigned int count = 0;
3595
3596 table = gpiod_find_lookup_table(dev);
3597 if (!table)
3598 return -ENOENT;
3599
Geert Uytterhoeven4c033b52020-05-11 16:52:54 +02003600 for (p = &table->table[0]; p->key; p++) {
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01003601 if ((con_id && p->con_id && !strcmp(con_id, p->con_id)) ||
3602 (!con_id && !p->con_id))
3603 count++;
3604 }
3605 if (!count)
3606 return -ENOENT;
3607
3608 return count;
3609}
3610
3611/**
Dmitry Torokhov13949fa2019-09-12 20:22:39 -07003612 * fwnode_gpiod_get_index - obtain a GPIO from firmware node
3613 * @fwnode: handle of the firmware node
3614 * @con_id: function within the GPIO consumer
3615 * @index: index of the GPIO to obtain for the consumer
3616 * @flags: GPIO initialization flags
3617 * @label: label to attach to the requested GPIO
3618 *
3619 * This function can be used for drivers that get their configuration
3620 * from opaque firmware.
3621 *
3622 * The function properly finds the corresponding GPIO using whatever is the
3623 * underlying firmware interface and then makes sure that the GPIO
3624 * descriptor is requested before it is returned to the caller.
3625 *
3626 * Returns:
3627 * On successful request the GPIO pin is configured in accordance with
3628 * provided @flags.
3629 *
3630 * In case of error an ERR_PTR() is returned.
3631 */
3632struct gpio_desc *fwnode_gpiod_get_index(struct fwnode_handle *fwnode,
3633 const char *con_id, int index,
3634 enum gpiod_flags flags,
3635 const char *label)
3636{
3637 struct gpio_desc *desc;
3638 char prop_name[32]; /* 32 is max size of property name */
3639 unsigned int i;
3640
3641 for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
3642 if (con_id)
3643 snprintf(prop_name, sizeof(prop_name), "%s-%s",
3644 con_id, gpio_suffixes[i]);
3645 else
3646 snprintf(prop_name, sizeof(prop_name), "%s",
3647 gpio_suffixes[i]);
3648
3649 desc = fwnode_get_named_gpiod(fwnode, prop_name, index, flags,
3650 label);
Andy Shevchenko7b586962020-10-21 17:25:28 +03003651 if (!gpiod_not_found(desc))
Dmitry Torokhov13949fa2019-09-12 20:22:39 -07003652 break;
3653 }
3654
3655 return desc;
3656}
3657EXPORT_SYMBOL_GPL(fwnode_gpiod_get_index);
3658
3659/**
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01003660 * gpiod_count - return the number of GPIOs associated with a device / function
3661 * or -ENOENT if no GPIO has been assigned to the requested function
3662 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3663 * @con_id: function within the GPIO consumer
3664 */
3665int gpiod_count(struct device *dev, const char *con_id)
3666{
3667 int count = -ENOENT;
3668
3669 if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
Linus Walleijf626d6d2019-07-17 09:10:01 +02003670 count = of_gpio_get_count(dev, con_id);
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01003671 else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev))
3672 count = acpi_gpio_count(dev, con_id);
3673
3674 if (count < 0)
3675 count = platform_gpio_count(dev, con_id);
3676
3677 return count;
3678}
3679EXPORT_SYMBOL_GPL(gpiod_count);
3680
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003681/**
Thierry Reding08791622014-04-25 16:54:22 +02003682 * gpiod_get - obtain a GPIO for a given GPIO function
Alexandre Courbotad824782013-12-03 12:20:11 +09003683 * @dev: GPIO consumer, can be NULL for system-global GPIOs
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003684 * @con_id: function within the GPIO consumer
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003685 * @flags: optional GPIO initialization flags
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003686 *
3687 * Return the GPIO descriptor corresponding to the function con_id of device
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003688 * dev, -ENOENT if no GPIO has been assigned to the requested function, or
Colin Cronin20a8a962015-05-18 11:41:43 -07003689 * another IS_ERR() code if an error occurred while trying to acquire the GPIO.
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003690 */
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003691struct gpio_desc *__must_check gpiod_get(struct device *dev, const char *con_id,
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003692 enum gpiod_flags flags)
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003693{
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003694 return gpiod_get_index(dev, con_id, 0, flags);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003695}
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003696EXPORT_SYMBOL_GPL(gpiod_get);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003697
3698/**
Thierry Reding29a1f2332014-04-25 17:10:06 +02003699 * gpiod_get_optional - obtain an optional GPIO for a given GPIO function
3700 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3701 * @con_id: function within the GPIO consumer
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003702 * @flags: optional GPIO initialization flags
Thierry Reding29a1f2332014-04-25 17:10:06 +02003703 *
3704 * This is equivalent to gpiod_get(), except that when no GPIO was assigned to
3705 * the requested function it will return NULL. This is convenient for drivers
3706 * that need to handle optional GPIOs.
3707 */
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003708struct gpio_desc *__must_check gpiod_get_optional(struct device *dev,
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003709 const char *con_id,
3710 enum gpiod_flags flags)
Thierry Reding29a1f2332014-04-25 17:10:06 +02003711{
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003712 return gpiod_get_index_optional(dev, con_id, 0, flags);
Thierry Reding29a1f2332014-04-25 17:10:06 +02003713}
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003714EXPORT_SYMBOL_GPL(gpiod_get_optional);
Thierry Reding29a1f2332014-04-25 17:10:06 +02003715
Benoit Parrotf625d462015-02-02 11:44:44 -06003716
3717/**
3718 * gpiod_configure_flags - helper function to configure a given GPIO
3719 * @desc: gpio whose value will be assigned
3720 * @con_id: function within the GPIO consumer
Andy Shevchenkofed70262019-04-10 18:39:16 +03003721 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
3722 * of_find_gpio() or of_get_gpio_hog()
Benoit Parrotf625d462015-02-02 11:44:44 -06003723 * @dflags: gpiod_flags - optional GPIO initialization flags
3724 *
3725 * Return 0 on success, -ENOENT if no GPIO has been assigned to the
3726 * requested function and/or index, or another IS_ERR() code if an error
3727 * occurred while trying to acquire the GPIO.
3728 */
Andy Shevchenkoc29fd9e2017-05-23 20:03:16 +03003729int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id,
Johan Hovold85b03b32016-07-03 18:32:05 +02003730 unsigned long lflags, enum gpiod_flags dflags)
Benoit Parrotf625d462015-02-02 11:44:44 -06003731{
Linus Walleijd377f562019-07-16 11:11:45 +02003732 int ret;
Benoit Parrotf625d462015-02-02 11:44:44 -06003733
Johan Hovold85b03b32016-07-03 18:32:05 +02003734 if (lflags & GPIO_ACTIVE_LOW)
3735 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
Linus Walleijf926dfc2017-09-10 19:26:22 +02003736
Johan Hovold85b03b32016-07-03 18:32:05 +02003737 if (lflags & GPIO_OPEN_DRAIN)
3738 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
Linus Walleijf926dfc2017-09-10 19:26:22 +02003739 else if (dflags & GPIOD_FLAGS_BIT_OPEN_DRAIN) {
3740 /*
3741 * This enforces open drain mode from the consumer side.
3742 * This is necessary for some busses like I2C, but the lookup
3743 * should *REALLY* have specified them as open drain in the
3744 * first place, so print a little warning here.
3745 */
3746 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3747 gpiod_warn(desc,
3748 "enforced open drain please flag it properly in DT/ACPI DSDT/board file\n");
3749 }
3750
Johan Hovold85b03b32016-07-03 18:32:05 +02003751 if (lflags & GPIO_OPEN_SOURCE)
3752 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
Andrew Jefferye10f72b2017-11-30 14:25:24 +10303753
Thomas Petazzonid4499912019-02-07 17:28:58 +01003754 if ((lflags & GPIO_PULL_UP) && (lflags & GPIO_PULL_DOWN)) {
3755 gpiod_err(desc,
3756 "both pull-up and pull-down enabled, invalid configuration\n");
3757 return -EINVAL;
3758 }
3759
3760 if (lflags & GPIO_PULL_UP)
3761 set_bit(FLAG_PULL_UP, &desc->flags);
3762 else if (lflags & GPIO_PULL_DOWN)
3763 set_bit(FLAG_PULL_DOWN, &desc->flags);
3764
Linus Walleijd377f562019-07-16 11:11:45 +02003765 ret = gpiod_set_transitory(desc, (lflags & GPIO_TRANSITORY));
3766 if (ret < 0)
3767 return ret;
Johan Hovold85b03b32016-07-03 18:32:05 +02003768
Benoit Parrotf625d462015-02-02 11:44:44 -06003769 /* No particular flag request, return here... */
3770 if (!(dflags & GPIOD_FLAGS_BIT_DIR_SET)) {
Geert Uytterhoeven262b9012020-04-24 16:14:32 +02003771 gpiod_dbg(desc, "no flags found for %s\n", con_id);
Benoit Parrotf625d462015-02-02 11:44:44 -06003772 return 0;
3773 }
3774
3775 /* Process flags */
3776 if (dflags & GPIOD_FLAGS_BIT_DIR_OUT)
Linus Walleijd377f562019-07-16 11:11:45 +02003777 ret = gpiod_direction_output(desc,
Linus Walleijad177312016-11-13 23:02:44 +01003778 !!(dflags & GPIOD_FLAGS_BIT_DIR_VAL));
Benoit Parrotf625d462015-02-02 11:44:44 -06003779 else
Linus Walleijd377f562019-07-16 11:11:45 +02003780 ret = gpiod_direction_input(desc);
Benoit Parrotf625d462015-02-02 11:44:44 -06003781
Linus Walleijd377f562019-07-16 11:11:45 +02003782 return ret;
Benoit Parrotf625d462015-02-02 11:44:44 -06003783}
3784
Thierry Reding29a1f2332014-04-25 17:10:06 +02003785/**
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003786 * gpiod_get_index - obtain a GPIO from a multi-index GPIO function
Andy Shevchenkofdd6a5f2013-12-05 11:26:26 +02003787 * @dev: GPIO consumer, can be NULL for system-global GPIOs
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003788 * @con_id: function within the GPIO consumer
3789 * @idx: index of the GPIO to obtain in the consumer
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003790 * @flags: optional GPIO initialization flags
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003791 *
3792 * This variant of gpiod_get() allows to access GPIOs other than the first
3793 * defined one for functions that define several GPIOs.
3794 *
Alexandre Courbot2a3cf6a2013-12-11 11:32:28 +09003795 * Return a valid GPIO descriptor, -ENOENT if no GPIO has been assigned to the
3796 * requested function and/or index, or another IS_ERR() code if an error
Colin Cronin20a8a962015-05-18 11:41:43 -07003797 * occurred while trying to acquire the GPIO.
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003798 */
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003799struct gpio_desc *__must_check gpiod_get_index(struct device *dev,
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003800 const char *con_id,
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003801 unsigned int idx,
3802 enum gpiod_flags flags)
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003803{
Andy Shevchenko2d6c06f2019-04-10 18:39:17 +03003804 unsigned long lookupflags = GPIO_LOOKUP_FLAGS_DEFAULT;
Alexandre Courbot35c5d7f2013-11-23 19:34:50 +09003805 struct gpio_desc *desc = NULL;
Linus Walleijd377f562019-07-16 11:11:45 +02003806 int ret;
Linus Walleij7d18f0a2018-01-16 08:29:50 +01003807 /* Maybe we have a device name, maybe not */
3808 const char *devname = dev ? dev_name(dev) : "?";
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003809
3810 dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id);
3811
Rafael J. Wysocki4d8440b2015-03-10 23:08:57 +01003812 if (dev) {
3813 /* Using device tree? */
3814 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
3815 dev_dbg(dev, "using device tree for GPIO lookup\n");
3816 desc = of_find_gpio(dev, con_id, idx, &lookupflags);
3817 } else if (ACPI_COMPANION(dev)) {
3818 dev_dbg(dev, "using ACPI for GPIO lookup\n");
Andy Shevchenkoa31f5c32017-05-23 20:03:23 +03003819 desc = acpi_find_gpio(dev, con_id, idx, &flags, &lookupflags);
Rafael J. Wysocki4d8440b2015-03-10 23:08:57 +01003820 }
Alexandre Courbot35c5d7f2013-11-23 19:34:50 +09003821 }
3822
3823 /*
3824 * Either we are not using DT or ACPI, or their lookup did not return
3825 * a result. In that case, use platform lookup as a fallback.
3826 */
Andy Shevchenko7b586962020-10-21 17:25:28 +03003827 if (!desc || gpiod_not_found(desc)) {
Alexander Shiyan43a87852014-09-19 11:39:25 +04003828 dev_dbg(dev, "using lookup tables for GPIO lookup\n");
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003829 desc = gpiod_find(dev, con_id, idx, &lookupflags);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003830 }
3831
3832 if (IS_ERR(desc)) {
Wang Dongsheng9d5a1f22018-02-27 00:12:13 -08003833 dev_dbg(dev, "No GPIO consumer %s found\n", con_id);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003834 return desc;
3835 }
3836
Linus Walleij7d18f0a2018-01-16 08:29:50 +01003837 /*
3838 * If a connection label was passed use that, else attempt to use
3839 * the device name as label
3840 */
Linus Walleijd377f562019-07-16 11:11:45 +02003841 ret = gpiod_request(desc, con_id ? con_id : devname);
Andy Shevchenko8bbff392020-10-21 14:25:36 +03003842 if (ret) {
Linus Walleijd377f562019-07-16 11:11:45 +02003843 if (ret == -EBUSY && flags & GPIOD_FLAGS_BIT_NONEXCLUSIVE) {
Linus Walleijb0ce7b292018-10-12 14:54:12 +02003844 /*
3845 * This happens when there are several consumers for
3846 * the same GPIO line: we just return here without
3847 * further initialization. It is a bit if a hack.
3848 * This is necessary to support fixed regulators.
3849 *
3850 * FIXME: Make this more sane and safe.
3851 */
3852 dev_info(dev, "nonexclusive access to GPIO for %s\n",
3853 con_id ? con_id : devname);
3854 return desc;
3855 } else {
Linus Walleijd377f562019-07-16 11:11:45 +02003856 return ERR_PTR(ret);
Linus Walleijb0ce7b292018-10-12 14:54:12 +02003857 }
3858 }
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003859
Linus Walleijd377f562019-07-16 11:11:45 +02003860 ret = gpiod_configure_flags(desc, con_id, lookupflags, flags);
3861 if (ret < 0) {
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003862 dev_dbg(dev, "setup of GPIO %s failed\n", con_id);
3863 gpiod_put(desc);
Linus Walleijd377f562019-07-16 11:11:45 +02003864 return ERR_PTR(ret);
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003865 }
3866
Kent Gibson6accc372020-07-08 12:15:51 +08003867 blocking_notifier_call_chain(&desc->gdev->notifier,
3868 GPIOLINE_CHANGED_REQUESTED, desc);
Bartosz Golaszewski9fefca72020-05-09 16:08:13 +02003869
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003870 return desc;
3871}
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003872EXPORT_SYMBOL_GPL(gpiod_get_index);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07003873
3874/**
Mika Westerberg40b73182014-10-21 13:33:59 +02003875 * fwnode_get_named_gpiod - obtain a GPIO from firmware node
3876 * @fwnode: handle of the firmware node
3877 * @propname: name of the firmware property representing the GPIO
Linus Walleij6392cca2017-12-29 02:07:54 +01003878 * @index: index of the GPIO to obtain for the consumer
Andy Shevchenkoa264d102017-01-09 16:02:28 +02003879 * @dflags: GPIO initialization flags
Thierry Reding950d55f52017-07-24 16:57:22 +02003880 * @label: label to attach to the requested GPIO
Mika Westerberg40b73182014-10-21 13:33:59 +02003881 *
3882 * This function can be used for drivers that get their configuration
Linus Walleij6392cca2017-12-29 02:07:54 +01003883 * from opaque firmware.
Mika Westerberg40b73182014-10-21 13:33:59 +02003884 *
Linus Walleij6392cca2017-12-29 02:07:54 +01003885 * The function properly finds the corresponding GPIO using whatever is the
Mika Westerberg40b73182014-10-21 13:33:59 +02003886 * underlying firmware interface and then makes sure that the GPIO
3887 * descriptor is requested before it is returned to the caller.
3888 *
Thierry Reding950d55f52017-07-24 16:57:22 +02003889 * Returns:
Andy Shevchenkoff213782017-02-28 17:03:12 +02003890 * On successful request the GPIO pin is configured in accordance with
Andy Shevchenkoa264d102017-01-09 16:02:28 +02003891 * provided @dflags.
3892 *
Mika Westerberg40b73182014-10-21 13:33:59 +02003893 * In case of error an ERR_PTR() is returned.
3894 */
3895struct gpio_desc *fwnode_get_named_gpiod(struct fwnode_handle *fwnode,
Boris Brezillon537b94d2017-02-02 14:53:11 +01003896 const char *propname, int index,
Alexander Steinb2987d72017-01-12 17:39:24 +01003897 enum gpiod_flags dflags,
3898 const char *label)
Mika Westerberg40b73182014-10-21 13:33:59 +02003899{
Andy Shevchenko2d6c06f2019-04-10 18:39:17 +03003900 unsigned long lflags = GPIO_LOOKUP_FLAGS_DEFAULT;
Mika Westerberg40b73182014-10-21 13:33:59 +02003901 struct gpio_desc *desc = ERR_PTR(-ENODEV);
Mika Westerberg40b73182014-10-21 13:33:59 +02003902 int ret;
3903
3904 if (!fwnode)
3905 return ERR_PTR(-EINVAL);
3906
3907 if (is_of_node(fwnode)) {
Linus Walleij6392cca2017-12-29 02:07:54 +01003908 desc = gpiod_get_from_of_node(to_of_node(fwnode),
3909 propname, index,
3910 dflags,
3911 label);
3912 return desc;
Mika Westerberg40b73182014-10-21 13:33:59 +02003913 } else if (is_acpi_node(fwnode)) {
3914 struct acpi_gpio_info info;
3915
Boris Brezillon537b94d2017-02-02 14:53:11 +01003916 desc = acpi_node_get_gpiod(fwnode, propname, index, &info);
Linus Walleij6392cca2017-12-29 02:07:54 +01003917 if (IS_ERR(desc))
3918 return desc;
3919
3920 acpi_gpio_update_gpiod_flags(&dflags, &info);
Andy Shevchenko606be342019-04-10 18:39:20 +03003921 acpi_gpio_update_gpiod_lookup_flags(&lflags, &info);
Mika Westerberg40b73182014-10-21 13:33:59 +02003922 }
3923
Linus Walleij6392cca2017-12-29 02:07:54 +01003924 /* Currently only ACPI takes this path */
Alexander Steinb2987d72017-01-12 17:39:24 +01003925 ret = gpiod_request(desc, label);
Johan Hovold85b03b32016-07-03 18:32:05 +02003926 if (ret)
3927 return ERR_PTR(ret);
3928
Andy Shevchenkoa264d102017-01-09 16:02:28 +02003929 ret = gpiod_configure_flags(desc, propname, lflags, dflags);
3930 if (ret < 0) {
3931 gpiod_put(desc);
3932 return ERR_PTR(ret);
Laurent Pinchart90b665f2015-10-13 00:20:21 +03003933 }
3934
Kent Gibson6accc372020-07-08 12:15:51 +08003935 blocking_notifier_call_chain(&desc->gdev->notifier,
3936 GPIOLINE_CHANGED_REQUESTED, desc);
Bartosz Golaszewski9fefca72020-05-09 16:08:13 +02003937
Mika Westerberg40b73182014-10-21 13:33:59 +02003938 return desc;
3939}
3940EXPORT_SYMBOL_GPL(fwnode_get_named_gpiod);
3941
3942/**
Thierry Reding29a1f2332014-04-25 17:10:06 +02003943 * gpiod_get_index_optional - obtain an optional GPIO from a multi-index GPIO
3944 * function
3945 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3946 * @con_id: function within the GPIO consumer
3947 * @index: index of the GPIO to obtain in the consumer
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003948 * @flags: optional GPIO initialization flags
Thierry Reding29a1f2332014-04-25 17:10:06 +02003949 *
3950 * This is equivalent to gpiod_get_index(), except that when no GPIO with the
3951 * specified index was assigned to the requested function it will return NULL.
3952 * This is convenient for drivers that need to handle optional GPIOs.
3953 */
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003954struct gpio_desc *__must_check gpiod_get_index_optional(struct device *dev,
Thierry Reding29a1f2332014-04-25 17:10:06 +02003955 const char *con_id,
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003956 unsigned int index,
3957 enum gpiod_flags flags)
Thierry Reding29a1f2332014-04-25 17:10:06 +02003958{
3959 struct gpio_desc *desc;
3960
Alexandre Courbot39b2bbe2014-07-25 23:38:36 +09003961 desc = gpiod_get_index(dev, con_id, index, flags);
Andy Shevchenko7b586962020-10-21 17:25:28 +03003962 if (gpiod_not_found(desc))
3963 return NULL;
Thierry Reding29a1f2332014-04-25 17:10:06 +02003964
3965 return desc;
3966}
Uwe Kleine-Königb17d1bf2015-02-11 11:52:37 +01003967EXPORT_SYMBOL_GPL(gpiod_get_index_optional);
Thierry Reding29a1f2332014-04-25 17:10:06 +02003968
3969/**
Benoit Parrotf625d462015-02-02 11:44:44 -06003970 * gpiod_hog - Hog the specified GPIO desc given the provided flags
3971 * @desc: gpio whose value will be assigned
3972 * @name: gpio line name
Andy Shevchenkofed70262019-04-10 18:39:16 +03003973 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
3974 * of_find_gpio() or of_get_gpio_hog()
Benoit Parrotf625d462015-02-02 11:44:44 -06003975 * @dflags: gpiod_flags - optional GPIO initialization flags
3976 */
3977int gpiod_hog(struct gpio_desc *desc, const char *name,
3978 unsigned long lflags, enum gpiod_flags dflags)
3979{
Linus Walleija0b66a72020-03-29 16:04:05 +02003980 struct gpio_chip *gc;
Benoit Parrotf625d462015-02-02 11:44:44 -06003981 struct gpio_desc *local_desc;
3982 int hwnum;
Linus Walleijd377f562019-07-16 11:11:45 +02003983 int ret;
Benoit Parrotf625d462015-02-02 11:44:44 -06003984
Linus Walleija0b66a72020-03-29 16:04:05 +02003985 gc = gpiod_to_chip(desc);
Benoit Parrotf625d462015-02-02 11:44:44 -06003986 hwnum = gpio_chip_hwgpio(desc);
3987
Linus Walleija0b66a72020-03-29 16:04:05 +02003988 local_desc = gpiochip_request_own_desc(gc, hwnum, name,
Linus Walleij5923ea62019-04-26 14:40:18 +02003989 lflags, dflags);
Benoit Parrotf625d462015-02-02 11:44:44 -06003990 if (IS_ERR(local_desc)) {
Linus Walleijd377f562019-07-16 11:11:45 +02003991 ret = PTR_ERR(local_desc);
Laxman Dewanganc31a5712016-03-11 19:13:21 +05303992 pr_err("requesting hog GPIO %s (chip %s, offset %d) failed, %d\n",
Linus Walleija0b66a72020-03-29 16:04:05 +02003993 name, gc->label, hwnum, ret);
Linus Walleijd377f562019-07-16 11:11:45 +02003994 return ret;
Benoit Parrotf625d462015-02-02 11:44:44 -06003995 }
3996
Benoit Parrotf625d462015-02-02 11:44:44 -06003997 /* Mark GPIO as hogged so it can be identified and removed later */
3998 set_bit(FLAG_IS_HOGGED, &desc->flags);
3999
Geert Uytterhoeven262b9012020-04-24 16:14:32 +02004000 gpiod_info(desc, "hogged as %s%s\n",
Bartosz Golaszewskib27f3002019-11-13 14:16:29 +01004001 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ? "output" : "input",
4002 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ?
4003 (dflags & GPIOD_FLAGS_BIT_DIR_VAL) ? "/high" : "/low" : "");
Benoit Parrotf625d462015-02-02 11:44:44 -06004004
4005 return 0;
4006}
4007
4008/**
4009 * gpiochip_free_hogs - Scan gpio-controller chip and release GPIO hog
Linus Walleija0b66a72020-03-29 16:04:05 +02004010 * @gc: gpio chip to act on
Benoit Parrotf625d462015-02-02 11:44:44 -06004011 */
Linus Walleija0b66a72020-03-29 16:04:05 +02004012static void gpiochip_free_hogs(struct gpio_chip *gc)
Benoit Parrotf625d462015-02-02 11:44:44 -06004013{
4014 int id;
4015
Linus Walleija0b66a72020-03-29 16:04:05 +02004016 for (id = 0; id < gc->ngpio; id++) {
4017 if (test_bit(FLAG_IS_HOGGED, &gc->gpiodev->descs[id].flags))
4018 gpiochip_free_own_desc(&gc->gpiodev->descs[id]);
Benoit Parrotf625d462015-02-02 11:44:44 -06004019 }
4020}
4021
4022/**
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004023 * gpiod_get_array - obtain multiple GPIOs from a multi-index GPIO function
4024 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4025 * @con_id: function within the GPIO consumer
4026 * @flags: optional GPIO initialization flags
4027 *
4028 * This function acquires all the GPIOs defined under a given function.
4029 *
4030 * Return a struct gpio_descs containing an array of descriptors, -ENOENT if
4031 * no GPIO has been assigned to the requested function, or another IS_ERR()
4032 * code if an error occurred while trying to acquire the GPIOs.
4033 */
4034struct gpio_descs *__must_check gpiod_get_array(struct device *dev,
4035 const char *con_id,
4036 enum gpiod_flags flags)
4037{
4038 struct gpio_desc *desc;
4039 struct gpio_descs *descs;
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004040 struct gpio_array *array_info = NULL;
Linus Walleija0b66a72020-03-29 16:04:05 +02004041 struct gpio_chip *gc;
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004042 int count, bitmap_size;
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004043
4044 count = gpiod_count(dev, con_id);
4045 if (count < 0)
4046 return ERR_PTR(count);
4047
Kees Cookacafe7e2018-05-08 13:45:50 -07004048 descs = kzalloc(struct_size(descs, desc, count), GFP_KERNEL);
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004049 if (!descs)
4050 return ERR_PTR(-ENOMEM);
4051
4052 for (descs->ndescs = 0; descs->ndescs < count; ) {
4053 desc = gpiod_get_index(dev, con_id, descs->ndescs, flags);
4054 if (IS_ERR(desc)) {
4055 gpiod_put_array(descs);
4056 return ERR_CAST(desc);
4057 }
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004058
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004059 descs->desc[descs->ndescs] = desc;
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004060
Linus Walleija0b66a72020-03-29 16:04:05 +02004061 gc = gpiod_to_chip(desc);
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004062 /*
Janusz Krzysztofikc4c958a2018-09-24 01:53:36 +02004063 * If pin hardware number of array member 0 is also 0, select
4064 * its chip as a candidate for fast bitmap processing path.
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004065 */
Janusz Krzysztofikc4c958a2018-09-24 01:53:36 +02004066 if (descs->ndescs == 0 && gpio_chip_hwgpio(desc) == 0) {
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004067 struct gpio_descs *array;
4068
Linus Walleija0b66a72020-03-29 16:04:05 +02004069 bitmap_size = BITS_TO_LONGS(gc->ngpio > count ?
4070 gc->ngpio : count);
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004071
4072 array = kzalloc(struct_size(descs, desc, count) +
4073 struct_size(array_info, invert_mask,
4074 3 * bitmap_size), GFP_KERNEL);
4075 if (!array) {
4076 gpiod_put_array(descs);
4077 return ERR_PTR(-ENOMEM);
4078 }
4079
4080 memcpy(array, descs,
4081 struct_size(descs, desc, descs->ndescs + 1));
4082 kfree(descs);
4083
4084 descs = array;
4085 array_info = (void *)(descs->desc + count);
4086 array_info->get_mask = array_info->invert_mask +
4087 bitmap_size;
4088 array_info->set_mask = array_info->get_mask +
4089 bitmap_size;
4090
4091 array_info->desc = descs->desc;
4092 array_info->size = count;
Linus Walleija0b66a72020-03-29 16:04:05 +02004093 array_info->chip = gc;
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004094 bitmap_set(array_info->get_mask, descs->ndescs,
4095 count - descs->ndescs);
4096 bitmap_set(array_info->set_mask, descs->ndescs,
4097 count - descs->ndescs);
4098 descs->info = array_info;
4099 }
Janusz Krzysztofikc4c958a2018-09-24 01:53:36 +02004100 /* Unmark array members which don't belong to the 'fast' chip */
Linus Walleija0b66a72020-03-29 16:04:05 +02004101 if (array_info && array_info->chip != gc) {
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004102 __clear_bit(descs->ndescs, array_info->get_mask);
4103 __clear_bit(descs->ndescs, array_info->set_mask);
Janusz Krzysztofikc4c958a2018-09-24 01:53:36 +02004104 }
4105 /*
4106 * Detect array members which belong to the 'fast' chip
4107 * but their pins are not in hardware order.
4108 */
4109 else if (array_info &&
4110 gpio_chip_hwgpio(desc) != descs->ndescs) {
4111 /*
4112 * Don't use fast path if all array members processed so
4113 * far belong to the same chip as this one but its pin
4114 * hardware number is different from its array index.
4115 */
4116 if (bitmap_full(array_info->get_mask, descs->ndescs)) {
4117 array_info = NULL;
4118 } else {
4119 __clear_bit(descs->ndescs,
4120 array_info->get_mask);
4121 __clear_bit(descs->ndescs,
4122 array_info->set_mask);
4123 }
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004124 } else if (array_info) {
4125 /* Exclude open drain or open source from fast output */
Linus Walleija0b66a72020-03-29 16:04:05 +02004126 if (gpiochip_line_is_open_drain(gc, descs->ndescs) ||
4127 gpiochip_line_is_open_source(gc, descs->ndescs))
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004128 __clear_bit(descs->ndescs,
4129 array_info->set_mask);
4130 /* Identify 'fast' pins which require invertion */
4131 if (gpiod_is_active_low(desc))
4132 __set_bit(descs->ndescs,
4133 array_info->invert_mask);
4134 }
4135
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004136 descs->ndescs++;
4137 }
Janusz Krzysztofikbf9346f2018-09-05 23:50:06 +02004138 if (array_info)
4139 dev_dbg(dev,
4140 "GPIO array info: chip=%s, size=%d, get_mask=%lx, set_mask=%lx, invert_mask=%lx\n",
4141 array_info->chip->label, array_info->size,
4142 *array_info->get_mask, *array_info->set_mask,
4143 *array_info->invert_mask);
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004144 return descs;
4145}
4146EXPORT_SYMBOL_GPL(gpiod_get_array);
4147
4148/**
4149 * gpiod_get_array_optional - obtain multiple GPIOs from a multi-index GPIO
4150 * function
4151 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4152 * @con_id: function within the GPIO consumer
4153 * @flags: optional GPIO initialization flags
4154 *
4155 * This is equivalent to gpiod_get_array(), except that when no GPIO was
4156 * assigned to the requested function it will return NULL.
4157 */
4158struct gpio_descs *__must_check gpiod_get_array_optional(struct device *dev,
4159 const char *con_id,
4160 enum gpiod_flags flags)
4161{
4162 struct gpio_descs *descs;
4163
4164 descs = gpiod_get_array(dev, con_id, flags);
Andy Shevchenko7b586962020-10-21 17:25:28 +03004165 if (gpiod_not_found(descs))
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004166 return NULL;
4167
4168 return descs;
4169}
4170EXPORT_SYMBOL_GPL(gpiod_get_array_optional);
4171
4172/**
Alexandre Courbotbae48da2013-10-17 10:21:38 -07004173 * gpiod_put - dispose of a GPIO descriptor
4174 * @desc: GPIO descriptor to dispose of
4175 *
4176 * No descriptor can be used after gpiod_put() has been called on it.
4177 */
4178void gpiod_put(struct gpio_desc *desc)
4179{
Andy Shevchenko1d7765b2019-03-26 17:21:14 +02004180 if (desc)
4181 gpiod_free(desc);
Alexandre Courbotbae48da2013-10-17 10:21:38 -07004182}
4183EXPORT_SYMBOL_GPL(gpiod_put);
David Brownelld2876d02008-02-04 22:28:20 -08004184
Rojhalat Ibrahim66858522015-02-11 17:27:58 +01004185/**
4186 * gpiod_put_array - dispose of multiple GPIO descriptors
4187 * @descs: struct gpio_descs containing an array of descriptors
4188 */
4189void gpiod_put_array(struct gpio_descs *descs)
4190{
4191 unsigned int i;
4192
4193 for (i = 0; i < descs->ndescs; i++)
4194 gpiod_put(descs->desc[i]);
4195
4196 kfree(descs);
4197}
4198EXPORT_SYMBOL_GPL(gpiod_put_array);
4199
Linus Walleij3c702e92015-10-21 15:29:53 +02004200static int __init gpiolib_dev_init(void)
4201{
4202 int ret;
4203
4204 /* Register GPIO sysfs bus */
Andy Shevchenkob1911712018-07-03 03:39:03 +03004205 ret = bus_register(&gpio_bus_type);
Linus Walleij3c702e92015-10-21 15:29:53 +02004206 if (ret < 0) {
4207 pr_err("gpiolib: could not register GPIO bus type\n");
4208 return ret;
4209 }
4210
Geert Uytterhoevenddd88912019-11-27 09:42:47 +01004211 ret = alloc_chrdev_region(&gpio_devt, 0, GPIO_DEV_MAX, GPIOCHIP_NAME);
Linus Walleij3c702e92015-10-21 15:29:53 +02004212 if (ret < 0) {
4213 pr_err("gpiolib: failed to allocate char dev region\n");
4214 bus_unregister(&gpio_bus_type);
Geert Uytterhoeven63636d92020-02-20 14:01:49 +01004215 return ret;
Linus Walleij3c702e92015-10-21 15:29:53 +02004216 }
Geert Uytterhoeven63636d92020-02-20 14:01:49 +01004217
4218 gpiolib_initialized = true;
4219 gpiochip_setup_devs();
4220
David Gow8650b602020-04-24 21:46:55 -07004221#if IS_ENABLED(CONFIG_OF_DYNAMIC) && IS_ENABLED(CONFIG_OF_GPIO)
4222 WARN_ON(of_reconfig_notifier_register(&gpio_of_notifier));
4223#endif /* CONFIG_OF_DYNAMIC && CONFIG_OF_GPIO */
Geert Uytterhoeven63636d92020-02-20 14:01:49 +01004224
Linus Walleij3c702e92015-10-21 15:29:53 +02004225 return ret;
4226}
4227core_initcall(gpiolib_dev_init);
4228
David Brownelld2876d02008-02-04 22:28:20 -08004229#ifdef CONFIG_DEBUG_FS
4230
Linus Walleijfdeb8e12016-02-10 10:57:36 +01004231static void gpiolib_dbg_show(struct seq_file *s, struct gpio_device *gdev)
David Brownelld2876d02008-02-04 22:28:20 -08004232{
4233 unsigned i;
Linus Walleija0b66a72020-03-29 16:04:05 +02004234 struct gpio_chip *gc = gdev->chip;
Linus Walleijfdeb8e12016-02-10 10:57:36 +01004235 unsigned gpio = gdev->base;
4236 struct gpio_desc *gdesc = &gdev->descs[0];
Linus Walleij90fd2272018-10-01 23:06:17 +02004237 bool is_out;
4238 bool is_irq;
4239 bool active_low;
David Brownelld2876d02008-02-04 22:28:20 -08004240
Linus Walleijfdeb8e12016-02-10 10:57:36 +01004241 for (i = 0; i < gdev->ngpio; i++, gpio++, gdesc++) {
Markus Pargmannced433e2015-08-14 16:11:02 +02004242 if (!test_bit(FLAG_REQUESTED, &gdesc->flags)) {
4243 if (gdesc->name) {
4244 seq_printf(s, " gpio-%-3d (%-20.20s)\n",
4245 gpio, gdesc->name);
4246 }
David Brownelld2876d02008-02-04 22:28:20 -08004247 continue;
Markus Pargmannced433e2015-08-14 16:11:02 +02004248 }
David Brownelld2876d02008-02-04 22:28:20 -08004249
Alexandre Courbot372e7222013-02-03 01:29:29 +09004250 gpiod_get_direction(gdesc);
David Brownelld2876d02008-02-04 22:28:20 -08004251 is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
Linus Walleijd468bf92013-09-24 11:54:38 +02004252 is_irq = test_bit(FLAG_USED_AS_IRQ, &gdesc->flags);
Linus Walleij90fd2272018-10-01 23:06:17 +02004253 active_low = test_bit(FLAG_ACTIVE_LOW, &gdesc->flags);
4254 seq_printf(s, " gpio-%-3d (%-20.20s|%-20.20s) %s %s %s%s",
Markus Pargmannced433e2015-08-14 16:11:02 +02004255 gpio, gdesc->name ? gdesc->name : "", gdesc->label,
David Brownelld2876d02008-02-04 22:28:20 -08004256 is_out ? "out" : "in ",
Linus Walleija0b66a72020-03-29 16:04:05 +02004257 gc->get ? (gc->get(gc, i) ? "hi" : "lo") : "? ",
Linus Walleij90fd2272018-10-01 23:06:17 +02004258 is_irq ? "IRQ " : "",
4259 active_low ? "ACTIVE LOW" : "");
David Brownelld2876d02008-02-04 22:28:20 -08004260 seq_printf(s, "\n");
4261 }
4262}
4263
Thierry Redingf9c4a312012-04-12 13:26:01 +02004264static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
David Brownelld2876d02008-02-04 22:28:20 -08004265{
Grant Likely362432a2013-02-09 09:41:49 +00004266 unsigned long flags;
Linus Walleijff2b1352015-10-20 11:10:38 +02004267 struct gpio_device *gdev = NULL;
Alexandre Courbotcb1650d2013-02-03 01:29:27 +09004268 loff_t index = *pos;
Thierry Redingf9c4a312012-04-12 13:26:01 +02004269
4270 s->private = "";
4271
Grant Likely362432a2013-02-09 09:41:49 +00004272 spin_lock_irqsave(&gpio_lock, flags);
Linus Walleijff2b1352015-10-20 11:10:38 +02004273 list_for_each_entry(gdev, &gpio_devices, list)
Grant Likely362432a2013-02-09 09:41:49 +00004274 if (index-- == 0) {
4275 spin_unlock_irqrestore(&gpio_lock, flags);
Linus Walleijff2b1352015-10-20 11:10:38 +02004276 return gdev;
Grant Likely362432a2013-02-09 09:41:49 +00004277 }
4278 spin_unlock_irqrestore(&gpio_lock, flags);
Alexandre Courbotcb1650d2013-02-03 01:29:27 +09004279
4280 return NULL;
Thierry Redingf9c4a312012-04-12 13:26:01 +02004281}
4282
4283static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
4284{
Grant Likely362432a2013-02-09 09:41:49 +00004285 unsigned long flags;
Linus Walleijff2b1352015-10-20 11:10:38 +02004286 struct gpio_device *gdev = v;
Thierry Redingf9c4a312012-04-12 13:26:01 +02004287 void *ret = NULL;
4288
Grant Likely362432a2013-02-09 09:41:49 +00004289 spin_lock_irqsave(&gpio_lock, flags);
Linus Walleijff2b1352015-10-20 11:10:38 +02004290 if (list_is_last(&gdev->list, &gpio_devices))
Alexandre Courbotcb1650d2013-02-03 01:29:27 +09004291 ret = NULL;
4292 else
Linus Walleijff2b1352015-10-20 11:10:38 +02004293 ret = list_entry(gdev->list.next, struct gpio_device, list);
Grant Likely362432a2013-02-09 09:41:49 +00004294 spin_unlock_irqrestore(&gpio_lock, flags);
Thierry Redingf9c4a312012-04-12 13:26:01 +02004295
4296 s->private = "\n";
4297 ++*pos;
4298
4299 return ret;
4300}
4301
4302static void gpiolib_seq_stop(struct seq_file *s, void *v)
4303{
4304}
4305
4306static int gpiolib_seq_show(struct seq_file *s, void *v)
4307{
Linus Walleijff2b1352015-10-20 11:10:38 +02004308 struct gpio_device *gdev = v;
Linus Walleija0b66a72020-03-29 16:04:05 +02004309 struct gpio_chip *gc = gdev->chip;
Linus Walleijff2b1352015-10-20 11:10:38 +02004310 struct device *parent;
Thierry Redingf9c4a312012-04-12 13:26:01 +02004311
Linus Walleija0b66a72020-03-29 16:04:05 +02004312 if (!gc) {
Linus Walleijff2b1352015-10-20 11:10:38 +02004313 seq_printf(s, "%s%s: (dangling chip)", (char *)s->private,
4314 dev_name(&gdev->dev));
4315 return 0;
4316 }
4317
4318 seq_printf(s, "%s%s: GPIOs %d-%d", (char *)s->private,
4319 dev_name(&gdev->dev),
Linus Walleijfdeb8e12016-02-10 10:57:36 +01004320 gdev->base, gdev->base + gdev->ngpio - 1);
Linus Walleija0b66a72020-03-29 16:04:05 +02004321 parent = gc->parent;
Linus Walleijff2b1352015-10-20 11:10:38 +02004322 if (parent)
4323 seq_printf(s, ", parent: %s/%s",
4324 parent->bus ? parent->bus->name : "no-bus",
4325 dev_name(parent));
Linus Walleija0b66a72020-03-29 16:04:05 +02004326 if (gc->label)
4327 seq_printf(s, ", %s", gc->label);
4328 if (gc->can_sleep)
Thierry Redingf9c4a312012-04-12 13:26:01 +02004329 seq_printf(s, ", can sleep");
4330 seq_printf(s, ":\n");
4331
Linus Walleija0b66a72020-03-29 16:04:05 +02004332 if (gc->dbg_show)
4333 gc->dbg_show(s, gc);
Thierry Redingf9c4a312012-04-12 13:26:01 +02004334 else
Linus Walleijfdeb8e12016-02-10 10:57:36 +01004335 gpiolib_dbg_show(s, gdev);
Thierry Redingf9c4a312012-04-12 13:26:01 +02004336
David Brownelld2876d02008-02-04 22:28:20 -08004337 return 0;
4338}
4339
Andy Shevchenko425c5b32020-09-10 13:19:35 +03004340static const struct seq_operations gpiolib_sops = {
Thierry Redingf9c4a312012-04-12 13:26:01 +02004341 .start = gpiolib_seq_start,
4342 .next = gpiolib_seq_next,
4343 .stop = gpiolib_seq_stop,
4344 .show = gpiolib_seq_show,
4345};
Andy Shevchenko425c5b32020-09-10 13:19:35 +03004346DEFINE_SEQ_ATTRIBUTE(gpiolib);
David Brownelld2876d02008-02-04 22:28:20 -08004347
4348static int __init gpiolib_debugfs_init(void)
4349{
4350 /* /sys/kernel/debug/gpio */
Andy Shevchenko425c5b32020-09-10 13:19:35 +03004351 debugfs_create_file("gpio", 0444, NULL, NULL, &gpiolib_fops);
David Brownelld2876d02008-02-04 22:28:20 -08004352 return 0;
4353}
4354subsys_initcall(gpiolib_debugfs_init);
4355
4356#endif /* DEBUG_FS */