Linux Audio

Check our new training course

Loading...
v4.6
   1#include <linux/kernel.h>
   2#include <linux/module.h>
   3#include <linux/interrupt.h>
   4#include <linux/irq.h>
   5#include <linux/spinlock.h>
   6#include <linux/list.h>
   7#include <linux/device.h>
   8#include <linux/err.h>
   9#include <linux/debugfs.h>
  10#include <linux/seq_file.h>
  11#include <linux/gpio.h>
  12#include <linux/of_gpio.h>
  13#include <linux/idr.h>
  14#include <linux/slab.h>
  15#include <linux/acpi.h>
  16#include <linux/gpio/driver.h>
  17#include <linux/gpio/machine.h>
  18#include <linux/pinctrl/consumer.h>
  19#include <linux/idr.h>
  20#include <linux/cdev.h>
  21#include <linux/fs.h>
  22#include <linux/uaccess.h>
  23#include <uapi/linux/gpio.h>
  24
  25#include "gpiolib.h"
  26
  27#define CREATE_TRACE_POINTS
  28#include <trace/events/gpio.h>
  29
  30/* Implementation infrastructure for GPIO interfaces.
 
 
 
  31 *
  32 * The GPIO programming interface allows for inlining speed-critical
  33 * get/set operations for common cases, so that access to SOC-integrated
  34 * GPIOs can sometimes cost only an instruction or two per bit.
 
 
  35 */
  36
  37
  38/* When debugging, extend minimal trust to callers and platform code.
  39 * Also emit diagnostic messages that may help initial bringup, when
  40 * board setup or driver bugs are most common.
  41 *
  42 * Otherwise, minimize overhead in what may be bitbanging codepaths.
  43 */
  44#ifdef	DEBUG
  45#define	extra_checks	1
  46#else
  47#define	extra_checks	0
  48#endif
  49
  50/* Device and char device-related information */
  51static DEFINE_IDA(gpio_ida);
  52static dev_t gpio_devt;
  53#define GPIO_DEV_MAX 256 /* 256 GPIO chip devices supported */
  54static struct bus_type gpio_bus_type = {
  55	.name = "gpio",
  56};
  57
  58/* gpio_lock prevents conflicts during gpio_desc[] table updates.
  59 * While any GPIO is requested, its gpio_chip is not removable;
  60 * each GPIO's "requested" flag serves as a lock and refcount.
  61 */
  62DEFINE_SPINLOCK(gpio_lock);
  63
  64static DEFINE_MUTEX(gpio_lookup_lock);
  65static LIST_HEAD(gpio_lookup_list);
  66LIST_HEAD(gpio_devices);
 
 
 
 
 
 
 
 
 
 
 
  67
  68static void gpiochip_free_hogs(struct gpio_chip *chip);
  69static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip);
  70
  71static bool gpiolib_initialized;
 
 
 
 
 
 
 
 
 
 
 
  72
  73static inline void desc_set_label(struct gpio_desc *d, const char *label)
  74{
 
  75	d->label = label;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  76}
  77
  78/**
  79 * Convert a GPIO number to its descriptor
 
 
 
 
 
 
 
 
  80 */
  81struct gpio_desc *gpio_to_desc(unsigned gpio)
  82{
  83	struct gpio_device *gdev;
  84	unsigned long flags;
 
 
 
 
  85
  86	spin_lock_irqsave(&gpio_lock, flags);
  87
  88	list_for_each_entry(gdev, &gpio_devices, list) {
  89		if (gdev->base <= gpio &&
  90		    gdev->base + gdev->ngpio > gpio) {
  91			spin_unlock_irqrestore(&gpio_lock, flags);
  92			return &gdev->descs[gpio - gdev->base];
 
  93		}
 
 
  94	}
  95
 
 
 
  96	spin_unlock_irqrestore(&gpio_lock, flags);
  97
  98	if (!gpio_is_valid(gpio))
  99		WARN(1, "invalid GPIO %d\n", gpio);
 100
 101	return NULL;
 102}
 103EXPORT_SYMBOL_GPL(gpio_to_desc);
 104
 105/**
 106 * Get the GPIO descriptor corresponding to the given hw number for this chip.
 
 
 107 */
 108struct gpio_desc *gpiochip_get_desc(struct gpio_chip *chip,
 109				    u16 hwnum)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 110{
 111	struct gpio_device *gdev = chip->gpiodev;
 
 112
 113	if (hwnum >= gdev->ngpio)
 114		return ERR_PTR(-EINVAL);
 115
 116	return &gdev->descs[hwnum];
 
 
 
 
 
 
 
 
 117}
 118
 119/**
 120 * Convert a GPIO descriptor to the integer namespace.
 121 * This should disappear in the future but is needed since we still
 122 * use GPIO numbers for error messages and sysfs nodes
 123 */
 124int desc_to_gpio(const struct gpio_desc *desc)
 125{
 126	return desc->gdev->base + (desc - &desc->gdev->descs[0]);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 127}
 128EXPORT_SYMBOL_GPL(desc_to_gpio);
 129
 
 
 130
 131/**
 132 * gpiod_to_chip - Return the GPIO chip to which a GPIO descriptor belongs
 133 * @desc:	descriptor to return the chip of
 134 */
 135struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
 136{
 137	if (!desc || !desc->gdev || !desc->gdev->chip)
 138		return NULL;
 139	return desc->gdev->chip;
 140}
 141EXPORT_SYMBOL_GPL(gpiod_to_chip);
 142
 143/* dynamic allocation of GPIOs, e.g. on a hotplugged device */
 144static int gpiochip_find_base(int ngpio)
 145{
 146	struct gpio_device *gdev;
 147	int base = ARCH_NR_GPIOS - ngpio;
 148
 149	list_for_each_entry_reverse(gdev, &gpio_devices, list) {
 150		/* found a free space? */
 151		if (gdev->base + gdev->ngpio <= base)
 152			break;
 153		else
 154			/* nope, check the space right before the chip */
 155			base = gdev->base - ngpio;
 156	}
 157
 158	if (gpio_is_valid(base)) {
 159		pr_debug("%s: found new base at %d\n", __func__, base);
 160		return base;
 161	} else {
 162		pr_err("%s: cannot find free range\n", __func__);
 163		return -ENOSPC;
 164	}
 165}
 166
 167/**
 168 * gpiod_get_direction - return the current direction of a GPIO
 169 * @desc:	GPIO to get the direction of
 170 *
 171 * Return GPIOF_DIR_IN or GPIOF_DIR_OUT, or an error code in case of error.
 172 *
 173 * This function may sleep if gpiod_cansleep() is true.
 174 */
 175int gpiod_get_direction(struct gpio_desc *desc)
 176{
 177	struct gpio_chip	*chip;
 178	unsigned		offset;
 179	int			status = -EINVAL;
 180
 181	chip = gpiod_to_chip(desc);
 182	offset = gpio_chip_hwgpio(desc);
 183
 184	if (!chip->get_direction)
 185		return status;
 
 186
 187	status = chip->get_direction(chip, offset);
 188	if (status > 0) {
 189		/* GPIOF_DIR_IN, or other positive */
 190		status = 1;
 191		clear_bit(FLAG_IS_OUT, &desc->flags);
 192	}
 193	if (status == 0) {
 194		/* GPIOF_DIR_OUT */
 195		set_bit(FLAG_IS_OUT, &desc->flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 196	}
 
 
 197	return status;
 198}
 199EXPORT_SYMBOL_GPL(gpiod_get_direction);
 200
 201/*
 202 * Add a new chip to the global chips list, keeping the list of chips sorted
 203 * by range(means [base, base + ngpio - 1]) order.
 204 *
 205 * Return -EBUSY if the new chip overlaps with some other chip's integer
 206 * space.
 207 */
 208static int gpiodev_add_to_list(struct gpio_device *gdev)
 209{
 210	struct gpio_device *prev, *next;
 211
 212	if (list_empty(&gpio_devices)) {
 213		/* initial entry in list */
 214		list_add_tail(&gdev->list, &gpio_devices);
 215		return 0;
 216	}
 217
 218	next = list_entry(gpio_devices.next, struct gpio_device, list);
 219	if (gdev->base + gdev->ngpio <= next->base) {
 220		/* add before first entry */
 221		list_add(&gdev->list, &gpio_devices);
 222		return 0;
 223	}
 224
 225	prev = list_entry(gpio_devices.prev, struct gpio_device, list);
 226	if (prev->base + prev->ngpio <= gdev->base) {
 227		/* add behind last entry */
 228		list_add_tail(&gdev->list, &gpio_devices);
 229		return 0;
 230	}
 231
 232	list_for_each_entry_safe(prev, next, &gpio_devices, list) {
 233		/* at the end of the list */
 234		if (&next->list == &gpio_devices)
 235			break;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 236
 237		/* add between prev and next */
 238		if (prev->base + prev->ngpio <= gdev->base
 239				&& gdev->base + gdev->ngpio <= next->base) {
 240			list_add(&gdev->list, &prev->list);
 241			return 0;
 
 
 
 
 
 
 
 
 
 
 
 242		}
 243	}
 244
 245	dev_err(&gdev->dev, "GPIO integer space overlap, cannot add chip\n");
 246	return -EBUSY;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 247}
 248
 249/**
 250 * Convert a GPIO name to its descriptor
 251 */
 252static struct gpio_desc *gpio_name_to_desc(const char * const name)
 253{
 254	struct gpio_device *gdev;
 255	unsigned long flags;
 
 
 
 
 
 
 256
 257	spin_lock_irqsave(&gpio_lock, flags);
 258
 259	list_for_each_entry(gdev, &gpio_devices, list) {
 260		int i;
 
 261
 262		for (i = 0; i != gdev->ngpio; ++i) {
 263			struct gpio_desc *desc = &gdev->descs[i];
 264
 265			if (!desc->name || !name)
 266				continue;
 
 
 267
 268			if (!strcmp(desc->name, name)) {
 269				spin_unlock_irqrestore(&gpio_lock, flags);
 270				return desc;
 
 
 
 
 271			}
 272		}
 273	}
 274
 275	spin_unlock_irqrestore(&gpio_lock, flags);
 276
 277	return NULL;
 278}
 279
 280/*
 281 * Takes the names from gc->names and checks if they are all unique. If they
 282 * are, they are assigned to their gpio descriptors.
 283 *
 284 * Warning if one of the names is already used for a different GPIO.
 285 */
 286static int gpiochip_set_desc_names(struct gpio_chip *gc)
 287{
 288	struct gpio_device *gdev = gc->gpiodev;
 289	int i;
 
 
 
 
 
 
 290
 291	if (!gc->names)
 292		return 0;
 293
 294	/* First check all names if they are unique */
 295	for (i = 0; i != gc->ngpio; ++i) {
 296		struct gpio_desc *gpio;
 297
 298		gpio = gpio_name_to_desc(gc->names[i]);
 299		if (gpio)
 300			dev_warn(&gdev->dev,
 301				 "Detected name collision for GPIO name '%s'\n",
 302				 gc->names[i]);
 303	}
 304
 305	/* Then add all names to the GPIO descriptors */
 306	for (i = 0; i != gc->ngpio; ++i)
 307		gdev->descs[i].name = gc->names[i];
 308
 309	return 0;
 310}
 311
 312/**
 313 * gpio_ioctl() - ioctl handler for the GPIO chardev
 314 */
 315static long gpio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
 316{
 317	struct gpio_device *gdev = filp->private_data;
 318	struct gpio_chip *chip = gdev->chip;
 319	int __user *ip = (int __user *)arg;
 320
 321	/* We fail any subsequent ioctl():s when the chip is gone */
 322	if (!chip)
 323		return -ENODEV;
 324
 325	/* Fill in the struct and pass to userspace */
 326	if (cmd == GPIO_GET_CHIPINFO_IOCTL) {
 327		struct gpiochip_info chipinfo;
 328
 329		strncpy(chipinfo.name, dev_name(&gdev->dev),
 330			sizeof(chipinfo.name));
 331		chipinfo.name[sizeof(chipinfo.name)-1] = '\0';
 332		strncpy(chipinfo.label, gdev->label,
 333			sizeof(chipinfo.label));
 334		chipinfo.label[sizeof(chipinfo.label)-1] = '\0';
 335		chipinfo.lines = gdev->ngpio;
 336		if (copy_to_user(ip, &chipinfo, sizeof(chipinfo)))
 337			return -EFAULT;
 338		return 0;
 339	} else if (cmd == GPIO_GET_LINEINFO_IOCTL) {
 340		struct gpioline_info lineinfo;
 341		struct gpio_desc *desc;
 342
 343		if (copy_from_user(&lineinfo, ip, sizeof(lineinfo)))
 344			return -EFAULT;
 345		if (lineinfo.line_offset > gdev->ngpio)
 346			return -EINVAL;
 347
 348		desc = &gdev->descs[lineinfo.line_offset];
 349		if (desc->name) {
 350			strncpy(lineinfo.name, desc->name,
 351				sizeof(lineinfo.name));
 352			lineinfo.name[sizeof(lineinfo.name)-1] = '\0';
 353		} else {
 354			lineinfo.name[0] = '\0';
 355		}
 356		if (desc->label) {
 357			strncpy(lineinfo.consumer, desc->label,
 358				sizeof(lineinfo.consumer));
 359			lineinfo.consumer[sizeof(lineinfo.consumer)-1] = '\0';
 360		} else {
 361			lineinfo.consumer[0] = '\0';
 362		}
 363
 364		/*
 365		 * Userspace only need to know that the kernel is using
 366		 * this GPIO so it can't use it.
 367		 */
 368		lineinfo.flags = 0;
 369		if (test_bit(FLAG_REQUESTED, &desc->flags) ||
 370		    test_bit(FLAG_IS_HOGGED, &desc->flags) ||
 371		    test_bit(FLAG_USED_AS_IRQ, &desc->flags) ||
 372		    test_bit(FLAG_EXPORT, &desc->flags) ||
 373		    test_bit(FLAG_SYSFS, &desc->flags))
 374			lineinfo.flags |= GPIOLINE_FLAG_KERNEL;
 375		if (test_bit(FLAG_IS_OUT, &desc->flags))
 376			lineinfo.flags |= GPIOLINE_FLAG_IS_OUT;
 377		if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
 378			lineinfo.flags |= GPIOLINE_FLAG_ACTIVE_LOW;
 379		if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
 380			lineinfo.flags |= GPIOLINE_FLAG_OPEN_DRAIN;
 381		if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
 382			lineinfo.flags |= GPIOLINE_FLAG_OPEN_SOURCE;
 383
 384		if (copy_to_user(ip, &lineinfo, sizeof(lineinfo)))
 385			return -EFAULT;
 386		return 0;
 
 
 
 
 387	}
 388	return -EINVAL;
 389}
 390
 391/**
 392 * gpio_chrdev_open() - open the chardev for ioctl operations
 393 * @inode: inode for this chardev
 394 * @filp: file struct for storing private data
 395 * Returns 0 on success
 396 */
 397static int gpio_chrdev_open(struct inode *inode, struct file *filp)
 398{
 399	struct gpio_device *gdev = container_of(inode->i_cdev,
 400					      struct gpio_device, chrdev);
 401
 402	/* Fail on open if the backing gpiochip is gone */
 403	if (!gdev || !gdev->chip)
 404		return -ENODEV;
 405	get_device(&gdev->dev);
 406	filp->private_data = gdev;
 407	return 0;
 408}
 409
 410/**
 411 * gpio_chrdev_release() - close chardev after ioctl operations
 412 * @inode: inode for this chardev
 413 * @filp: file struct for storing private data
 414 * Returns 0 on success
 415 */
 416static int gpio_chrdev_release(struct inode *inode, struct file *filp)
 417{
 418	struct gpio_device *gdev = container_of(inode->i_cdev,
 419					      struct gpio_device, chrdev);
 420
 421	if (!gdev)
 422		return -ENODEV;
 423	put_device(&gdev->dev);
 424	return 0;
 425}
 426
 
 427
 428static const struct file_operations gpio_fileops = {
 429	.release = gpio_chrdev_release,
 430	.open = gpio_chrdev_open,
 431	.owner = THIS_MODULE,
 432	.llseek = noop_llseek,
 433	.unlocked_ioctl = gpio_ioctl,
 434	.compat_ioctl = gpio_ioctl,
 435};
 436
 437static void gpiodevice_release(struct device *dev)
 438{
 439	struct gpio_device *gdev = dev_get_drvdata(dev);
 440
 441	cdev_del(&gdev->chrdev);
 442	list_del(&gdev->list);
 443	ida_simple_remove(&gpio_ida, gdev->id);
 444	kfree(gdev->label);
 445	kfree(gdev->descs);
 446	kfree(gdev);
 447}
 448
 449static int gpiochip_setup_dev(struct gpio_device *gdev)
 
 450{
 451	int status;
 
 452
 453	cdev_init(&gdev->chrdev, &gpio_fileops);
 454	gdev->chrdev.owner = THIS_MODULE;
 455	gdev->chrdev.kobj.parent = &gdev->dev.kobj;
 456	gdev->dev.devt = MKDEV(MAJOR(gpio_devt), gdev->id);
 457	status = cdev_add(&gdev->chrdev, gdev->dev.devt, 1);
 458	if (status < 0)
 459		chip_warn(gdev->chip, "failed to add char device %d:%d\n",
 460			  MAJOR(gpio_devt), gdev->id);
 461	else
 462		chip_dbg(gdev->chip, "added GPIO chardev (%d:%d)\n",
 463			 MAJOR(gpio_devt), gdev->id);
 464	status = device_add(&gdev->dev);
 465	if (status)
 466		goto err_remove_chardev;
 467
 468	status = gpiochip_sysfs_register(gdev);
 469	if (status)
 470		goto err_remove_device;
 
 471
 472	/* From this point, the .release() function cleans up gpio_device */
 473	gdev->dev.release = gpiodevice_release;
 474	get_device(&gdev->dev);
 475	pr_debug("%s: registered GPIOs %d to %d on device: %s (%s)\n",
 476		 __func__, gdev->base, gdev->base + gdev->ngpio - 1,
 477		 dev_name(&gdev->dev), gdev->chip->label ? : "generic");
 478
 479	return 0;
 480
 481err_remove_device:
 482	device_del(&gdev->dev);
 483err_remove_chardev:
 484	cdev_del(&gdev->chrdev);
 485	return status;
 486}
 487
 488static void gpiochip_setup_devs(void)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 489{
 490	struct gpio_device *gdev;
 491	int err;
 492
 493	list_for_each_entry(gdev, &gpio_devices, list) {
 494		err = gpiochip_setup_dev(gdev);
 495		if (err)
 496			pr_err("%s: Failed to initialize gpio device (%d)\n",
 497			       dev_name(&gdev->dev), err);
 498	}
 499}
 
 500
 501/**
 502 * gpiochip_add_data() - register a gpio_chip
 503 * @chip: the chip to register, with chip->base initialized
 504 * Context: potentially before irqs will work
 505 *
 506 * Returns a negative errno if the chip can't be registered, such as
 507 * because the chip->base is invalid or already associated with a
 508 * different chip.  Otherwise it returns zero as a success code.
 509 *
 510 * When gpiochip_add_data() is called very early during boot, so that GPIOs
 511 * can be freely used, the chip->parent device must be registered before
 512 * the gpio framework's arch_initcall().  Otherwise sysfs initialization
 513 * for GPIOs will fail rudely.
 514 *
 515 * gpiochip_add_data() must only be called after gpiolib initialization,
 516 * ie after core_initcall().
 517 *
 518 * If chip->base is negative, this requests dynamic assignment of
 519 * a range of valid GPIOs.
 520 */
 521int gpiochip_add_data(struct gpio_chip *chip, void *data)
 522{
 523	unsigned long	flags;
 524	int		status = 0;
 525	unsigned	i;
 526	int		base = chip->base;
 527	struct gpio_device *gdev;
 528
 529	/*
 530	 * First: allocate and populate the internal stat container, and
 531	 * set up the struct device.
 532	 */
 533	gdev = kzalloc(sizeof(*gdev), GFP_KERNEL);
 534	if (!gdev)
 535		return -ENOMEM;
 536	gdev->dev.bus = &gpio_bus_type;
 537	gdev->chip = chip;
 538	chip->gpiodev = gdev;
 539	if (chip->parent) {
 540		gdev->dev.parent = chip->parent;
 541		gdev->dev.of_node = chip->parent->of_node;
 542	} else {
 543#ifdef CONFIG_OF_GPIO
 544	/* If the gpiochip has an assigned OF node this takes precedence */
 545		if (chip->of_node)
 546			gdev->dev.of_node = chip->of_node;
 547#endif
 548	}
 549	gdev->id = ida_simple_get(&gpio_ida, 0, 0, GFP_KERNEL);
 550	if (gdev->id < 0) {
 551		status = gdev->id;
 552		goto err_free_gdev;
 553	}
 554	dev_set_name(&gdev->dev, "gpiochip%d", gdev->id);
 555	device_initialize(&gdev->dev);
 556	dev_set_drvdata(&gdev->dev, gdev);
 557	if (chip->parent && chip->parent->driver)
 558		gdev->owner = chip->parent->driver->owner;
 559	else if (chip->owner)
 560		/* TODO: remove chip->owner */
 561		gdev->owner = chip->owner;
 562	else
 563		gdev->owner = THIS_MODULE;
 564
 565	gdev->descs = kcalloc(chip->ngpio, sizeof(gdev->descs[0]), GFP_KERNEL);
 566	if (!gdev->descs) {
 567		status = -ENOMEM;
 568		goto err_free_gdev;
 569	}
 570
 571	if (chip->ngpio == 0) {
 572		chip_err(chip, "tried to insert a GPIO chip with zero lines\n");
 573		status = -EINVAL;
 574		goto err_free_descs;
 575	}
 576
 577	if (chip->label)
 578		gdev->label = kstrdup(chip->label, GFP_KERNEL);
 579	else
 580		gdev->label = kstrdup("unknown", GFP_KERNEL);
 581	if (!gdev->label) {
 582		status = -ENOMEM;
 583		goto err_free_descs;
 584	}
 585
 586	gdev->ngpio = chip->ngpio;
 587	gdev->data = data;
 
 588
 589	spin_lock_irqsave(&gpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 590
 591	/*
 592	 * TODO: this allocates a Linux GPIO number base in the global
 593	 * GPIO numberspace for this chip. In the long run we want to
 594	 * get *rid* of this numberspace and use only descriptors, but
 595	 * it may be a pipe dream. It will not happen before we get rid
 596	 * of the sysfs interface anyways.
 
 597	 */
 598	if (base < 0) {
 599		base = gpiochip_find_base(chip->ngpio);
 600		if (base < 0) {
 601			status = base;
 602			spin_unlock_irqrestore(&gpio_lock, flags);
 603			goto err_free_label;
 604		}
 605		/*
 606		 * TODO: it should not be necessary to reflect the assigned
 607		 * base outside of the GPIO subsystem. Go over drivers and
 608		 * see if anyone makes use of this, else drop this and assign
 609		 * a poison instead.
 610		 */
 611		chip->base = base;
 612	}
 613	gdev->base = base;
 614
 615	status = gpiodev_add_to_list(gdev);
 616	if (status) {
 617		spin_unlock_irqrestore(&gpio_lock, flags);
 618		goto err_free_label;
 619	}
 620
 621	for (i = 0; i < chip->ngpio; i++) {
 622		struct gpio_desc *desc = &gdev->descs[i];
 
 
 
 623
 624		desc->gdev = gdev;
 
 
 
 
 625
 626		/* REVISIT: most hardware initializes GPIOs as inputs (often
 627		 * with pullups enabled) so power usage is minimized. Linux
 628		 * code should set the gpio direction first thing; but until
 629		 * it does, and in case chip->get_direction is not set, we may
 630		 * expose the wrong direction in sysfs.
 631		 */
 632		desc->flags = !chip->direction_input ? (1 << FLAG_IS_OUT) : 0;
 633	}
 634
 635	spin_unlock_irqrestore(&gpio_lock, flags);
 
 
 636
 637#ifdef CONFIG_PINCTRL
 638	INIT_LIST_HEAD(&gdev->pin_ranges);
 639#endif
 640
 641	status = gpiochip_set_desc_names(chip);
 642	if (status)
 643		goto err_remove_from_list;
 644
 645	status = of_gpiochip_add(chip);
 
 
 
 
 
 
 
 
 646	if (status)
 647		goto err_remove_chip;
 
 
 648
 649	acpi_gpiochip_add(chip);
 
 
 
 
 650
 651	/*
 652	 * By first adding the chardev, and then adding the device,
 653	 * we get a device node entry in sysfs under
 654	 * /sys/bus/gpio/devices/gpiochipN/dev that can be used for
 655	 * coldplug of device nodes and other udev business.
 656	 * We can do this only if gpiolib has been initialized.
 657	 * Otherwise, defer until later.
 658	 */
 659	if (gpiolib_initialized) {
 660		status = gpiochip_setup_dev(gdev);
 661		if (status)
 662			goto err_remove_chip;
 663	}
 664	return 0;
 665
 666err_remove_chip:
 667	acpi_gpiochip_remove(chip);
 668	gpiochip_free_hogs(chip);
 669	of_gpiochip_remove(chip);
 670err_remove_from_list:
 671	spin_lock_irqsave(&gpio_lock, flags);
 672	list_del(&gdev->list);
 673	spin_unlock_irqrestore(&gpio_lock, flags);
 674err_free_label:
 675	kfree(gdev->label);
 676err_free_descs:
 677	kfree(gdev->descs);
 678err_free_gdev:
 679	ida_simple_remove(&gpio_ida, gdev->id);
 680	/* failures here can mean systems won't boot... */
 681	pr_err("%s: GPIOs %d..%d (%s) failed to register\n", __func__,
 682	       gdev->base, gdev->base + gdev->ngpio - 1,
 683	       chip->label ? : "generic");
 684	kfree(gdev);
 685	return status;
 686}
 687EXPORT_SYMBOL_GPL(gpiochip_add_data);
 688
 689/**
 690 * gpiochip_get_data() - get per-subdriver data for the chip
 691 */
 692void *gpiochip_get_data(struct gpio_chip *chip)
 693{
 694	return chip->gpiodev->data;
 695}
 696EXPORT_SYMBOL_GPL(gpiochip_get_data);
 697
 698/**
 699 * gpiochip_remove() - unregister a gpio_chip
 700 * @chip: the chip to unregister
 
 
 
 
 
 
 
 
 
 701 *
 702 * A gpio_chip with any GPIOs still requested may not be removed.
 703 */
 704void gpiochip_remove(struct gpio_chip *chip)
 705{
 706	struct gpio_device *gdev = chip->gpiodev;
 707	struct gpio_desc *desc;
 708	unsigned long	flags;
 709	unsigned	i;
 710	bool		requested = false;
 711
 712	/* FIXME: should the legacy sysfs handling be moved to gpio_device? */
 713	gpiochip_sysfs_unregister(gdev);
 714	/* Numb the device, cancelling all outstanding operations */
 715	gdev->chip = NULL;
 716	gpiochip_irqchip_remove(chip);
 717	acpi_gpiochip_remove(chip);
 718	gpiochip_remove_pin_ranges(chip);
 719	gpiochip_free_hogs(chip);
 720	of_gpiochip_remove(chip);
 721	/*
 722	 * We accept no more calls into the driver from this point, so
 723	 * NULL the driver data pointer
 724	 */
 725	gdev->data = NULL;
 726
 727	spin_lock_irqsave(&gpio_lock, flags);
 728	for (i = 0; i < gdev->ngpio; i++) {
 729		desc = &gdev->descs[i];
 730		if (test_bit(FLAG_REQUESTED, &desc->flags))
 731			requested = true;
 
 
 
 732	}
 733	spin_unlock_irqrestore(&gpio_lock, flags);
 734
 735	if (requested)
 736		dev_crit(&gdev->dev,
 737			 "REMOVING GPIOCHIP WITH GPIOS STILL REQUESTED\n");
 738
 739	/*
 740	 * The gpiochip side puts its use of the device to rest here:
 741	 * if there are no userspace clients, the chardev and device will
 742	 * be removed, else it will be dangling until the last user is
 743	 * gone.
 744	 */
 745	put_device(&gdev->dev);
 746}
 747EXPORT_SYMBOL_GPL(gpiochip_remove);
 748
 749static void devm_gpio_chip_release(struct device *dev, void *res)
 750{
 751	struct gpio_chip *chip = *(struct gpio_chip **)res;
 752
 753	gpiochip_remove(chip);
 754}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 755
 756static int devm_gpio_chip_match(struct device *dev, void *res, void *data)
 757
 758{
 759	struct gpio_chip **r = res;
 
 760
 761	if (!r || !*r) {
 762		WARN_ON(!r || !*r);
 763		return 0;
 764	}
 765
 766	return *r == data;
 
 
 767}
 768
 769/**
 770 * devm_gpiochip_add_data() - Resource manager piochip_add_data()
 771 * @dev: the device pointer on which irq_chip belongs to.
 772 * @chip: the chip to register, with chip->base initialized
 773 * Context: potentially before irqs will work
 774 *
 775 * Returns a negative errno if the chip can't be registered, such as
 776 * because the chip->base is invalid or already associated with a
 777 * different chip.  Otherwise it returns zero as a success code.
 778 *
 779 * The gpio chip automatically be released when the device is unbound.
 780 */
 781int devm_gpiochip_add_data(struct device *dev, struct gpio_chip *chip,
 782			   void *data)
 783{
 784	struct gpio_chip **ptr;
 785	int ret;
 
 
 
 786
 787	ptr = devres_alloc(devm_gpio_chip_release, sizeof(*ptr),
 788			     GFP_KERNEL);
 789	if (!ptr)
 790		return -ENOMEM;
 791
 792	ret = gpiochip_add_data(chip, data);
 793	if (ret < 0) {
 794		devres_free(ptr);
 795		return ret;
 
 
 
 
 
 
 
 
 796	}
 797
 798	*ptr = chip;
 799	devres_add(dev, ptr);
 800
 801	return 0;
 
 
 
 
 802}
 803EXPORT_SYMBOL_GPL(devm_gpiochip_add_data);
 
 804
 805/**
 806 * devm_gpiochip_remove() - Resource manager of gpiochip_remove()
 807 * @dev: device for which which resource was allocated
 808 * @chip: the chip to remove
 809 *
 810 * A gpio_chip with any GPIOs still requested may not be removed.
 
 
 
 
 
 811 */
 812void devm_gpiochip_remove(struct device *dev, struct gpio_chip *chip)
 813{
 814	int ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 815
 816	ret = devres_release(dev, devm_gpio_chip_release,
 817			     devm_gpio_chip_match, chip);
 818	if (!ret)
 819		WARN_ON(ret);
 820}
 821EXPORT_SYMBOL_GPL(devm_gpiochip_remove);
 822
 823/**
 824 * gpiochip_find() - iterator for locating a specific gpio_chip
 825 * @data: data to pass to match function
 826 * @callback: Callback function to check gpio_chip
 827 *
 828 * Similar to bus_find_device.  It returns a reference to a gpio_chip as
 829 * determined by a user supplied @match callback.  The callback should return
 830 * 0 if the device doesn't match and non-zero if it does.  If the callback is
 831 * non-zero, this function will return to the caller and not iterate over any
 832 * more gpio_chips.
 833 */
 834struct gpio_chip *gpiochip_find(void *data,
 835				int (*match)(struct gpio_chip *chip,
 836					     void *data))
 837{
 838	struct gpio_device *gdev;
 839	struct gpio_chip *chip;
 840	unsigned long flags;
 841
 842	spin_lock_irqsave(&gpio_lock, flags);
 843	list_for_each_entry(gdev, &gpio_devices, list)
 844		if (match(gdev->chip, data))
 845			break;
 846
 847	/* No match? */
 848	if (&gdev->list == &gpio_devices)
 849		chip = NULL;
 850	else
 851		chip = gdev->chip;
 852
 853	spin_unlock_irqrestore(&gpio_lock, flags);
 854
 855	return chip;
 856}
 857EXPORT_SYMBOL_GPL(gpiochip_find);
 858
 859static int gpiochip_match_name(struct gpio_chip *chip, void *data)
 860{
 861	const char *name = data;
 
 
 
 
 862
 863	return !strcmp(chip->label, name);
 
 
 
 
 
 
 
 864}
 
 865
 866static struct gpio_chip *find_chip_by_name(const char *name)
 867{
 868	return gpiochip_find((void *)name, gpiochip_match_name);
 869}
 870
 871#ifdef CONFIG_GPIOLIB_IRQCHIP
 
 
 
 
 
 
 872
 873/*
 874 * The following is irqchip helper code for gpiochips.
 875 */
 
 
 
 
 
 
 
 
 876
 877/**
 878 * gpiochip_set_chained_irqchip() - sets a chained irqchip to a gpiochip
 879 * @gpiochip: the gpiochip to set the irqchip chain to
 880 * @irqchip: the irqchip to chain to the gpiochip
 881 * @parent_irq: the irq number corresponding to the parent IRQ for this
 882 * chained irqchip
 883 * @parent_handler: the parent interrupt handler for the accumulated IRQ
 884 * coming out of the gpiochip. If the interrupt is nested rather than
 885 * cascaded, pass NULL in this handler argument
 886 */
 887void gpiochip_set_chained_irqchip(struct gpio_chip *gpiochip,
 888				  struct irq_chip *irqchip,
 889				  int parent_irq,
 890				  irq_flow_handler_t parent_handler)
 891{
 892	unsigned int offset;
 893
 894	if (!gpiochip->irqdomain) {
 895		chip_err(gpiochip, "called %s before setting up irqchip\n",
 896			 __func__);
 897		return;
 898	}
 899
 900	if (parent_handler) {
 901		if (gpiochip->can_sleep) {
 902			chip_err(gpiochip,
 903				 "you cannot have chained interrupts on a "
 904				 "chip that may sleep\n");
 905			return;
 906		}
 907		/*
 908		 * The parent irqchip is already using the chip_data for this
 909		 * irqchip, so our callbacks simply use the handler_data.
 910		 */
 911		irq_set_chained_handler_and_data(parent_irq, parent_handler,
 912						 gpiochip);
 913
 914		gpiochip->irq_parent = parent_irq;
 915	}
 916
 917	/* Set the parent IRQ for all affected IRQs */
 918	for (offset = 0; offset < gpiochip->ngpio; offset++)
 919		irq_set_parent(irq_find_mapping(gpiochip->irqdomain, offset),
 920			       parent_irq);
 921}
 922EXPORT_SYMBOL_GPL(gpiochip_set_chained_irqchip);
 923
 924/**
 925 * gpiochip_irq_map() - maps an IRQ into a GPIO irqchip
 926 * @d: the irqdomain used by this irqchip
 927 * @irq: the global irq number used by this GPIO irqchip irq
 928 * @hwirq: the local IRQ/GPIO line offset on this gpiochip
 929 *
 930 * This function will set up the mapping for a certain IRQ line on a
 931 * gpiochip by assigning the gpiochip as chip data, and using the irqchip
 932 * stored inside the gpiochip.
 933 */
 934static int gpiochip_irq_map(struct irq_domain *d, unsigned int irq,
 935			    irq_hw_number_t hwirq)
 936{
 937	struct gpio_chip *chip = d->host_data;
 938
 939	irq_set_chip_data(irq, chip);
 940	/*
 941	 * This lock class tells lockdep that GPIO irqs are in a different
 942	 * category than their parents, so it won't report false recursion.
 943	 */
 944	irq_set_lockdep_class(irq, chip->lock_key);
 945	irq_set_chip_and_handler(irq, chip->irqchip, chip->irq_handler);
 946	/* Chips that can sleep need nested thread handlers */
 947	if (chip->can_sleep && !chip->irq_not_threaded)
 948		irq_set_nested_thread(irq, 1);
 949	irq_set_noprobe(irq);
 950
 951	/*
 952	 * No set-up of the hardware will happen if IRQ_TYPE_NONE
 953	 * is passed as default type.
 954	 */
 955	if (chip->irq_default_type != IRQ_TYPE_NONE)
 956		irq_set_irq_type(irq, chip->irq_default_type);
 957
 958	return 0;
 959}
 960
 961static void gpiochip_irq_unmap(struct irq_domain *d, unsigned int irq)
 962{
 963	struct gpio_chip *chip = d->host_data;
 
 964
 965	if (chip->can_sleep)
 966		irq_set_nested_thread(irq, 0);
 967	irq_set_chip_and_handler(irq, NULL, NULL);
 968	irq_set_chip_data(irq, NULL);
 969}
 
 
 
 
 
 970
 971static const struct irq_domain_ops gpiochip_domain_ops = {
 972	.map	= gpiochip_irq_map,
 973	.unmap	= gpiochip_irq_unmap,
 974	/* Virtually all GPIO irqchips are twocell:ed */
 975	.xlate	= irq_domain_xlate_twocell,
 976};
 977
 978static int gpiochip_irq_reqres(struct irq_data *d)
 979{
 980	struct gpio_chip *chip = irq_data_get_irq_chip_data(d);
 
 
 981
 982	if (!try_module_get(chip->gpiodev->owner))
 983		return -ENODEV;
 
 984
 985	if (gpiochip_lock_as_irq(chip, d->hwirq)) {
 986		chip_err(chip,
 987			"unable to lock HW IRQ %lu for IRQ\n",
 988			d->hwirq);
 989		module_put(chip->gpiodev->owner);
 990		return -EINVAL;
 
 
 
 
 
 
 
 
 
 
 
 991	}
 992	return 0;
 
 
 
 993}
 
 994
 995static void gpiochip_irq_relres(struct irq_data *d)
 
 996{
 997	struct gpio_chip *chip = irq_data_get_irq_chip_data(d);
 998
 999	gpiochip_unlock_as_irq(chip, d->hwirq);
1000	module_put(chip->gpiodev->owner);
1001}
1002
1003static int gpiochip_to_irq(struct gpio_chip *chip, unsigned offset)
1004{
1005	return irq_find_mapping(chip->irqdomain, offset);
1006}
1007
 
 
1008/**
1009 * gpiochip_irqchip_remove() - removes an irqchip added to a gpiochip
1010 * @gpiochip: the gpiochip to remove the irqchip from
 
1011 *
1012 * This is called only from gpiochip_remove()
 
 
 
 
 
 
 
 
 
 
1013 */
1014static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip)
1015{
1016	unsigned int offset;
1017
1018	acpi_gpiochip_free_interrupts(gpiochip);
1019
1020	if (gpiochip->irq_parent) {
1021		irq_set_chained_handler(gpiochip->irq_parent, NULL);
1022		irq_set_handler_data(gpiochip->irq_parent, NULL);
1023	}
1024
1025	/* Remove all IRQ mappings and delete the domain */
1026	if (gpiochip->irqdomain) {
1027		for (offset = 0; offset < gpiochip->ngpio; offset++)
1028			irq_dispose_mapping(
1029				irq_find_mapping(gpiochip->irqdomain, offset));
1030		irq_domain_remove(gpiochip->irqdomain);
1031	}
1032
1033	if (gpiochip->irqchip) {
1034		gpiochip->irqchip->irq_request_resources = NULL;
1035		gpiochip->irqchip->irq_release_resources = NULL;
1036		gpiochip->irqchip = NULL;
1037	}
1038}
1039
1040/**
1041 * gpiochip_irqchip_add() - adds an irqchip to a gpiochip
1042 * @gpiochip: the gpiochip to add the irqchip to
1043 * @irqchip: the irqchip to add to the gpiochip
1044 * @first_irq: if not dynamically assigned, the base (first) IRQ to
1045 * allocate gpiochip irqs from
1046 * @handler: the irq handler to use (often a predefined irq core function)
1047 * @type: the default type for IRQs on this irqchip, pass IRQ_TYPE_NONE
1048 * to have the core avoid setting up any default type in the hardware.
1049 * @lock_key: lockdep class
1050 *
1051 * This function closely associates a certain irqchip with a certain
1052 * gpiochip, providing an irq domain to translate the local IRQs to
1053 * global irqs in the gpiolib core, and making sure that the gpiochip
1054 * is passed as chip data to all related functions. Driver callbacks
1055 * need to use gpiochip_get_data() to get their local state containers back
1056 * from the gpiochip passed as chip data. An irqdomain will be stored
1057 * in the gpiochip that shall be used by the driver to handle IRQ number
1058 * translation. The gpiochip will need to be initialized and registered
1059 * before calling this function.
1060 *
1061 * This function will handle two cell:ed simple IRQs and assumes all
1062 * the pins on the gpiochip can generate a unique IRQ. Everything else
1063 * need to be open coded.
1064 */
1065int _gpiochip_irqchip_add(struct gpio_chip *gpiochip,
1066			  struct irq_chip *irqchip,
1067			  unsigned int first_irq,
1068			  irq_flow_handler_t handler,
1069			  unsigned int type,
1070			  struct lock_class_key *lock_key)
1071{
1072	struct device_node *of_node;
1073	unsigned int offset;
1074	unsigned irq_base = 0;
1075
1076	if (!gpiochip || !irqchip)
1077		return -EINVAL;
1078
1079	if (!gpiochip->parent) {
1080		pr_err("missing gpiochip .dev parent pointer\n");
1081		return -EINVAL;
1082	}
1083	of_node = gpiochip->parent->of_node;
1084#ifdef CONFIG_OF_GPIO
1085	/*
1086	 * If the gpiochip has an assigned OF node this takes precedence
1087	 * FIXME: get rid of this and use gpiochip->parent->of_node
1088	 * everywhere
1089	 */
1090	if (gpiochip->of_node)
1091		of_node = gpiochip->of_node;
1092#endif
1093	gpiochip->irqchip = irqchip;
1094	gpiochip->irq_handler = handler;
1095	gpiochip->irq_default_type = type;
1096	gpiochip->to_irq = gpiochip_to_irq;
1097	gpiochip->lock_key = lock_key;
1098	gpiochip->irqdomain = irq_domain_add_simple(of_node,
1099					gpiochip->ngpio, first_irq,
1100					&gpiochip_domain_ops, gpiochip);
1101	if (!gpiochip->irqdomain) {
1102		gpiochip->irqchip = NULL;
1103		return -EINVAL;
1104	}
1105
1106	/*
1107	 * It is possible for a driver to override this, but only if the
1108	 * alternative functions are both implemented.
1109	 */
1110	if (!irqchip->irq_request_resources &&
1111	    !irqchip->irq_release_resources) {
1112		irqchip->irq_request_resources = gpiochip_irq_reqres;
1113		irqchip->irq_release_resources = gpiochip_irq_relres;
1114	}
 
 
 
1115
1116	/*
1117	 * Prepare the mapping since the irqchip shall be orthogonal to
1118	 * any gpiochip calls. If the first_irq was zero, this is
1119	 * necessary to allocate descriptors for all IRQs.
1120	 */
1121	for (offset = 0; offset < gpiochip->ngpio; offset++) {
1122		irq_base = irq_create_mapping(gpiochip->irqdomain, offset);
1123		if (offset == 0)
1124			/*
1125			 * Store the base into the gpiochip to be used when
1126			 * unmapping the irqs.
1127			 */
1128			gpiochip->irq_base = irq_base;
 
 
 
1129	}
1130
1131	acpi_gpiochip_request_interrupts(gpiochip);
1132
1133	return 0;
1134}
1135EXPORT_SYMBOL_GPL(_gpiochip_irqchip_add);
1136
1137#else /* CONFIG_GPIOLIB_IRQCHIP */
 
1138
1139static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip) {}
 
 
1140
1141#endif /* CONFIG_GPIOLIB_IRQCHIP */
 
 
1142
1143/**
1144 * gpiochip_generic_request() - request the gpio function for a pin
1145 * @chip: the gpiochip owning the GPIO
1146 * @offset: the offset of the GPIO to request for GPIO function
1147 */
1148int gpiochip_generic_request(struct gpio_chip *chip, unsigned offset)
1149{
1150	return pinctrl_request_gpio(chip->gpiodev->base + offset);
1151}
1152EXPORT_SYMBOL_GPL(gpiochip_generic_request);
1153
1154/**
1155 * gpiochip_generic_free() - free the gpio function from a pin
1156 * @chip: the gpiochip to request the gpio function for
1157 * @offset: the offset of the GPIO to free from GPIO function
 
1158 */
1159void gpiochip_generic_free(struct gpio_chip *chip, unsigned offset)
1160{
1161	pinctrl_free_gpio(chip->gpiodev->base + offset);
1162}
1163EXPORT_SYMBOL_GPL(gpiochip_generic_free);
1164
1165#ifdef CONFIG_PINCTRL
1166
1167/**
1168 * gpiochip_add_pingroup_range() - add a range for GPIO <-> pin mapping
1169 * @chip: the gpiochip to add the range for
1170 * @pctldev: the pin controller to map to
1171 * @gpio_offset: the start offset in the current gpio_chip number space
1172 * @pin_group: name of the pin group inside the pin controller
1173 */
1174int gpiochip_add_pingroup_range(struct gpio_chip *chip,
1175			struct pinctrl_dev *pctldev,
1176			unsigned int gpio_offset, const char *pin_group)
1177{
1178	struct gpio_pin_range *pin_range;
1179	struct gpio_device *gdev = chip->gpiodev;
1180	int ret;
1181
1182	pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1183	if (!pin_range) {
1184		chip_err(chip, "failed to allocate pin ranges\n");
1185		return -ENOMEM;
1186	}
1187
1188	/* Use local offset as range ID */
1189	pin_range->range.id = gpio_offset;
1190	pin_range->range.gc = chip;
1191	pin_range->range.name = chip->label;
1192	pin_range->range.base = gdev->base + gpio_offset;
1193	pin_range->pctldev = pctldev;
1194
1195	ret = pinctrl_get_group_pins(pctldev, pin_group,
1196					&pin_range->range.pins,
1197					&pin_range->range.npins);
1198	if (ret < 0) {
1199		kfree(pin_range);
1200		return ret;
1201	}
1202
1203	pinctrl_add_gpio_range(pctldev, &pin_range->range);
1204
1205	chip_dbg(chip, "created GPIO range %d->%d ==> %s PINGRP %s\n",
1206		 gpio_offset, gpio_offset + pin_range->range.npins - 1,
1207		 pinctrl_dev_get_devname(pctldev), pin_group);
1208
1209	list_add_tail(&pin_range->node, &gdev->pin_ranges);
1210
1211	return 0;
1212}
1213EXPORT_SYMBOL_GPL(gpiochip_add_pingroup_range);
 
 
 
 
 
 
 
1214
1215/**
1216 * gpiochip_add_pin_range() - add a range for GPIO <-> pin mapping
1217 * @chip: the gpiochip to add the range for
1218 * @pinctrl_name: the dev_name() of the pin controller to map to
1219 * @gpio_offset: the start offset in the current gpio_chip number space
1220 * @pin_offset: the start offset in the pin controller number space
1221 * @npins: the number of pins from the offset of each pin space (GPIO and
1222 *	pin controller) to accumulate in this range
1223 */
1224int gpiochip_add_pin_range(struct gpio_chip *chip, const char *pinctl_name,
1225			   unsigned int gpio_offset, unsigned int pin_offset,
1226			   unsigned int npins)
1227{
1228	struct gpio_pin_range *pin_range;
1229	struct gpio_device *gdev = chip->gpiodev;
1230	int ret;
1231
1232	pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1233	if (!pin_range) {
1234		chip_err(chip, "failed to allocate pin ranges\n");
1235		return -ENOMEM;
1236	}
1237
1238	/* Use local offset as range ID */
1239	pin_range->range.id = gpio_offset;
1240	pin_range->range.gc = chip;
1241	pin_range->range.name = chip->label;
1242	pin_range->range.base = gdev->base + gpio_offset;
1243	pin_range->range.pin_base = pin_offset;
1244	pin_range->range.npins = npins;
1245	pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
1246			&pin_range->range);
1247	if (IS_ERR(pin_range->pctldev)) {
1248		ret = PTR_ERR(pin_range->pctldev);
1249		chip_err(chip, "could not create pin range\n");
1250		kfree(pin_range);
1251		return ret;
1252	}
1253	chip_dbg(chip, "created GPIO range %d->%d ==> %s PIN %d->%d\n",
1254		 gpio_offset, gpio_offset + npins - 1,
1255		 pinctl_name,
1256		 pin_offset, pin_offset + npins - 1);
1257
1258	list_add_tail(&pin_range->node, &gdev->pin_ranges);
 
1259
1260	return 0;
1261}
1262EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
1263
1264/**
1265 * gpiochip_remove_pin_ranges() - remove all the GPIO <-> pin mappings
1266 * @chip: the chip to remove all the mappings for
 
 
 
 
 
 
 
1267 */
1268void gpiochip_remove_pin_ranges(struct gpio_chip *chip)
 
 
1269{
1270	struct gpio_pin_range *pin_range, *tmp;
1271	struct gpio_device *gdev = chip->gpiodev;
 
 
 
 
 
 
1272
1273	list_for_each_entry_safe(pin_range, tmp, &gdev->pin_ranges, node) {
1274		list_del(&pin_range->node);
1275		pinctrl_remove_gpio_range(pin_range->pctldev,
1276				&pin_range->range);
1277		kfree(pin_range);
1278	}
1279}
1280EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
1281
1282#endif /* CONFIG_PINCTRL */
 
 
1283
1284/* These "optional" allocation calls help prevent drivers from stomping
1285 * on each other, and help provide better diagnostics in debugfs.
1286 * They're called even less than the "set direction" calls.
1287 */
1288static int __gpiod_request(struct gpio_desc *desc, const char *label)
1289{
1290	struct gpio_chip	*chip = desc->gdev->chip;
1291	int			status;
 
1292	unsigned long		flags;
1293
1294	spin_lock_irqsave(&gpio_lock, flags);
1295
 
 
 
 
 
 
 
 
 
 
1296	/* NOTE:  gpio_request() can be called in early boot,
1297	 * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
1298	 */
1299
1300	if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
1301		desc_set_label(desc, label ? : "?");
1302		status = 0;
1303	} else {
1304		status = -EBUSY;
 
1305		goto done;
1306	}
1307
1308	if (chip->request) {
1309		/* chip->request may sleep */
1310		spin_unlock_irqrestore(&gpio_lock, flags);
1311		status = chip->request(chip, gpio_chip_hwgpio(desc));
1312		spin_lock_irqsave(&gpio_lock, flags);
1313
1314		if (status < 0) {
1315			desc_set_label(desc, NULL);
 
1316			clear_bit(FLAG_REQUESTED, &desc->flags);
1317			goto done;
1318		}
1319	}
1320	if (chip->get_direction) {
1321		/* chip->get_direction may sleep */
1322		spin_unlock_irqrestore(&gpio_lock, flags);
1323		gpiod_get_direction(desc);
1324		spin_lock_irqsave(&gpio_lock, flags);
1325	}
1326done:
1327	if (status < 0) {
1328		/* Clear flags that might have been set by the caller before
1329		 * requesting the GPIO.
1330		 */
1331		clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
1332		clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
1333		clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
1334	}
1335	spin_unlock_irqrestore(&gpio_lock, flags);
1336	return status;
1337}
1338
1339/*
1340 * This descriptor validation needs to be inserted verbatim into each
1341 * function taking a descriptor, so we need to use a preprocessor
1342 * macro to avoid endless duplication.
1343 */
1344#define VALIDATE_DESC(desc) do { \
1345	if (!desc || !desc->gdev) { \
1346		pr_warn("%s: invalid GPIO\n", __func__); \
1347		return -EINVAL; \
1348	} \
1349	if ( !desc->gdev->chip ) { \
1350		dev_warn(&desc->gdev->dev, \
1351			 "%s: backing chip is gone\n", __func__); \
1352		return 0; \
1353	} } while (0)
1354
1355#define VALIDATE_DESC_VOID(desc) do { \
1356	if (!desc || !desc->gdev) { \
1357		pr_warn("%s: invalid GPIO\n", __func__); \
1358		return; \
1359	} \
1360	if (!desc->gdev->chip) { \
1361		dev_warn(&desc->gdev->dev, \
1362			 "%s: backing chip is gone\n", __func__); \
1363		return; \
1364	} } while (0)
1365
1366
1367int gpiod_request(struct gpio_desc *desc, const char *label)
1368{
1369	int status = -EPROBE_DEFER;
1370	struct gpio_device *gdev;
1371
1372	VALIDATE_DESC(desc);
1373	gdev = desc->gdev;
1374
1375	if (try_module_get(gdev->owner)) {
1376		status = __gpiod_request(desc, label);
1377		if (status < 0)
1378			module_put(gdev->owner);
1379		else
1380			get_device(&gdev->dev);
1381	}
1382
 
1383	if (status)
1384		gpiod_dbg(desc, "%s: status %d\n", __func__, status);
1385
 
1386	return status;
1387}
 
1388
1389static bool __gpiod_free(struct gpio_desc *desc)
1390{
1391	bool			ret = false;
1392	unsigned long		flags;
 
1393	struct gpio_chip	*chip;
1394
1395	might_sleep();
1396
1397	gpiod_unexport(desc);
 
 
 
 
 
1398
1399	spin_lock_irqsave(&gpio_lock, flags);
1400
1401	chip = desc->gdev->chip;
 
1402	if (chip && test_bit(FLAG_REQUESTED, &desc->flags)) {
1403		if (chip->free) {
1404			spin_unlock_irqrestore(&gpio_lock, flags);
1405			might_sleep_if(chip->can_sleep);
1406			chip->free(chip, gpio_chip_hwgpio(desc));
1407			spin_lock_irqsave(&gpio_lock, flags);
1408		}
1409		desc_set_label(desc, NULL);
 
1410		clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
1411		clear_bit(FLAG_REQUESTED, &desc->flags);
1412		clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
1413		clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
1414		clear_bit(FLAG_IS_HOGGED, &desc->flags);
1415		ret = true;
1416	}
1417
1418	spin_unlock_irqrestore(&gpio_lock, flags);
1419	return ret;
1420}
 
1421
1422void gpiod_free(struct gpio_desc *desc)
 
 
 
 
 
 
1423{
1424	if (desc && desc->gdev && __gpiod_free(desc)) {
1425		module_put(desc->gdev->owner);
1426		put_device(&desc->gdev->dev);
1427	} else {
1428		WARN_ON(extra_checks);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1429	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1430}
 
 
 
 
 
 
 
 
 
 
 
 
 
1431
1432/**
1433 * gpiochip_is_requested - return string iff signal was requested
1434 * @chip: controller managing the signal
1435 * @offset: of signal within controller's 0..(ngpio - 1) range
1436 *
1437 * Returns NULL if the GPIO is not currently requested, else a string.
1438 * The string returned is the label passed to gpio_request(); if none has been
1439 * passed it is a meaningless, non-NULL constant.
1440 *
1441 * This function is for use by GPIO controller drivers.  The label can
1442 * help with diagnostics, and knowing that the signal is used as a GPIO
1443 * can help avoid accidentally multiplexing it to another controller.
1444 */
1445const char *gpiochip_is_requested(struct gpio_chip *chip, unsigned offset)
1446{
1447	struct gpio_desc *desc;
1448
1449	if (offset >= chip->ngpio)
1450		return NULL;
1451
1452	desc = &chip->gpiodev->descs[offset];
1453
1454	if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
1455		return NULL;
1456	return desc->label;
 
 
 
 
1457}
1458EXPORT_SYMBOL_GPL(gpiochip_is_requested);
1459
1460/**
1461 * gpiochip_request_own_desc - Allow GPIO chip to request its own descriptor
1462 * @desc: GPIO descriptor to request
1463 * @label: label for the GPIO
1464 *
1465 * Function allows GPIO chip drivers to request and use their own GPIO
1466 * descriptors via gpiolib API. Difference to gpiod_request() is that this
1467 * function will not increase reference count of the GPIO chip module. This
1468 * allows the GPIO chip module to be unloaded as needed (we assume that the
1469 * GPIO chip driver handles freeing the GPIOs it has requested).
1470 */
1471struct gpio_desc *gpiochip_request_own_desc(struct gpio_chip *chip, u16 hwnum,
1472					    const char *label)
1473{
1474	struct gpio_desc *desc = gpiochip_get_desc(chip, hwnum);
1475	int err;
1476
1477	if (IS_ERR(desc)) {
1478		chip_err(chip, "failed to get GPIO descriptor\n");
1479		return desc;
1480	}
1481
1482	err = __gpiod_request(desc, label);
1483	if (err < 0)
1484		return ERR_PTR(err);
1485
1486	return desc;
1487}
1488EXPORT_SYMBOL_GPL(gpiochip_request_own_desc);
1489
1490/**
1491 * gpiochip_free_own_desc - Free GPIO requested by the chip driver
1492 * @desc: GPIO descriptor to free
1493 *
1494 * Function frees the given GPIO requested previously with
1495 * gpiochip_request_own_desc().
1496 */
1497void gpiochip_free_own_desc(struct gpio_desc *desc)
1498{
1499	if (desc)
1500		__gpiod_free(desc);
1501}
1502EXPORT_SYMBOL_GPL(gpiochip_free_own_desc);
1503
1504/*
1505 * Drivers MUST set GPIO direction before making get/set calls.  In
1506 * some cases this is done in early boot, before IRQs are enabled.
1507 *
1508 * As a rule these aren't called more than once (except for drivers
1509 * using the open-drain emulation idiom) so these are natural places
1510 * to accumulate extra debugging checks.  Note that we can't (yet)
1511 * rely on gpio_request() having been called beforehand.
1512 */
1513
1514/**
1515 * gpiod_direction_input - set the GPIO direction to input
1516 * @desc:	GPIO to set to input
1517 *
1518 * Set the direction of the passed GPIO to input, such as gpiod_get_value() can
1519 * be called safely on it.
1520 *
1521 * Return 0 in case of success, else an error code.
1522 */
1523int gpiod_direction_input(struct gpio_desc *desc)
1524{
 
1525	struct gpio_chip	*chip;
 
1526	int			status = -EINVAL;
1527
1528	VALIDATE_DESC(desc);
1529	chip = desc->gdev->chip;
1530
1531	if (!chip->get || !chip->direction_input) {
1532		gpiod_warn(desc,
1533			"%s: missing get() or direction_input() operations\n",
1534			__func__);
1535		return -EIO;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1536	}
1537
1538	status = chip->direction_input(chip, gpio_chip_hwgpio(desc));
1539	if (status == 0)
1540		clear_bit(FLAG_IS_OUT, &desc->flags);
1541
1542	trace_gpio_direction(desc_to_gpio(desc), 1, status);
1543
 
 
 
 
 
 
1544	return status;
1545}
1546EXPORT_SYMBOL_GPL(gpiod_direction_input);
1547
1548static int _gpiod_direction_output_raw(struct gpio_desc *desc, int value)
1549{
 
1550	struct gpio_chip	*chip;
 
1551	int			status = -EINVAL;
1552
1553	/* GPIOs used for IRQs shall not be set as output */
1554	if (test_bit(FLAG_USED_AS_IRQ, &desc->flags)) {
1555		gpiod_err(desc,
1556			  "%s: tried to set a GPIO tied to an IRQ as output\n",
1557			  __func__);
1558		return -EIO;
1559	}
1560
1561	/* Open drain pin should not be driven to 1 */
1562	if (value && test_bit(FLAG_OPEN_DRAIN,  &desc->flags))
1563		return gpiod_direction_input(desc);
1564
1565	/* Open source pin should not be driven to 0 */
1566	if (!value && test_bit(FLAG_OPEN_SOURCE,  &desc->flags))
1567		return gpiod_direction_input(desc);
1568
1569	chip = desc->gdev->chip;
1570	if (!chip->set || !chip->direction_output) {
1571		gpiod_warn(desc,
1572		       "%s: missing set() or direction_output() operations\n",
1573		       __func__);
1574		return -EIO;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1575	}
1576
1577	status = chip->direction_output(chip, gpio_chip_hwgpio(desc), value);
1578	if (status == 0)
1579		set_bit(FLAG_IS_OUT, &desc->flags);
1580	trace_gpio_value(desc_to_gpio(desc), 0, value);
1581	trace_gpio_direction(desc_to_gpio(desc), 0, status);
 
 
 
 
 
 
 
1582	return status;
1583}
 
1584
1585/**
1586 * gpiod_direction_output_raw - set the GPIO direction to output
1587 * @desc:	GPIO to set to output
1588 * @value:	initial output value of the GPIO
1589 *
1590 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
1591 * be called safely on it. The initial value of the output must be specified
1592 * as raw value on the physical line without regard for the ACTIVE_LOW status.
1593 *
1594 * Return 0 in case of success, else an error code.
1595 */
1596int gpiod_direction_output_raw(struct gpio_desc *desc, int value)
1597{
1598	VALIDATE_DESC(desc);
1599	return _gpiod_direction_output_raw(desc, value);
1600}
1601EXPORT_SYMBOL_GPL(gpiod_direction_output_raw);
1602
1603/**
1604 * gpiod_direction_output - set the GPIO direction to output
1605 * @desc:	GPIO to set to output
1606 * @value:	initial output value of the GPIO
1607 *
1608 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
1609 * be called safely on it. The initial value of the output must be specified
1610 * as the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
1611 * account.
1612 *
1613 * Return 0 in case of success, else an error code.
1614 */
1615int gpiod_direction_output(struct gpio_desc *desc, int value)
1616{
1617	VALIDATE_DESC(desc);
1618	if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
1619		value = !value;
1620	return _gpiod_direction_output_raw(desc, value);
1621}
1622EXPORT_SYMBOL_GPL(gpiod_direction_output);
1623
1624/**
1625 * gpiod_set_debounce - sets @debounce time for a @gpio
1626 * @gpio: the gpio to set debounce time
1627 * @debounce: debounce time is microseconds
1628 *
1629 * returns -ENOTSUPP if the controller does not support setting
1630 * debounce.
1631 */
1632int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce)
1633{
 
1634	struct gpio_chip	*chip;
 
 
1635
1636	VALIDATE_DESC(desc);
1637	chip = desc->gdev->chip;
1638	if (!chip->set || !chip->set_debounce) {
1639		gpiod_dbg(desc,
1640			  "%s: missing set() or set_debounce() operations\n",
1641			  __func__);
1642		return -ENOTSUPP;
1643	}
1644
1645	return chip->set_debounce(chip, gpio_chip_hwgpio(desc), debounce);
1646}
1647EXPORT_SYMBOL_GPL(gpiod_set_debounce);
 
 
 
 
 
 
 
 
1648
1649/**
1650 * gpiod_is_active_low - test whether a GPIO is active-low or not
1651 * @desc: the gpio descriptor to test
1652 *
1653 * Returns 1 if the GPIO is active-low, 0 otherwise.
1654 */
1655int gpiod_is_active_low(const struct gpio_desc *desc)
1656{
1657	VALIDATE_DESC(desc);
1658	return test_bit(FLAG_ACTIVE_LOW, &desc->flags);
 
 
 
 
 
1659}
1660EXPORT_SYMBOL_GPL(gpiod_is_active_low);
1661
1662/* I/O calls are only valid after configuration completed; the relevant
1663 * "is this a valid GPIO" error checks should already have been done.
1664 *
1665 * "Get" operations are often inlinable as reading a pin value register,
1666 * and masking the relevant bit in that register.
1667 *
1668 * When "set" operations are inlinable, they involve writing that mask to
1669 * one register to set a low value, or a different register to set it high.
1670 * Otherwise locking is needed, so there may be little value to inlining.
1671 *
1672 *------------------------------------------------------------------------
1673 *
1674 * IMPORTANT!!!  The hot paths -- get/set value -- assume that callers
1675 * have requested the GPIO.  That can include implicit requesting by
1676 * a direction setting call.  Marking a gpio as requested locks its chip
1677 * in memory, guaranteeing that these table lookups need no more locking
1678 * and that gpiochip_remove() will fail.
1679 *
1680 * REVISIT when debugging, consider adding some instrumentation to ensure
1681 * that the GPIO was actually requested.
1682 */
1683
1684static int _gpiod_get_raw_value(const struct gpio_desc *desc)
1685{
1686	struct gpio_chip	*chip;
1687	int offset;
1688	int value;
1689
1690	chip = desc->gdev->chip;
1691	offset = gpio_chip_hwgpio(desc);
1692	value = chip->get ? chip->get(chip, offset) : -EIO;
1693	value = value < 0 ? value : !!value;
1694	trace_gpio_value(desc_to_gpio(desc), 1, value);
1695	return value;
1696}
1697
1698/**
1699 * gpiod_get_raw_value() - return a gpio's raw value
1700 * @desc: gpio whose value will be returned
1701 *
1702 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
1703 * its ACTIVE_LOW status, or negative errno on failure.
1704 *
1705 * This function should be called from contexts where we cannot sleep, and will
1706 * complain if the GPIO chip functions potentially sleep.
1707 */
1708int gpiod_get_raw_value(const struct gpio_desc *desc)
1709{
1710	VALIDATE_DESC(desc);
1711	/* Should be using gpio_get_value_cansleep() */
1712	WARN_ON(desc->gdev->chip->can_sleep);
1713	return _gpiod_get_raw_value(desc);
1714}
1715EXPORT_SYMBOL_GPL(gpiod_get_raw_value);
1716
1717/**
1718 * gpiod_get_value() - return a gpio's value
1719 * @desc: gpio whose value will be returned
1720 *
1721 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
1722 * account, or negative errno on failure.
1723 *
1724 * This function should be called from contexts where we cannot sleep, and will
1725 * complain if the GPIO chip functions potentially sleep.
1726 */
1727int gpiod_get_value(const struct gpio_desc *desc)
1728{
 
1729	int value;
1730
1731	VALIDATE_DESC(desc);
1732	/* Should be using gpio_get_value_cansleep() */
1733	WARN_ON(desc->gdev->chip->can_sleep);
1734
1735	value = _gpiod_get_raw_value(desc);
1736	if (value < 0)
1737		return value;
1738
1739	if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
1740		value = !value;
1741
1742	return value;
1743}
1744EXPORT_SYMBOL_GPL(gpiod_get_value);
1745
1746/*
1747 *  _gpio_set_open_drain_value() - Set the open drain gpio's value.
1748 * @desc: gpio descriptor whose state need to be set.
1749 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
 
1750 */
1751static void _gpio_set_open_drain_value(struct gpio_desc *desc, bool value)
 
1752{
1753	int err = 0;
1754	struct gpio_chip *chip = desc->gdev->chip;
1755	int offset = gpio_chip_hwgpio(desc);
1756
1757	if (value) {
1758		err = chip->direction_input(chip, offset);
1759		if (!err)
1760			clear_bit(FLAG_IS_OUT, &desc->flags);
1761	} else {
1762		err = chip->direction_output(chip, offset, 0);
1763		if (!err)
1764			set_bit(FLAG_IS_OUT, &desc->flags);
1765	}
1766	trace_gpio_direction(desc_to_gpio(desc), value, err);
1767	if (err < 0)
1768		gpiod_err(desc,
1769			  "%s: Error in set_value for open drain err %d\n",
1770			  __func__, err);
1771}
1772
1773/*
1774 *  _gpio_set_open_source_value() - Set the open source gpio's value.
1775 * @desc: gpio descriptor whose state need to be set.
1776 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
 
1777 */
1778static void _gpio_set_open_source_value(struct gpio_desc *desc, bool value)
 
1779{
1780	int err = 0;
1781	struct gpio_chip *chip = desc->gdev->chip;
1782	int offset = gpio_chip_hwgpio(desc);
1783
1784	if (value) {
1785		err = chip->direction_output(chip, offset, 1);
1786		if (!err)
1787			set_bit(FLAG_IS_OUT, &desc->flags);
1788	} else {
1789		err = chip->direction_input(chip, offset);
1790		if (!err)
1791			clear_bit(FLAG_IS_OUT, &desc->flags);
1792	}
1793	trace_gpio_direction(desc_to_gpio(desc), !value, err);
1794	if (err < 0)
1795		gpiod_err(desc,
1796			  "%s: Error in set_value for open source err %d\n",
1797			  __func__, err);
1798}
1799
1800static void _gpiod_set_raw_value(struct gpio_desc *desc, bool value)
1801{
1802	struct gpio_chip	*chip;
1803
1804	chip = desc->gdev->chip;
1805	trace_gpio_value(desc_to_gpio(desc), 0, value);
1806	if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
1807		_gpio_set_open_drain_value(desc, value);
1808	else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
1809		_gpio_set_open_source_value(desc, value);
1810	else
1811		chip->set(chip, gpio_chip_hwgpio(desc), value);
1812}
1813
1814/*
1815 * set multiple outputs on the same chip;
1816 * use the chip's set_multiple function if available;
1817 * otherwise set the outputs sequentially;
1818 * @mask: bit mask array; one bit per output; BITS_PER_LONG bits per word
1819 *        defines which outputs are to be changed
1820 * @bits: bit value array; one bit per output; BITS_PER_LONG bits per word
1821 *        defines the values the outputs specified by mask are to be set to
1822 */
1823static void gpio_chip_set_multiple(struct gpio_chip *chip,
1824				   unsigned long *mask, unsigned long *bits)
1825{
1826	if (chip->set_multiple) {
1827		chip->set_multiple(chip, mask, bits);
1828	} else {
1829		int i;
1830		for (i = 0; i < chip->ngpio; i++) {
1831			if (mask[BIT_WORD(i)] == 0) {
1832				/* no more set bits in this mask word;
1833				 * skip ahead to the next word */
1834				i = (BIT_WORD(i) + 1) * BITS_PER_LONG - 1;
1835				continue;
1836			}
1837			/* set outputs if the corresponding mask bit is set */
1838			if (__test_and_clear_bit(i, mask))
1839				chip->set(chip, i, test_bit(i, bits));
1840		}
1841	}
1842}
1843
1844static void gpiod_set_array_value_priv(bool raw, bool can_sleep,
1845				       unsigned int array_size,
1846				       struct gpio_desc **desc_array,
1847				       int *value_array)
1848{
1849	int i = 0;
1850
1851	while (i < array_size) {
1852		struct gpio_chip *chip = desc_array[i]->gdev->chip;
1853		unsigned long mask[BITS_TO_LONGS(chip->ngpio)];
1854		unsigned long bits[BITS_TO_LONGS(chip->ngpio)];
1855		int count = 0;
1856
1857		if (!can_sleep)
1858			WARN_ON(chip->can_sleep);
1859
1860		memset(mask, 0, sizeof(mask));
1861		do {
1862			struct gpio_desc *desc = desc_array[i];
1863			int hwgpio = gpio_chip_hwgpio(desc);
1864			int value = value_array[i];
1865
1866			if (!raw && test_bit(FLAG_ACTIVE_LOW, &desc->flags))
1867				value = !value;
1868			trace_gpio_value(desc_to_gpio(desc), 0, value);
1869			/*
1870			 * collect all normal outputs belonging to the same chip
1871			 * open drain and open source outputs are set individually
1872			 */
1873			if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
1874				_gpio_set_open_drain_value(desc, value);
1875			} else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
1876				_gpio_set_open_source_value(desc, value);
1877			} else {
1878				__set_bit(hwgpio, mask);
1879				if (value)
1880					__set_bit(hwgpio, bits);
1881				else
1882					__clear_bit(hwgpio, bits);
1883				count++;
1884			}
1885			i++;
1886		} while ((i < array_size) &&
1887			 (desc_array[i]->gdev->chip == chip));
1888		/* push collected bits to outputs */
1889		if (count != 0)
1890			gpio_chip_set_multiple(chip, mask, bits);
1891	}
1892}
1893
1894/**
1895 * gpiod_set_raw_value() - assign a gpio's raw value
1896 * @desc: gpio whose value will be assigned
1897 * @value: value to assign
1898 *
1899 * Set the raw value of the GPIO, i.e. the value of its physical line without
1900 * regard for its ACTIVE_LOW status.
1901 *
1902 * This function should be called from contexts where we cannot sleep, and will
1903 * complain if the GPIO chip functions potentially sleep.
1904 */
1905void gpiod_set_raw_value(struct gpio_desc *desc, int value)
1906{
1907	VALIDATE_DESC_VOID(desc);
1908	/* Should be using gpiod_set_value_cansleep() */
1909	WARN_ON(desc->gdev->chip->can_sleep);
1910	_gpiod_set_raw_value(desc, value);
1911}
1912EXPORT_SYMBOL_GPL(gpiod_set_raw_value);
1913
1914/**
1915 * gpiod_set_value() - assign a gpio's value
1916 * @desc: gpio whose value will be assigned
1917 * @value: value to assign
 
1918 *
1919 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
1920 * account
1921 *
1922 * This function should be called from contexts where we cannot sleep, and will
1923 * complain if the GPIO chip functions potentially sleep.
1924 */
1925void gpiod_set_value(struct gpio_desc *desc, int value)
1926{
1927	VALIDATE_DESC_VOID(desc);
1928	/* Should be using gpiod_set_value_cansleep() */
1929	WARN_ON(desc->gdev->chip->can_sleep);
1930	if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
1931		value = !value;
1932	_gpiod_set_raw_value(desc, value);
1933}
1934EXPORT_SYMBOL_GPL(gpiod_set_value);
1935
1936/**
1937 * gpiod_set_raw_array_value() - assign values to an array of GPIOs
1938 * @array_size: number of elements in the descriptor / value arrays
1939 * @desc_array: array of GPIO descriptors whose values will be assigned
1940 * @value_array: array of values to assign
1941 *
1942 * Set the raw values of the GPIOs, i.e. the values of the physical lines
1943 * without regard for their ACTIVE_LOW status.
1944 *
1945 * This function should be called from contexts where we cannot sleep, and will
1946 * complain if the GPIO chip functions potentially sleep.
1947 */
1948void gpiod_set_raw_array_value(unsigned int array_size,
1949			 struct gpio_desc **desc_array, int *value_array)
1950{
1951	if (!desc_array)
1952		return;
1953	gpiod_set_array_value_priv(true, false, array_size, desc_array,
1954				   value_array);
1955}
1956EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value);
1957
1958/**
1959 * gpiod_set_array_value() - assign values to an array of GPIOs
1960 * @array_size: number of elements in the descriptor / value arrays
1961 * @desc_array: array of GPIO descriptors whose values will be assigned
1962 * @value_array: array of values to assign
1963 *
1964 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
1965 * into account.
1966 *
1967 * This function should be called from contexts where we cannot sleep, and will
1968 * complain if the GPIO chip functions potentially sleep.
1969 */
1970void gpiod_set_array_value(unsigned int array_size,
1971			   struct gpio_desc **desc_array, int *value_array)
1972{
1973	if (!desc_array)
1974		return;
1975	gpiod_set_array_value_priv(false, false, array_size, desc_array,
1976				   value_array);
1977}
1978EXPORT_SYMBOL_GPL(gpiod_set_array_value);
1979
1980/**
1981 * gpiod_cansleep() - report whether gpio value access may sleep
1982 * @desc: gpio to check
1983 *
1984 */
1985int gpiod_cansleep(const struct gpio_desc *desc)
1986{
1987	VALIDATE_DESC(desc);
1988	return desc->gdev->chip->can_sleep;
1989}
1990EXPORT_SYMBOL_GPL(gpiod_cansleep);
1991
1992/**
1993 * gpiod_to_irq() - return the IRQ corresponding to a GPIO
1994 * @desc: gpio whose IRQ will be returned (already requested)
1995 *
1996 * Return the IRQ corresponding to the passed GPIO, or an error code in case of
1997 * error.
1998 */
1999int gpiod_to_irq(const struct gpio_desc *desc)
2000{
2001	struct gpio_chip	*chip;
2002	int			offset;
2003
2004	VALIDATE_DESC(desc);
2005	chip = desc->gdev->chip;
2006	offset = gpio_chip_hwgpio(desc);
2007	return chip->to_irq ? chip->to_irq(chip, offset) : -ENXIO;
 
 
 
 
 
 
2008}
2009EXPORT_SYMBOL_GPL(gpiod_to_irq);
2010
2011/**
2012 * gpiochip_lock_as_irq() - lock a GPIO to be used as IRQ
2013 * @chip: the chip the GPIO to lock belongs to
2014 * @offset: the offset of the GPIO to lock as IRQ
2015 *
2016 * This is used directly by GPIO drivers that want to lock down
2017 * a certain GPIO line to be used for IRQs.
2018 */
2019int gpiochip_lock_as_irq(struct gpio_chip *chip, unsigned int offset)
2020{
2021	if (offset >= chip->ngpio)
2022		return -EINVAL;
2023
2024	if (test_bit(FLAG_IS_OUT, &chip->gpiodev->descs[offset].flags)) {
2025		chip_err(chip,
2026			  "%s: tried to flag a GPIO set as output for IRQ\n",
2027			  __func__);
2028		return -EIO;
2029	}
2030
2031	set_bit(FLAG_USED_AS_IRQ, &chip->gpiodev->descs[offset].flags);
2032	return 0;
2033}
2034EXPORT_SYMBOL_GPL(gpiochip_lock_as_irq);
2035
2036/**
2037 * gpiochip_unlock_as_irq() - unlock a GPIO used as IRQ
2038 * @chip: the chip the GPIO to lock belongs to
2039 * @offset: the offset of the GPIO to lock as IRQ
2040 *
2041 * This is used directly by GPIO drivers that want to indicate
2042 * that a certain GPIO is no longer used exclusively for IRQ.
 
2043 */
2044void gpiochip_unlock_as_irq(struct gpio_chip *chip, unsigned int offset)
2045{
2046	if (offset >= chip->ngpio)
2047		return;
2048
2049	clear_bit(FLAG_USED_AS_IRQ, &chip->gpiodev->descs[offset].flags);
2050}
2051EXPORT_SYMBOL_GPL(gpiochip_unlock_as_irq);
2052
2053bool gpiochip_line_is_irq(struct gpio_chip *chip, unsigned int offset)
2054{
2055	if (offset >= chip->ngpio)
2056		return false;
2057
2058	return test_bit(FLAG_USED_AS_IRQ, &chip->gpiodev->descs[offset].flags);
2059}
2060EXPORT_SYMBOL_GPL(gpiochip_line_is_irq);
2061
2062bool gpiochip_line_is_open_drain(struct gpio_chip *chip, unsigned int offset)
2063{
2064	if (offset >= chip->ngpio)
2065		return false;
2066
2067	return test_bit(FLAG_OPEN_DRAIN, &chip->gpiodev->descs[offset].flags);
 
2068}
2069EXPORT_SYMBOL_GPL(gpiochip_line_is_open_drain);
2070
2071bool gpiochip_line_is_open_source(struct gpio_chip *chip, unsigned int offset)
2072{
2073	if (offset >= chip->ngpio)
2074		return false;
2075
2076	return test_bit(FLAG_OPEN_SOURCE, &chip->gpiodev->descs[offset].flags);
2077}
2078EXPORT_SYMBOL_GPL(gpiochip_line_is_open_source);
2079
2080/**
2081 * gpiod_get_raw_value_cansleep() - return a gpio's raw value
2082 * @desc: gpio whose value will be returned
2083 *
2084 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
2085 * its ACTIVE_LOW status, or negative errno on failure.
2086 *
2087 * This function is to be called from contexts that can sleep.
2088 */
2089int gpiod_get_raw_value_cansleep(const struct gpio_desc *desc)
2090{
2091	might_sleep_if(extra_checks);
2092	VALIDATE_DESC(desc);
2093	return _gpiod_get_raw_value(desc);
2094}
2095EXPORT_SYMBOL_GPL(gpiod_get_raw_value_cansleep);
2096
2097/**
2098 * gpiod_get_value_cansleep() - return a gpio's value
2099 * @desc: gpio whose value will be returned
2100 *
2101 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
2102 * account, or negative errno on failure.
2103 *
2104 * This function is to be called from contexts that can sleep.
2105 */
2106int gpiod_get_value_cansleep(const struct gpio_desc *desc)
2107{
 
2108	int value;
2109
2110	might_sleep_if(extra_checks);
2111	VALIDATE_DESC(desc);
2112	value = _gpiod_get_raw_value(desc);
2113	if (value < 0)
2114		return value;
2115
2116	if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2117		value = !value;
2118
2119	return value;
2120}
2121EXPORT_SYMBOL_GPL(gpiod_get_value_cansleep);
2122
2123/**
2124 * gpiod_set_raw_value_cansleep() - assign a gpio's raw value
2125 * @desc: gpio whose value will be assigned
2126 * @value: value to assign
2127 *
2128 * Set the raw value of the GPIO, i.e. the value of its physical line without
2129 * regard for its ACTIVE_LOW status.
2130 *
2131 * This function is to be called from contexts that can sleep.
2132 */
2133void gpiod_set_raw_value_cansleep(struct gpio_desc *desc, int value)
2134{
2135	might_sleep_if(extra_checks);
2136	VALIDATE_DESC_VOID(desc);
2137	_gpiod_set_raw_value(desc, value);
2138}
2139EXPORT_SYMBOL_GPL(gpiod_set_raw_value_cansleep);
2140
2141/**
2142 * gpiod_set_value_cansleep() - assign a gpio's value
2143 * @desc: gpio whose value will be assigned
2144 * @value: value to assign
2145 *
2146 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
2147 * account
2148 *
2149 * This function is to be called from contexts that can sleep.
2150 */
2151void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
2152{
2153	might_sleep_if(extra_checks);
2154	VALIDATE_DESC_VOID(desc);
2155	if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2156		value = !value;
2157	_gpiod_set_raw_value(desc, value);
2158}
2159EXPORT_SYMBOL_GPL(gpiod_set_value_cansleep);
2160
2161/**
2162 * gpiod_set_raw_array_value_cansleep() - assign values to an array of GPIOs
2163 * @array_size: number of elements in the descriptor / value arrays
2164 * @desc_array: array of GPIO descriptors whose values will be assigned
2165 * @value_array: array of values to assign
2166 *
2167 * Set the raw values of the GPIOs, i.e. the values of the physical lines
2168 * without regard for their ACTIVE_LOW status.
2169 *
2170 * This function is to be called from contexts that can sleep.
2171 */
2172void gpiod_set_raw_array_value_cansleep(unsigned int array_size,
2173					struct gpio_desc **desc_array,
2174					int *value_array)
2175{
2176	might_sleep_if(extra_checks);
2177	if (!desc_array)
2178		return;
2179	gpiod_set_array_value_priv(true, true, array_size, desc_array,
2180				   value_array);
2181}
2182EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value_cansleep);
2183
2184/**
2185 * gpiod_set_array_value_cansleep() - assign values to an array of GPIOs
2186 * @array_size: number of elements in the descriptor / value arrays
2187 * @desc_array: array of GPIO descriptors whose values will be assigned
2188 * @value_array: array of values to assign
2189 *
2190 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
2191 * into account.
2192 *
2193 * This function is to be called from contexts that can sleep.
2194 */
2195void gpiod_set_array_value_cansleep(unsigned int array_size,
2196				    struct gpio_desc **desc_array,
2197				    int *value_array)
2198{
2199	might_sleep_if(extra_checks);
2200	if (!desc_array)
2201		return;
2202	gpiod_set_array_value_priv(false, true, array_size, desc_array,
2203				   value_array);
2204}
2205EXPORT_SYMBOL_GPL(gpiod_set_array_value_cansleep);
2206
2207/**
2208 * gpiod_add_lookup_table() - register GPIO device consumers
2209 * @table: table of consumers to register
2210 */
2211void gpiod_add_lookup_table(struct gpiod_lookup_table *table)
2212{
2213	mutex_lock(&gpio_lookup_lock);
2214
2215	list_add_tail(&table->list, &gpio_lookup_list);
2216
2217	mutex_unlock(&gpio_lookup_lock);
2218}
2219
2220/**
2221 * gpiod_remove_lookup_table() - unregister GPIO device consumers
2222 * @table: table of consumers to unregister
2223 */
2224void gpiod_remove_lookup_table(struct gpiod_lookup_table *table)
2225{
2226	mutex_lock(&gpio_lookup_lock);
2227
2228	list_del(&table->list);
2229
2230	mutex_unlock(&gpio_lookup_lock);
2231}
2232
2233static struct gpio_desc *of_find_gpio(struct device *dev, const char *con_id,
2234				      unsigned int idx,
2235				      enum gpio_lookup_flags *flags)
2236{
2237	char prop_name[32]; /* 32 is max size of property name */
2238	enum of_gpio_flags of_flags;
2239	struct gpio_desc *desc;
2240	unsigned int i;
2241
2242	for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
2243		if (con_id)
2244			snprintf(prop_name, sizeof(prop_name), "%s-%s", con_id,
2245				 gpio_suffixes[i]);
2246		else
2247			snprintf(prop_name, sizeof(prop_name), "%s",
2248				 gpio_suffixes[i]);
2249
2250		desc = of_get_named_gpiod_flags(dev->of_node, prop_name, idx,
2251						&of_flags);
2252		if (!IS_ERR(desc) || (PTR_ERR(desc) == -EPROBE_DEFER))
2253			break;
2254	}
2255
2256	if (IS_ERR(desc))
2257		return desc;
2258
2259	if (of_flags & OF_GPIO_ACTIVE_LOW)
2260		*flags |= GPIO_ACTIVE_LOW;
2261
2262	if (of_flags & OF_GPIO_SINGLE_ENDED) {
2263		if (of_flags & OF_GPIO_ACTIVE_LOW)
2264			*flags |= GPIO_OPEN_DRAIN;
2265		else
2266			*flags |= GPIO_OPEN_SOURCE;
2267	}
2268
2269	return desc;
2270}
2271
2272static struct gpio_desc *acpi_find_gpio(struct device *dev,
2273					const char *con_id,
2274					unsigned int idx,
2275					enum gpiod_flags flags,
2276					enum gpio_lookup_flags *lookupflags)
2277{
2278	struct acpi_device *adev = ACPI_COMPANION(dev);
2279	struct acpi_gpio_info info;
2280	struct gpio_desc *desc;
2281	char propname[32];
2282	int i;
2283
2284	/* Try first from _DSD */
2285	for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
2286		if (con_id && strcmp(con_id, "gpios")) {
2287			snprintf(propname, sizeof(propname), "%s-%s",
2288				 con_id, gpio_suffixes[i]);
2289		} else {
2290			snprintf(propname, sizeof(propname), "%s",
2291				 gpio_suffixes[i]);
2292		}
2293
2294		desc = acpi_get_gpiod_by_index(adev, propname, idx, &info);
2295		if (!IS_ERR(desc) || (PTR_ERR(desc) == -EPROBE_DEFER))
2296			break;
2297	}
2298
2299	/* Then from plain _CRS GPIOs */
2300	if (IS_ERR(desc)) {
2301		if (!acpi_can_fallback_to_crs(adev, con_id))
2302			return ERR_PTR(-ENOENT);
2303
2304		desc = acpi_get_gpiod_by_index(adev, NULL, idx, &info);
2305		if (IS_ERR(desc))
2306			return desc;
2307
2308		if ((flags == GPIOD_OUT_LOW || flags == GPIOD_OUT_HIGH) &&
2309		    info.gpioint) {
2310			dev_dbg(dev, "refusing GpioInt() entry when doing GPIOD_OUT_* lookup\n");
2311			return ERR_PTR(-ENOENT);
2312		}
2313	}
2314
2315	if (info.polarity == GPIO_ACTIVE_LOW)
2316		*lookupflags |= GPIO_ACTIVE_LOW;
2317
2318	return desc;
2319}
2320
2321static struct gpiod_lookup_table *gpiod_find_lookup_table(struct device *dev)
2322{
2323	const char *dev_id = dev ? dev_name(dev) : NULL;
2324	struct gpiod_lookup_table *table;
2325
2326	mutex_lock(&gpio_lookup_lock);
2327
2328	list_for_each_entry(table, &gpio_lookup_list, list) {
2329		if (table->dev_id && dev_id) {
2330			/*
2331			 * Valid strings on both ends, must be identical to have
2332			 * a match
2333			 */
2334			if (!strcmp(table->dev_id, dev_id))
2335				goto found;
2336		} else {
2337			/*
2338			 * One of the pointers is NULL, so both must be to have
2339			 * a match
2340			 */
2341			if (dev_id == table->dev_id)
2342				goto found;
2343		}
2344	}
2345	table = NULL;
2346
2347found:
2348	mutex_unlock(&gpio_lookup_lock);
2349	return table;
2350}
2351
2352static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id,
2353				    unsigned int idx,
2354				    enum gpio_lookup_flags *flags)
2355{
2356	struct gpio_desc *desc = ERR_PTR(-ENOENT);
2357	struct gpiod_lookup_table *table;
2358	struct gpiod_lookup *p;
2359
2360	table = gpiod_find_lookup_table(dev);
2361	if (!table)
2362		return desc;
2363
2364	for (p = &table->table[0]; p->chip_label; p++) {
2365		struct gpio_chip *chip;
2366
2367		/* idx must always match exactly */
2368		if (p->idx != idx)
2369			continue;
2370
2371		/* If the lookup entry has a con_id, require exact match */
2372		if (p->con_id && (!con_id || strcmp(p->con_id, con_id)))
2373			continue;
2374
2375		chip = find_chip_by_name(p->chip_label);
2376
2377		if (!chip) {
2378			dev_err(dev, "cannot find GPIO chip %s\n",
2379				p->chip_label);
2380			return ERR_PTR(-ENODEV);
2381		}
2382
2383		if (chip->ngpio <= p->chip_hwnum) {
2384			dev_err(dev,
2385				"requested GPIO %d is out of range [0..%d] for chip %s\n",
2386				idx, chip->ngpio, chip->label);
2387			return ERR_PTR(-EINVAL);
2388		}
2389
2390		desc = gpiochip_get_desc(chip, p->chip_hwnum);
2391		*flags = p->flags;
2392
2393		return desc;
2394	}
2395
2396	return desc;
2397}
2398
2399static int dt_gpio_count(struct device *dev, const char *con_id)
2400{
2401	int ret;
2402	char propname[32];
2403	unsigned int i;
2404
2405	for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
2406		if (con_id)
2407			snprintf(propname, sizeof(propname), "%s-%s",
2408				 con_id, gpio_suffixes[i]);
2409		else
2410			snprintf(propname, sizeof(propname), "%s",
2411				 gpio_suffixes[i]);
2412
2413		ret = of_gpio_named_count(dev->of_node, propname);
2414		if (ret >= 0)
2415			break;
2416	}
2417	return ret;
2418}
2419
2420static int platform_gpio_count(struct device *dev, const char *con_id)
2421{
2422	struct gpiod_lookup_table *table;
2423	struct gpiod_lookup *p;
2424	unsigned int count = 0;
2425
2426	table = gpiod_find_lookup_table(dev);
2427	if (!table)
2428		return -ENOENT;
2429
2430	for (p = &table->table[0]; p->chip_label; p++) {
2431		if ((con_id && p->con_id && !strcmp(con_id, p->con_id)) ||
2432		    (!con_id && !p->con_id))
2433			count++;
2434	}
2435	if (!count)
2436		return -ENOENT;
2437
2438	return count;
2439}
2440
2441/**
2442 * gpiod_count - return the number of GPIOs associated with a device / function
2443 *		or -ENOENT if no GPIO has been assigned to the requested function
2444 * @dev:	GPIO consumer, can be NULL for system-global GPIOs
2445 * @con_id:	function within the GPIO consumer
2446 */
2447int gpiod_count(struct device *dev, const char *con_id)
2448{
2449	int count = -ENOENT;
2450
2451	if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
2452		count = dt_gpio_count(dev, con_id);
2453	else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev))
2454		count = acpi_gpio_count(dev, con_id);
2455
2456	if (count < 0)
2457		count = platform_gpio_count(dev, con_id);
2458
2459	return count;
2460}
2461EXPORT_SYMBOL_GPL(gpiod_count);
2462
2463/**
2464 * gpiod_get - obtain a GPIO for a given GPIO function
2465 * @dev:	GPIO consumer, can be NULL for system-global GPIOs
2466 * @con_id:	function within the GPIO consumer
2467 * @flags:	optional GPIO initialization flags
2468 *
2469 * Return the GPIO descriptor corresponding to the function con_id of device
2470 * dev, -ENOENT if no GPIO has been assigned to the requested function, or
2471 * another IS_ERR() code if an error occurred while trying to acquire the GPIO.
2472 */
2473struct gpio_desc *__must_check gpiod_get(struct device *dev, const char *con_id,
2474					 enum gpiod_flags flags)
2475{
2476	return gpiod_get_index(dev, con_id, 0, flags);
2477}
2478EXPORT_SYMBOL_GPL(gpiod_get);
2479
2480/**
2481 * gpiod_get_optional - obtain an optional GPIO for a given GPIO function
2482 * @dev: GPIO consumer, can be NULL for system-global GPIOs
2483 * @con_id: function within the GPIO consumer
2484 * @flags: optional GPIO initialization flags
2485 *
2486 * This is equivalent to gpiod_get(), except that when no GPIO was assigned to
2487 * the requested function it will return NULL. This is convenient for drivers
2488 * that need to handle optional GPIOs.
2489 */
2490struct gpio_desc *__must_check gpiod_get_optional(struct device *dev,
2491						  const char *con_id,
2492						  enum gpiod_flags flags)
2493{
2494	return gpiod_get_index_optional(dev, con_id, 0, flags);
2495}
2496EXPORT_SYMBOL_GPL(gpiod_get_optional);
2497
2498/**
2499 * gpiod_parse_flags - helper function to parse GPIO lookup flags
2500 * @desc:	gpio to be setup
2501 * @lflags:	gpio_lookup_flags - returned from of_find_gpio() or
2502 *		of_get_gpio_hog()
2503 *
2504 * Set the GPIO descriptor flags based on the given GPIO lookup flags.
2505 */
2506static void gpiod_parse_flags(struct gpio_desc *desc, unsigned long lflags)
2507{
2508	if (lflags & GPIO_ACTIVE_LOW)
2509		set_bit(FLAG_ACTIVE_LOW, &desc->flags);
2510	if (lflags & GPIO_OPEN_DRAIN)
2511		set_bit(FLAG_OPEN_DRAIN, &desc->flags);
2512	if (lflags & GPIO_OPEN_SOURCE)
2513		set_bit(FLAG_OPEN_SOURCE, &desc->flags);
2514}
2515
2516/**
2517 * gpiod_configure_flags - helper function to configure a given GPIO
2518 * @desc:	gpio whose value will be assigned
2519 * @con_id:	function within the GPIO consumer
2520 * @dflags:	gpiod_flags - optional GPIO initialization flags
2521 *
2522 * Return 0 on success, -ENOENT if no GPIO has been assigned to the
2523 * requested function and/or index, or another IS_ERR() code if an error
2524 * occurred while trying to acquire the GPIO.
2525 */
2526static int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id,
2527				 enum gpiod_flags dflags)
2528{
2529	int status;
2530
2531	/* No particular flag request, return here... */
2532	if (!(dflags & GPIOD_FLAGS_BIT_DIR_SET)) {
2533		pr_debug("no flags found for %s\n", con_id);
2534		return 0;
2535	}
2536
2537	/* Process flags */
2538	if (dflags & GPIOD_FLAGS_BIT_DIR_OUT)
2539		status = gpiod_direction_output(desc,
2540					      dflags & GPIOD_FLAGS_BIT_DIR_VAL);
2541	else
2542		status = gpiod_direction_input(desc);
2543
2544	return status;
2545}
2546
2547/**
2548 * gpiod_get_index - obtain a GPIO from a multi-index GPIO function
2549 * @dev:	GPIO consumer, can be NULL for system-global GPIOs
2550 * @con_id:	function within the GPIO consumer
2551 * @idx:	index of the GPIO to obtain in the consumer
2552 * @flags:	optional GPIO initialization flags
2553 *
2554 * This variant of gpiod_get() allows to access GPIOs other than the first
2555 * defined one for functions that define several GPIOs.
2556 *
2557 * Return a valid GPIO descriptor, -ENOENT if no GPIO has been assigned to the
2558 * requested function and/or index, or another IS_ERR() code if an error
2559 * occurred while trying to acquire the GPIO.
2560 */
2561struct gpio_desc *__must_check gpiod_get_index(struct device *dev,
2562					       const char *con_id,
2563					       unsigned int idx,
2564					       enum gpiod_flags flags)
2565{
2566	struct gpio_desc *desc = NULL;
2567	int status;
2568	enum gpio_lookup_flags lookupflags = 0;
2569
2570	dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id);
2571
2572	if (dev) {
2573		/* Using device tree? */
2574		if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
2575			dev_dbg(dev, "using device tree for GPIO lookup\n");
2576			desc = of_find_gpio(dev, con_id, idx, &lookupflags);
2577		} else if (ACPI_COMPANION(dev)) {
2578			dev_dbg(dev, "using ACPI for GPIO lookup\n");
2579			desc = acpi_find_gpio(dev, con_id, idx, flags, &lookupflags);
2580		}
2581	}
2582
2583	/*
2584	 * Either we are not using DT or ACPI, or their lookup did not return
2585	 * a result. In that case, use platform lookup as a fallback.
2586	 */
2587	if (!desc || desc == ERR_PTR(-ENOENT)) {
2588		dev_dbg(dev, "using lookup tables for GPIO lookup\n");
2589		desc = gpiod_find(dev, con_id, idx, &lookupflags);
2590	}
2591
2592	if (IS_ERR(desc)) {
2593		dev_dbg(dev, "lookup for GPIO %s failed\n", con_id);
2594		return desc;
2595	}
2596
2597	gpiod_parse_flags(desc, lookupflags);
2598
2599	status = gpiod_request(desc, con_id);
2600	if (status < 0)
2601		return ERR_PTR(status);
2602
2603	status = gpiod_configure_flags(desc, con_id, flags);
2604	if (status < 0) {
2605		dev_dbg(dev, "setup of GPIO %s failed\n", con_id);
2606		gpiod_put(desc);
2607		return ERR_PTR(status);
2608	}
2609
2610	return desc;
2611}
2612EXPORT_SYMBOL_GPL(gpiod_get_index);
2613
2614/**
2615 * fwnode_get_named_gpiod - obtain a GPIO from firmware node
2616 * @fwnode:	handle of the firmware node
2617 * @propname:	name of the firmware property representing the GPIO
2618 *
2619 * This function can be used for drivers that get their configuration
2620 * from firmware.
2621 *
2622 * Function properly finds the corresponding GPIO using whatever is the
2623 * underlying firmware interface and then makes sure that the GPIO
2624 * descriptor is requested before it is returned to the caller.
2625 *
2626 * In case of error an ERR_PTR() is returned.
2627 */
2628struct gpio_desc *fwnode_get_named_gpiod(struct fwnode_handle *fwnode,
2629					 const char *propname)
2630{
2631	struct gpio_desc *desc = ERR_PTR(-ENODEV);
2632	bool active_low = false;
2633	bool single_ended = false;
2634	int ret;
2635
2636	if (!fwnode)
2637		return ERR_PTR(-EINVAL);
2638
2639	if (is_of_node(fwnode)) {
2640		enum of_gpio_flags flags;
2641
2642		desc = of_get_named_gpiod_flags(to_of_node(fwnode), propname, 0,
2643						&flags);
2644		if (!IS_ERR(desc)) {
2645			active_low = flags & OF_GPIO_ACTIVE_LOW;
2646			single_ended = flags & OF_GPIO_SINGLE_ENDED;
2647		}
2648	} else if (is_acpi_node(fwnode)) {
2649		struct acpi_gpio_info info;
2650
2651		desc = acpi_node_get_gpiod(fwnode, propname, 0, &info);
2652		if (!IS_ERR(desc))
2653			active_low = info.polarity == GPIO_ACTIVE_LOW;
2654	}
2655
2656	if (IS_ERR(desc))
2657		return desc;
2658
2659	if (active_low)
2660		set_bit(FLAG_ACTIVE_LOW, &desc->flags);
2661
2662	if (single_ended) {
2663		if (active_low)
2664			set_bit(FLAG_OPEN_DRAIN, &desc->flags);
2665		else
2666			set_bit(FLAG_OPEN_SOURCE, &desc->flags);
2667	}
2668
2669	ret = gpiod_request(desc, NULL);
2670	if (ret)
2671		return ERR_PTR(ret);
2672
2673	return desc;
2674}
2675EXPORT_SYMBOL_GPL(fwnode_get_named_gpiod);
2676
2677/**
2678 * gpiod_get_index_optional - obtain an optional GPIO from a multi-index GPIO
2679 *                            function
2680 * @dev: GPIO consumer, can be NULL for system-global GPIOs
2681 * @con_id: function within the GPIO consumer
2682 * @index: index of the GPIO to obtain in the consumer
2683 * @flags: optional GPIO initialization flags
2684 *
2685 * This is equivalent to gpiod_get_index(), except that when no GPIO with the
2686 * specified index was assigned to the requested function it will return NULL.
2687 * This is convenient for drivers that need to handle optional GPIOs.
2688 */
2689struct gpio_desc *__must_check gpiod_get_index_optional(struct device *dev,
2690							const char *con_id,
2691							unsigned int index,
2692							enum gpiod_flags flags)
2693{
2694	struct gpio_desc *desc;
2695
2696	desc = gpiod_get_index(dev, con_id, index, flags);
2697	if (IS_ERR(desc)) {
2698		if (PTR_ERR(desc) == -ENOENT)
2699			return NULL;
2700	}
2701
2702	return desc;
2703}
2704EXPORT_SYMBOL_GPL(gpiod_get_index_optional);
2705
2706/**
2707 * gpiod_hog - Hog the specified GPIO desc given the provided flags
2708 * @desc:	gpio whose value will be assigned
2709 * @name:	gpio line name
2710 * @lflags:	gpio_lookup_flags - returned from of_find_gpio() or
2711 *		of_get_gpio_hog()
2712 * @dflags:	gpiod_flags - optional GPIO initialization flags
2713 */
2714int gpiod_hog(struct gpio_desc *desc, const char *name,
2715	      unsigned long lflags, enum gpiod_flags dflags)
2716{
2717	struct gpio_chip *chip;
2718	struct gpio_desc *local_desc;
2719	int hwnum;
2720	int status;
2721
2722	chip = gpiod_to_chip(desc);
2723	hwnum = gpio_chip_hwgpio(desc);
2724
2725	gpiod_parse_flags(desc, lflags);
2726
2727	local_desc = gpiochip_request_own_desc(chip, hwnum, name);
2728	if (IS_ERR(local_desc)) {
2729		pr_err("requesting hog GPIO %s (chip %s, offset %d) failed\n",
2730		       name, chip->label, hwnum);
2731		return PTR_ERR(local_desc);
2732	}
2733
2734	status = gpiod_configure_flags(desc, name, dflags);
2735	if (status < 0) {
2736		pr_err("setup of hog GPIO %s (chip %s, offset %d) failed\n",
2737		       name, chip->label, hwnum);
2738		gpiochip_free_own_desc(desc);
2739		return status;
2740	}
2741
2742	/* Mark GPIO as hogged so it can be identified and removed later */
2743	set_bit(FLAG_IS_HOGGED, &desc->flags);
2744
2745	pr_info("GPIO line %d (%s) hogged as %s%s\n",
2746		desc_to_gpio(desc), name,
2747		(dflags&GPIOD_FLAGS_BIT_DIR_OUT) ? "output" : "input",
2748		(dflags&GPIOD_FLAGS_BIT_DIR_OUT) ?
2749		  (dflags&GPIOD_FLAGS_BIT_DIR_VAL) ? "/high" : "/low":"");
2750
2751	return 0;
2752}
2753
2754/**
2755 * gpiochip_free_hogs - Scan gpio-controller chip and release GPIO hog
2756 * @chip:	gpio chip to act on
2757 *
2758 * This is only used by of_gpiochip_remove to free hogged gpios
2759 */
2760static void gpiochip_free_hogs(struct gpio_chip *chip)
2761{
2762	int id;
2763
2764	for (id = 0; id < chip->ngpio; id++) {
2765		if (test_bit(FLAG_IS_HOGGED, &chip->gpiodev->descs[id].flags))
2766			gpiochip_free_own_desc(&chip->gpiodev->descs[id]);
2767	}
2768}
2769
2770/**
2771 * gpiod_get_array - obtain multiple GPIOs from a multi-index GPIO function
2772 * @dev:	GPIO consumer, can be NULL for system-global GPIOs
2773 * @con_id:	function within the GPIO consumer
2774 * @flags:	optional GPIO initialization flags
2775 *
2776 * This function acquires all the GPIOs defined under a given function.
2777 *
2778 * Return a struct gpio_descs containing an array of descriptors, -ENOENT if
2779 * no GPIO has been assigned to the requested function, or another IS_ERR()
2780 * code if an error occurred while trying to acquire the GPIOs.
2781 */
2782struct gpio_descs *__must_check gpiod_get_array(struct device *dev,
2783						const char *con_id,
2784						enum gpiod_flags flags)
2785{
2786	struct gpio_desc *desc;
2787	struct gpio_descs *descs;
2788	int count;
2789
2790	count = gpiod_count(dev, con_id);
2791	if (count < 0)
2792		return ERR_PTR(count);
2793
2794	descs = kzalloc(sizeof(*descs) + sizeof(descs->desc[0]) * count,
2795			GFP_KERNEL);
2796	if (!descs)
2797		return ERR_PTR(-ENOMEM);
2798
2799	for (descs->ndescs = 0; descs->ndescs < count; ) {
2800		desc = gpiod_get_index(dev, con_id, descs->ndescs, flags);
2801		if (IS_ERR(desc)) {
2802			gpiod_put_array(descs);
2803			return ERR_CAST(desc);
2804		}
2805		descs->desc[descs->ndescs] = desc;
2806		descs->ndescs++;
2807	}
2808	return descs;
2809}
2810EXPORT_SYMBOL_GPL(gpiod_get_array);
2811
2812/**
2813 * gpiod_get_array_optional - obtain multiple GPIOs from a multi-index GPIO
2814 *                            function
2815 * @dev:	GPIO consumer, can be NULL for system-global GPIOs
2816 * @con_id:	function within the GPIO consumer
2817 * @flags:	optional GPIO initialization flags
2818 *
2819 * This is equivalent to gpiod_get_array(), except that when no GPIO was
2820 * assigned to the requested function it will return NULL.
2821 */
2822struct gpio_descs *__must_check gpiod_get_array_optional(struct device *dev,
2823							const char *con_id,
2824							enum gpiod_flags flags)
2825{
2826	struct gpio_descs *descs;
2827
2828	descs = gpiod_get_array(dev, con_id, flags);
2829	if (IS_ERR(descs) && (PTR_ERR(descs) == -ENOENT))
2830		return NULL;
2831
2832	return descs;
2833}
2834EXPORT_SYMBOL_GPL(gpiod_get_array_optional);
2835
2836/**
2837 * gpiod_put - dispose of a GPIO descriptor
2838 * @desc:	GPIO descriptor to dispose of
2839 *
2840 * No descriptor can be used after gpiod_put() has been called on it.
2841 */
2842void gpiod_put(struct gpio_desc *desc)
2843{
2844	gpiod_free(desc);
2845}
2846EXPORT_SYMBOL_GPL(gpiod_put);
2847
2848/**
2849 * gpiod_put_array - dispose of multiple GPIO descriptors
2850 * @descs:	struct gpio_descs containing an array of descriptors
2851 */
2852void gpiod_put_array(struct gpio_descs *descs)
2853{
2854	unsigned int i;
2855
2856	for (i = 0; i < descs->ndescs; i++)
2857		gpiod_put(descs->desc[i]);
2858
2859	kfree(descs);
2860}
2861EXPORT_SYMBOL_GPL(gpiod_put_array);
2862
2863static int __init gpiolib_dev_init(void)
2864{
2865	int ret;
2866
2867	/* Register GPIO sysfs bus */
2868	ret  = bus_register(&gpio_bus_type);
2869	if (ret < 0) {
2870		pr_err("gpiolib: could not register GPIO bus type\n");
2871		return ret;
2872	}
2873
2874	ret = alloc_chrdev_region(&gpio_devt, 0, GPIO_DEV_MAX, "gpiochip");
2875	if (ret < 0) {
2876		pr_err("gpiolib: failed to allocate char dev region\n");
2877		bus_unregister(&gpio_bus_type);
2878	} else {
2879		gpiolib_initialized = true;
2880		gpiochip_setup_devs();
2881	}
2882	return ret;
2883}
2884core_initcall(gpiolib_dev_init);
2885
2886#ifdef CONFIG_DEBUG_FS
2887
2888static void gpiolib_dbg_show(struct seq_file *s, struct gpio_device *gdev)
2889{
2890	unsigned		i;
2891	struct gpio_chip	*chip = gdev->chip;
2892	unsigned		gpio = gdev->base;
2893	struct gpio_desc	*gdesc = &gdev->descs[0];
2894	int			is_out;
2895	int			is_irq;
2896
2897	for (i = 0; i < gdev->ngpio; i++, gpio++, gdesc++) {
2898		if (!test_bit(FLAG_REQUESTED, &gdesc->flags)) {
2899			if (gdesc->name) {
2900				seq_printf(s, " gpio-%-3d (%-20.20s)\n",
2901					   gpio, gdesc->name);
2902			}
2903			continue;
2904		}
2905
2906		gpiod_get_direction(gdesc);
2907		is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
2908		is_irq = test_bit(FLAG_USED_AS_IRQ, &gdesc->flags);
2909		seq_printf(s, " gpio-%-3d (%-20.20s|%-20.20s) %s %s %s",
2910			gpio, gdesc->name ? gdesc->name : "", gdesc->label,
2911			is_out ? "out" : "in ",
2912			chip->get
2913				? (chip->get(chip, i) ? "hi" : "lo")
2914				: "?  ",
2915			is_irq ? "IRQ" : "   ");
2916		seq_printf(s, "\n");
2917	}
2918}
2919
2920static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
2921{
2922	unsigned long flags;
2923	struct gpio_device *gdev = NULL;
2924	loff_t index = *pos;
2925
2926	s->private = "";
2927
2928	spin_lock_irqsave(&gpio_lock, flags);
2929	list_for_each_entry(gdev, &gpio_devices, list)
2930		if (index-- == 0) {
2931			spin_unlock_irqrestore(&gpio_lock, flags);
2932			return gdev;
2933		}
2934	spin_unlock_irqrestore(&gpio_lock, flags);
2935
2936	return NULL;
2937}
2938
2939static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
2940{
2941	unsigned long flags;
2942	struct gpio_device *gdev = v;
2943	void *ret = NULL;
2944
2945	spin_lock_irqsave(&gpio_lock, flags);
2946	if (list_is_last(&gdev->list, &gpio_devices))
2947		ret = NULL;
2948	else
2949		ret = list_entry(gdev->list.next, struct gpio_device, list);
2950	spin_unlock_irqrestore(&gpio_lock, flags);
2951
2952	s->private = "\n";
2953	++*pos;
2954
2955	return ret;
2956}
2957
2958static void gpiolib_seq_stop(struct seq_file *s, void *v)
2959{
2960}
2961
2962static int gpiolib_seq_show(struct seq_file *s, void *v)
2963{
2964	struct gpio_device *gdev = v;
2965	struct gpio_chip *chip = gdev->chip;
2966	struct device *parent;
2967
2968	if (!chip) {
2969		seq_printf(s, "%s%s: (dangling chip)", (char *)s->private,
2970			   dev_name(&gdev->dev));
2971		return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2972	}
2973
2974	seq_printf(s, "%s%s: GPIOs %d-%d", (char *)s->private,
2975		   dev_name(&gdev->dev),
2976		   gdev->base, gdev->base + gdev->ngpio - 1);
2977	parent = chip->parent;
2978	if (parent)
2979		seq_printf(s, ", parent: %s/%s",
2980			   parent->bus ? parent->bus->name : "no-bus",
2981			   dev_name(parent));
2982	if (chip->label)
2983		seq_printf(s, ", %s", chip->label);
2984	if (chip->can_sleep)
2985		seq_printf(s, ", can sleep");
2986	seq_printf(s, ":\n");
2987
2988	if (chip->dbg_show)
2989		chip->dbg_show(s, chip);
2990	else
2991		gpiolib_dbg_show(s, gdev);
2992
2993	return 0;
2994}
2995
2996static const struct seq_operations gpiolib_seq_ops = {
2997	.start = gpiolib_seq_start,
2998	.next = gpiolib_seq_next,
2999	.stop = gpiolib_seq_stop,
3000	.show = gpiolib_seq_show,
3001};
3002
3003static int gpiolib_open(struct inode *inode, struct file *file)
3004{
3005	return seq_open(file, &gpiolib_seq_ops);
3006}
3007
3008static const struct file_operations gpiolib_operations = {
3009	.owner		= THIS_MODULE,
3010	.open		= gpiolib_open,
3011	.read		= seq_read,
3012	.llseek		= seq_lseek,
3013	.release	= seq_release,
3014};
3015
3016static int __init gpiolib_debugfs_init(void)
3017{
3018	/* /sys/kernel/debug/gpio */
3019	(void) debugfs_create_file("gpio", S_IFREG | S_IRUGO,
3020				NULL, NULL, &gpiolib_operations);
3021	return 0;
3022}
3023subsys_initcall(gpiolib_debugfs_init);
3024
3025#endif	/* DEBUG_FS */
v3.5.6
   1#include <linux/kernel.h>
   2#include <linux/module.h>
   3#include <linux/interrupt.h>
   4#include <linux/irq.h>
   5#include <linux/spinlock.h>
 
   6#include <linux/device.h>
   7#include <linux/err.h>
   8#include <linux/debugfs.h>
   9#include <linux/seq_file.h>
  10#include <linux/gpio.h>
  11#include <linux/of_gpio.h>
  12#include <linux/idr.h>
  13#include <linux/slab.h>
 
 
 
 
 
 
 
 
 
 
 
  14
  15#define CREATE_TRACE_POINTS
  16#include <trace/events/gpio.h>
  17
  18/* Optional implementation infrastructure for GPIO interfaces.
  19 *
  20 * Platforms may want to use this if they tend to use very many GPIOs
  21 * that aren't part of a System-On-Chip core; or across I2C/SPI/etc.
  22 *
  23 * When kernel footprint or instruction count is an issue, simpler
  24 * implementations may be preferred.  The GPIO programming interface
  25 * allows for inlining speed-critical get/set operations for common
  26 * cases, so that access to SOC-integrated GPIOs can sometimes cost
  27 * only an instruction or two per bit.
  28 */
  29
  30
  31/* When debugging, extend minimal trust to callers and platform code.
  32 * Also emit diagnostic messages that may help initial bringup, when
  33 * board setup or driver bugs are most common.
  34 *
  35 * Otherwise, minimize overhead in what may be bitbanging codepaths.
  36 */
  37#ifdef	DEBUG
  38#define	extra_checks	1
  39#else
  40#define	extra_checks	0
  41#endif
  42
 
 
 
 
 
 
 
 
  43/* gpio_lock prevents conflicts during gpio_desc[] table updates.
  44 * While any GPIO is requested, its gpio_chip is not removable;
  45 * each GPIO's "requested" flag serves as a lock and refcount.
  46 */
  47static DEFINE_SPINLOCK(gpio_lock);
  48
  49struct gpio_desc {
  50	struct gpio_chip	*chip;
  51	unsigned long		flags;
  52/* flag symbols are bit numbers */
  53#define FLAG_REQUESTED	0
  54#define FLAG_IS_OUT	1
  55#define FLAG_RESERVED	2
  56#define FLAG_EXPORT	3	/* protected by sysfs_lock */
  57#define FLAG_SYSFS	4	/* exported via /sys/class/gpio/control */
  58#define FLAG_TRIG_FALL	5	/* trigger on falling edge */
  59#define FLAG_TRIG_RISE	6	/* trigger on rising edge */
  60#define FLAG_ACTIVE_LOW	7	/* sysfs value has active low */
  61#define FLAG_OPEN_DRAIN	8	/* Gpio is open drain type */
  62#define FLAG_OPEN_SOURCE 9	/* Gpio is open source type */
  63
  64#define ID_SHIFT	16	/* add new flags before this one */
 
  65
  66#define GPIO_FLAGS_MASK		((1 << ID_SHIFT) - 1)
  67#define GPIO_TRIGGER_MASK	(BIT(FLAG_TRIG_FALL) | BIT(FLAG_TRIG_RISE))
  68
  69#ifdef CONFIG_DEBUG_FS
  70	const char		*label;
  71#endif
  72};
  73static struct gpio_desc gpio_desc[ARCH_NR_GPIOS];
  74
  75#ifdef CONFIG_GPIO_SYSFS
  76static DEFINE_IDR(dirent_idr);
  77#endif
  78
  79static inline void desc_set_label(struct gpio_desc *d, const char *label)
  80{
  81#ifdef CONFIG_DEBUG_FS
  82	d->label = label;
  83#endif
  84}
  85
  86/* Warn when drivers omit gpio_request() calls -- legal but ill-advised
  87 * when setting direction, and otherwise illegal.  Until board setup code
  88 * and drivers use explicit requests everywhere (which won't happen when
  89 * those calls have no teeth) we can't avoid autorequesting.  This nag
  90 * message should motivate switching to explicit requests... so should
  91 * the weaker cleanup after faults, compared to gpio_request().
  92 *
  93 * NOTE: the autorequest mechanism is going away; at this point it's
  94 * only "legal" in the sense that (old) code using it won't break yet,
  95 * but instead only triggers a WARN() stack dump.
  96 */
  97static int gpio_ensure_requested(struct gpio_desc *desc, unsigned offset)
  98{
  99	const struct gpio_chip *chip = desc->chip;
 100	const int gpio = chip->base + offset;
 101
 102	if (WARN(test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0,
 103			"autorequest GPIO-%d\n", gpio)) {
 104		if (!try_module_get(chip->owner)) {
 105			pr_err("GPIO-%d: module can't be gotten \n", gpio);
 106			clear_bit(FLAG_REQUESTED, &desc->flags);
 107			/* lose */
 108			return -EIO;
 109		}
 110		desc_set_label(desc, "[auto]");
 111		/* caller must chip->request() w/o spinlock */
 112		if (chip->request)
 113			return 1;
 114	}
 115	return 0;
 116}
 117
 118/* caller holds gpio_lock *OR* gpio is marked as requested */
 119struct gpio_chip *gpio_to_chip(unsigned gpio)
 120{
 121	return gpio_desc[gpio].chip;
 122}
 123
 124/* dynamic allocation of GPIOs, e.g. on a hotplugged device */
 125static int gpiochip_find_base(int ngpio)
 126{
 127	int i;
 128	int spare = 0;
 129	int base = -ENOSPC;
 130
 131	for (i = ARCH_NR_GPIOS - 1; i >= 0 ; i--) {
 132		struct gpio_desc *desc = &gpio_desc[i];
 133		struct gpio_chip *chip = desc->chip;
 134
 135		if (!chip && !test_bit(FLAG_RESERVED, &desc->flags)) {
 136			spare++;
 137			if (spare == ngpio) {
 138				base = i;
 139				break;
 140			}
 141		} else {
 142			spare = 0;
 143			if (chip)
 144				i -= chip->ngpio - 1;
 145		}
 146	}
 147
 148	if (gpio_is_valid(base))
 149		pr_debug("%s: found new base at %d\n", __func__, base);
 150	return base;
 151}
 152
 153/**
 154 * gpiochip_reserve() - reserve range of gpios to use with platform code only
 155 * @start: starting gpio number
 156 * @ngpio: number of gpios to reserve
 157 * Context: platform init, potentially before irqs or kmalloc will work
 158 *
 159 * Returns a negative errno if any gpio within the range is already reserved
 160 * or registered, else returns zero as a success code.  Use this function
 161 * to mark a range of gpios as unavailable for dynamic gpio number allocation,
 162 * for example because its driver support is not yet loaded.
 163 */
 164int __init gpiochip_reserve(int start, int ngpio)
 165{
 166	int ret = 0;
 167	unsigned long flags;
 168	int i;
 169
 170	if (!gpio_is_valid(start) || !gpio_is_valid(start + ngpio - 1))
 171		return -EINVAL;
 172
 173	spin_lock_irqsave(&gpio_lock, flags);
 174
 175	for (i = start; i < start + ngpio; i++) {
 176		struct gpio_desc *desc = &gpio_desc[i];
 177
 178		if (desc->chip || test_bit(FLAG_RESERVED, &desc->flags)) {
 179			ret = -EBUSY;
 180			goto err;
 181		}
 182
 183		set_bit(FLAG_RESERVED, &desc->flags);
 184	}
 185
 186	pr_debug("%s: reserved gpios from %d to %d\n",
 187		 __func__, start, start + ngpio - 1);
 188err:
 189	spin_unlock_irqrestore(&gpio_lock, flags);
 190
 191	return ret;
 
 
 
 192}
 
 193
 194#ifdef CONFIG_GPIO_SYSFS
 195
 196/* lock protects against unexport_gpio() being called while
 197 * sysfs files are active.
 198 */
 199static DEFINE_MUTEX(sysfs_lock);
 200
 201/*
 202 * /sys/class/gpio/gpioN... only for GPIOs that are exported
 203 *   /direction
 204 *      * MAY BE OMITTED if kernel won't allow direction changes
 205 *      * is read/write as "in" or "out"
 206 *      * may also be written as "high" or "low", initializing
 207 *        output value as specified ("out" implies "low")
 208 *   /value
 209 *      * always readable, subject to hardware behavior
 210 *      * may be writable, as zero/nonzero
 211 *   /edge
 212 *      * configures behavior of poll(2) on /value
 213 *      * available only if pin can generate IRQs on input
 214 *      * is read/write as "none", "falling", "rising", or "both"
 215 *   /active_low
 216 *      * configures polarity of /value
 217 *      * is read/write as zero/nonzero
 218 *      * also affects existing and subsequent "falling" and "rising"
 219 *        /edge configuration
 220 */
 221
 222static ssize_t gpio_direction_show(struct device *dev,
 223		struct device_attribute *attr, char *buf)
 224{
 225	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 226	ssize_t			status;
 227
 228	mutex_lock(&sysfs_lock);
 
 229
 230	if (!test_bit(FLAG_EXPORT, &desc->flags))
 231		status = -EIO;
 232	else
 233		status = sprintf(buf, "%s\n",
 234			test_bit(FLAG_IS_OUT, &desc->flags)
 235				? "out" : "in");
 236
 237	mutex_unlock(&sysfs_lock);
 238	return status;
 239}
 240
 241static ssize_t gpio_direction_store(struct device *dev,
 242		struct device_attribute *attr, const char *buf, size_t size)
 
 
 
 
 243{
 244	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 245	unsigned		gpio = desc - gpio_desc;
 246	ssize_t			status;
 247
 248	mutex_lock(&sysfs_lock);
 249
 250	if (!test_bit(FLAG_EXPORT, &desc->flags))
 251		status = -EIO;
 252	else if (sysfs_streq(buf, "high"))
 253		status = gpio_direction_output(gpio, 1);
 254	else if (sysfs_streq(buf, "out") || sysfs_streq(buf, "low"))
 255		status = gpio_direction_output(gpio, 0);
 256	else if (sysfs_streq(buf, "in"))
 257		status = gpio_direction_input(gpio);
 258	else
 259		status = -EINVAL;
 260
 261	mutex_unlock(&sysfs_lock);
 262	return status ? : size;
 263}
 
 264
 265static /* const */ DEVICE_ATTR(direction, 0644,
 266		gpio_direction_show, gpio_direction_store);
 267
 268static ssize_t gpio_value_show(struct device *dev,
 269		struct device_attribute *attr, char *buf)
 
 
 
 270{
 271	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 272	unsigned		gpio = desc - gpio_desc;
 273	ssize_t			status;
 
 
 274
 275	mutex_lock(&sysfs_lock);
 
 
 
 
 276
 277	if (!test_bit(FLAG_EXPORT, &desc->flags)) {
 278		status = -EIO;
 
 
 
 
 
 
 
 
 
 
 279	} else {
 280		int value;
 
 
 
 281
 282		value = !!gpio_get_value_cansleep(gpio);
 283		if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
 284			value = !value;
 
 
 
 
 
 
 
 
 
 
 285
 286		status = sprintf(buf, "%d\n", value);
 287	}
 288
 289	mutex_unlock(&sysfs_lock);
 290	return status;
 291}
 292
 293static ssize_t gpio_value_store(struct device *dev,
 294		struct device_attribute *attr, const char *buf, size_t size)
 295{
 296	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 297	unsigned		gpio = desc - gpio_desc;
 298	ssize_t			status;
 299
 300	mutex_lock(&sysfs_lock);
 301
 302	if (!test_bit(FLAG_EXPORT, &desc->flags))
 303		status = -EIO;
 304	else if (!test_bit(FLAG_IS_OUT, &desc->flags))
 305		status = -EPERM;
 306	else {
 307		long		value;
 308
 309		status = strict_strtol(buf, 0, &value);
 310		if (status == 0) {
 311			if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
 312				value = !value;
 313			gpio_set_value_cansleep(gpio, value != 0);
 314			status = size;
 315		}
 316	}
 317
 318	mutex_unlock(&sysfs_lock);
 319	return status;
 320}
 
 321
 322static const DEVICE_ATTR(value, 0644,
 323		gpio_value_show, gpio_value_store);
 324
 325static irqreturn_t gpio_sysfs_irq(int irq, void *priv)
 
 
 
 
 326{
 327	struct sysfs_dirent	*value_sd = priv;
 328
 329	sysfs_notify_dirent(value_sd);
 330	return IRQ_HANDLED;
 331}
 
 
 332
 333static int gpio_setup_irq(struct gpio_desc *desc, struct device *dev,
 334		unsigned long gpio_flags)
 335{
 336	struct sysfs_dirent	*value_sd;
 337	unsigned long		irq_flags;
 338	int			ret, irq, id;
 339
 340	if ((desc->flags & GPIO_TRIGGER_MASK) == gpio_flags)
 
 
 
 341		return 0;
 
 342
 343	irq = gpio_to_irq(desc - gpio_desc);
 344	if (irq < 0)
 345		return -EIO;
 346
 347	id = desc->flags >> ID_SHIFT;
 348	value_sd = idr_find(&dirent_idr, id);
 349	if (value_sd)
 350		free_irq(irq, value_sd);
 351
 352	desc->flags &= ~GPIO_TRIGGER_MASK;
 353
 354	if (!gpio_flags) {
 355		ret = 0;
 356		goto free_id;
 357	}
 358
 359	irq_flags = IRQF_SHARED;
 360	if (test_bit(FLAG_TRIG_FALL, &gpio_flags))
 361		irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
 362			IRQF_TRIGGER_RISING : IRQF_TRIGGER_FALLING;
 363	if (test_bit(FLAG_TRIG_RISE, &gpio_flags))
 364		irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
 365			IRQF_TRIGGER_FALLING : IRQF_TRIGGER_RISING;
 366
 367	if (!value_sd) {
 368		value_sd = sysfs_get_dirent(dev->kobj.sd, NULL, "value");
 369		if (!value_sd) {
 370			ret = -ENODEV;
 371			goto err_out;
 372		}
 373
 374		do {
 375			ret = -ENOMEM;
 376			if (idr_pre_get(&dirent_idr, GFP_KERNEL))
 377				ret = idr_get_new_above(&dirent_idr, value_sd,
 378							1, &id);
 379		} while (ret == -EAGAIN);
 380
 381		if (ret)
 382			goto free_sd;
 383
 384		desc->flags &= GPIO_FLAGS_MASK;
 385		desc->flags |= (unsigned long)id << ID_SHIFT;
 386
 387		if (desc->flags >> ID_SHIFT != id) {
 388			ret = -ERANGE;
 389			goto free_id;
 390		}
 391	}
 392
 393	ret = request_any_context_irq(irq, gpio_sysfs_irq, irq_flags,
 394				"gpiolib", value_sd);
 395	if (ret < 0)
 396		goto free_id;
 397
 398	desc->flags |= gpio_flags;
 399	return 0;
 400
 401free_id:
 402	idr_remove(&dirent_idr, id);
 403	desc->flags &= GPIO_FLAGS_MASK;
 404free_sd:
 405	if (value_sd)
 406		sysfs_put(value_sd);
 407err_out:
 408	return ret;
 409}
 410
 411static const struct {
 412	const char *name;
 
 
 
 
 413	unsigned long flags;
 414} trigger_types[] = {
 415	{ "none",    0 },
 416	{ "falling", BIT(FLAG_TRIG_FALL) },
 417	{ "rising",  BIT(FLAG_TRIG_RISE) },
 418	{ "both",    BIT(FLAG_TRIG_FALL) | BIT(FLAG_TRIG_RISE) },
 419};
 420
 421static ssize_t gpio_edge_show(struct device *dev,
 422		struct device_attribute *attr, char *buf)
 423{
 424	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 425	ssize_t			status;
 426
 427	mutex_lock(&sysfs_lock);
 
 428
 429	if (!test_bit(FLAG_EXPORT, &desc->flags))
 430		status = -EIO;
 431	else {
 432		int i;
 433
 434		status = 0;
 435		for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
 436			if ((desc->flags & GPIO_TRIGGER_MASK)
 437					== trigger_types[i].flags) {
 438				status = sprintf(buf, "%s\n",
 439						 trigger_types[i].name);
 440				break;
 441			}
 
 442	}
 443
 444	mutex_unlock(&sysfs_lock);
 445	return status;
 
 446}
 447
 448static ssize_t gpio_edge_store(struct device *dev,
 449		struct device_attribute *attr, const char *buf, size_t size)
 
 
 
 
 
 450{
 451	struct gpio_desc	*desc = dev_get_drvdata(dev);
 452	ssize_t			status;
 453	int			i;
 454
 455	for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
 456		if (sysfs_streq(trigger_types[i].name, buf))
 457			goto found;
 458	return -EINVAL;
 459
 460found:
 461	mutex_lock(&sysfs_lock);
 462
 463	if (!test_bit(FLAG_EXPORT, &desc->flags))
 464		status = -EIO;
 465	else {
 466		status = gpio_setup_irq(desc, dev, trigger_types[i].flags);
 467		if (!status)
 468			status = size;
 
 
 
 469	}
 470
 471	mutex_unlock(&sysfs_lock);
 
 
 472
 473	return status;
 474}
 475
 476static DEVICE_ATTR(edge, 0644, gpio_edge_show, gpio_edge_store);
 477
 478static int sysfs_set_active_low(struct gpio_desc *desc, struct device *dev,
 479				int value)
 480{
 481	int			status = 0;
 482
 483	if (!!test_bit(FLAG_ACTIVE_LOW, &desc->flags) == !!value)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 484		return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 485
 486	if (value)
 487		set_bit(FLAG_ACTIVE_LOW, &desc->flags);
 488	else
 489		clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 490
 491	/* reconfigure poll(2) support if enabled on one edge only */
 492	if (dev != NULL && (!!test_bit(FLAG_TRIG_RISE, &desc->flags) ^
 493				!!test_bit(FLAG_TRIG_FALL, &desc->flags))) {
 494		unsigned long trigger_flags = desc->flags & GPIO_TRIGGER_MASK;
 495
 496		gpio_setup_irq(desc, dev, 0);
 497		status = gpio_setup_irq(desc, dev, trigger_flags);
 498	}
 
 
 499
 500	return status;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 501}
 502
 503static ssize_t gpio_active_low_show(struct device *dev,
 504		struct device_attribute *attr, char *buf)
 505{
 506	const struct gpio_desc	*desc = dev_get_drvdata(dev);
 507	ssize_t			status;
 
 
 
 
 
 
 
 
 
 
 
 508
 509	mutex_lock(&sysfs_lock);
 510
 511	if (!test_bit(FLAG_EXPORT, &desc->flags))
 512		status = -EIO;
 513	else
 514		status = sprintf(buf, "%d\n",
 515				!!test_bit(FLAG_ACTIVE_LOW, &desc->flags));
 
 
 
 516
 517	mutex_unlock(&sysfs_lock);
 
 
 518
 519	return status;
 
 
 
 
 
 520}
 521
 522static ssize_t gpio_active_low_store(struct device *dev,
 523		struct device_attribute *attr, const char *buf, size_t size)
 524{
 525	struct gpio_desc	*desc = dev_get_drvdata(dev);
 526	ssize_t			status;
 527
 528	mutex_lock(&sysfs_lock);
 
 
 
 
 
 
 
 
 
 
 
 
 
 529
 530	if (!test_bit(FLAG_EXPORT, &desc->flags)) {
 531		status = -EIO;
 532	} else {
 533		long		value;
 534
 535		status = strict_strtol(buf, 0, &value);
 536		if (status == 0)
 537			status = sysfs_set_active_low(desc, dev, value != 0);
 538	}
 
 
 539
 540	mutex_unlock(&sysfs_lock);
 541
 542	return status ? : size;
 
 
 
 
 543}
 544
 545static const DEVICE_ATTR(active_low, 0644,
 546		gpio_active_low_show, gpio_active_low_store);
 547
 548static const struct attribute *gpio_attrs[] = {
 549	&dev_attr_value.attr,
 550	&dev_attr_active_low.attr,
 551	NULL,
 552};
 553
 554static const struct attribute_group gpio_attr_group = {
 555	.attrs = (struct attribute **) gpio_attrs,
 556};
 557
 558/*
 559 * /sys/class/gpio/gpiochipN/
 560 *   /base ... matching gpio_chip.base (N)
 561 *   /label ... matching gpio_chip.label
 562 *   /ngpio ... matching gpio_chip.ngpio
 563 */
 564
 565static ssize_t chip_base_show(struct device *dev,
 566			       struct device_attribute *attr, char *buf)
 567{
 568	const struct gpio_chip	*chip = dev_get_drvdata(dev);
 
 569
 570	return sprintf(buf, "%d\n", chip->base);
 
 
 
 
 
 571}
 572static DEVICE_ATTR(base, 0444, chip_base_show, NULL);
 573
 574static ssize_t chip_label_show(struct device *dev,
 575			       struct device_attribute *attr, char *buf)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 576{
 577	const struct gpio_chip	*chip = dev_get_drvdata(dev);
 
 
 
 
 578
 579	return sprintf(buf, "%s\n", chip->label ? : "");
 580}
 581static DEVICE_ATTR(label, 0444, chip_label_show, NULL);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 582
 583static ssize_t chip_ngpio_show(struct device *dev,
 584			       struct device_attribute *attr, char *buf)
 585{
 586	const struct gpio_chip	*chip = dev_get_drvdata(dev);
 
 587
 588	return sprintf(buf, "%u\n", chip->ngpio);
 589}
 590static DEVICE_ATTR(ngpio, 0444, chip_ngpio_show, NULL);
 
 
 591
 592static const struct attribute *gpiochip_attrs[] = {
 593	&dev_attr_base.attr,
 594	&dev_attr_label.attr,
 595	&dev_attr_ngpio.attr,
 596	NULL,
 597};
 
 
 598
 599static const struct attribute_group gpiochip_attr_group = {
 600	.attrs = (struct attribute **) gpiochip_attrs,
 601};
 602
 603/*
 604 * /sys/class/gpio/export ... write-only
 605 *	integer N ... number of GPIO to export (full access)
 606 * /sys/class/gpio/unexport ... write-only
 607 *	integer N ... number of GPIO to unexport
 608 */
 609static ssize_t export_store(struct class *class,
 610				struct class_attribute *attr,
 611				const char *buf, size_t len)
 612{
 613	long	gpio;
 614	int	status;
 615
 616	status = strict_strtol(buf, 0, &gpio);
 617	if (status < 0)
 618		goto done;
 619
 620	/* No extra locking here; FLAG_SYSFS just signifies that the
 621	 * request and export were done by on behalf of userspace, so
 622	 * they may be undone on its behalf too.
 623	 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 624
 625	status = gpio_request(gpio, "sysfs");
 626	if (status < 0)
 627		goto done;
 
 
 628
 629	status = gpio_export(gpio, true);
 630	if (status < 0)
 631		gpio_free(gpio);
 632	else
 633		set_bit(FLAG_SYSFS, &gpio_desc[gpio].flags);
 634
 635done:
 636	if (status)
 637		pr_debug("%s: status %d\n", __func__, status);
 638	return status ? : len;
 639}
 640
 641static ssize_t unexport_store(struct class *class,
 642				struct class_attribute *attr,
 643				const char *buf, size_t len)
 644{
 645	long	gpio;
 646	int	status;
 
 
 647
 648	status = strict_strtol(buf, 0, &gpio);
 649	if (status < 0)
 650		goto done;
 651
 652	status = -EINVAL;
 
 
 653
 654	/* reject bogus commands (gpio_unexport ignores them) */
 655	if (!gpio_is_valid(gpio))
 656		goto done;
 657
 658	/* No extra locking here; FLAG_SYSFS just signifies that the
 659	 * request and export were done by on behalf of userspace, so
 660	 * they may be undone on its behalf too.
 661	 */
 662	if (test_and_clear_bit(FLAG_SYSFS, &gpio_desc[gpio].flags)) {
 663		status = 0;
 664		gpio_free(gpio);
 665	}
 666done:
 667	if (status)
 668		pr_debug("%s: status %d\n", __func__, status);
 669	return status ? : len;
 670}
 671
 672static struct class_attribute gpio_class_attrs[] = {
 673	__ATTR(export, 0200, NULL, export_store),
 674	__ATTR(unexport, 0200, NULL, unexport_store),
 675	__ATTR_NULL,
 676};
 677
 678static struct class gpio_class = {
 679	.name =		"gpio",
 680	.owner =	THIS_MODULE,
 
 
 
 
 
 
 
 
 
 
 
 681
 682	.class_attrs =	gpio_class_attrs,
 683};
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 684
 
 
 
 
 
 
 
 
 685
 686/**
 687 * gpio_export - export a GPIO through sysfs
 688 * @gpio: gpio to make available, already requested
 689 * @direction_may_change: true if userspace may change gpio direction
 690 * Context: arch_initcall or later
 691 *
 692 * When drivers want to make a GPIO accessible to userspace after they
 693 * have requested it -- perhaps while debugging, or as part of their
 694 * public interface -- they may use this routine.  If the GPIO can
 695 * change direction (some can't) and the caller allows it, userspace
 696 * will see "direction" sysfs attribute which may be used to change
 697 * the gpio's direction.  A "value" attribute will always be provided.
 698 *
 699 * Returns zero on success, else an error.
 700 */
 701int gpio_export(unsigned gpio, bool direction_may_change)
 702{
 703	unsigned long		flags;
 704	struct gpio_desc	*desc;
 705	int			status = -EINVAL;
 706	const char		*ioname = NULL;
 
 707
 708	/* can't export until sysfs is available ... */
 709	if (!gpio_class.p) {
 710		pr_debug("%s: called too early!\n", __func__);
 711		return -ENOENT;
 712	}
 713
 714	if (!gpio_is_valid(gpio))
 715		goto done;
 716
 717	mutex_lock(&sysfs_lock);
 
 
 
 
 718
 719	spin_lock_irqsave(&gpio_lock, flags);
 720	desc = &gpio_desc[gpio];
 721	if (test_bit(FLAG_REQUESTED, &desc->flags)
 722			&& !test_bit(FLAG_EXPORT, &desc->flags)) {
 723		status = 0;
 724		if (!desc->chip->direction_input
 725				|| !desc->chip->direction_output)
 726			direction_may_change = false;
 727	}
 728	spin_unlock_irqrestore(&gpio_lock, flags);
 729
 730	if (desc->chip->names && desc->chip->names[gpio - desc->chip->base])
 731		ioname = desc->chip->names[gpio - desc->chip->base];
 
 
 
 
 
 
 
 
 
 
 
 732
 733	if (status == 0) {
 734		struct device	*dev;
 
 735
 736		dev = device_create(&gpio_class, desc->chip->dev, MKDEV(0, 0),
 737				desc, ioname ? ioname : "gpio%u", gpio);
 738		if (!IS_ERR(dev)) {
 739			status = sysfs_create_group(&dev->kobj,
 740						&gpio_attr_group);
 741
 742			if (!status && direction_may_change)
 743				status = device_create_file(dev,
 744						&dev_attr_direction);
 745
 746			if (!status && gpio_to_irq(gpio) >= 0
 747					&& (direction_may_change
 748						|| !test_bit(FLAG_IS_OUT,
 749							&desc->flags)))
 750				status = device_create_file(dev,
 751						&dev_attr_edge);
 752
 753			if (status != 0)
 754				device_unregister(dev);
 755		} else
 756			status = PTR_ERR(dev);
 757		if (status == 0)
 758			set_bit(FLAG_EXPORT, &desc->flags);
 759	}
 760
 761	mutex_unlock(&sysfs_lock);
 762
 763done:
 764	if (status)
 765		pr_debug("%s: gpio%d status %d\n", __func__, gpio, status);
 766
 767	return status;
 768}
 769EXPORT_SYMBOL_GPL(gpio_export);
 
 770
 771static int match_export(struct device *dev, void *data)
 772{
 773	return dev_get_drvdata(dev) == data;
 774}
 775
 776/**
 777 * gpio_export_link - create a sysfs link to an exported GPIO node
 778 * @dev: device under which to create symlink
 779 * @name: name of the symlink
 780 * @gpio: gpio to create symlink to, already exported
 781 *
 782 * Set up a symlink from /sys/.../dev/name to /sys/class/gpio/gpioN
 783 * node. Caller is responsible for unlinking.
 
 784 *
 785 * Returns zero on success, else an error.
 786 */
 787int gpio_export_link(struct device *dev, const char *name, unsigned gpio)
 
 788{
 789	struct gpio_desc	*desc;
 790	int			status = -EINVAL;
 791
 792	if (!gpio_is_valid(gpio))
 793		goto done;
 794
 795	mutex_lock(&sysfs_lock);
 
 
 
 796
 797	desc = &gpio_desc[gpio];
 798
 799	if (test_bit(FLAG_EXPORT, &desc->flags)) {
 800		struct device *tdev;
 801
 802		tdev = class_find_device(&gpio_class, NULL, desc, match_export);
 803		if (tdev != NULL) {
 804			status = sysfs_create_link(&dev->kobj, &tdev->kobj,
 805						name);
 806		} else {
 807			status = -ENODEV;
 808		}
 809	}
 810
 811	mutex_unlock(&sysfs_lock);
 
 812
 813done:
 814	if (status)
 815		pr_debug("%s: gpio%d status %d\n", __func__, gpio, status);
 816
 817	return status;
 818}
 819EXPORT_SYMBOL_GPL(gpio_export_link);
 820
 821
 822/**
 823 * gpio_sysfs_set_active_low - set the polarity of gpio sysfs value
 824 * @gpio: gpio to change
 825 * @value: non-zero to use active low, i.e. inverted values
 826 *
 827 * Set the polarity of /sys/class/gpio/gpioN/value sysfs attribute.
 828 * The GPIO does not have to be exported yet.  If poll(2) support has
 829 * been enabled for either rising or falling edge, it will be
 830 * reconfigured to follow the new polarity.
 831 *
 832 * Returns zero on success, else an error.
 833 */
 834int gpio_sysfs_set_active_low(unsigned gpio, int value)
 835{
 836	struct gpio_desc	*desc;
 837	struct device		*dev = NULL;
 838	int			status = -EINVAL;
 839
 840	if (!gpio_is_valid(gpio))
 841		goto done;
 842
 843	mutex_lock(&sysfs_lock);
 844
 845	desc = &gpio_desc[gpio];
 846
 847	if (test_bit(FLAG_EXPORT, &desc->flags)) {
 848		dev = class_find_device(&gpio_class, NULL, desc, match_export);
 849		if (dev == NULL) {
 850			status = -ENODEV;
 851			goto unlock;
 852		}
 853	}
 854
 855	status = sysfs_set_active_low(desc, dev, value);
 856
 857unlock:
 858	mutex_unlock(&sysfs_lock);
 859
 860done:
 861	if (status)
 862		pr_debug("%s: gpio%d status %d\n", __func__, gpio, status);
 863
 864	return status;
 
 
 
 865}
 866EXPORT_SYMBOL_GPL(gpio_sysfs_set_active_low);
 867
 868/**
 869 * gpio_unexport - reverse effect of gpio_export()
 870 * @gpio: gpio to make unavailable
 
 871 *
 872 * This is implicit on gpio_free().
 
 
 
 
 873 */
 874void gpio_unexport(unsigned gpio)
 
 
 875{
 876	struct gpio_desc	*desc;
 877	int			status = 0;
 878	struct device		*dev = NULL;
 879
 880	if (!gpio_is_valid(gpio)) {
 881		status = -EINVAL;
 882		goto done;
 883	}
 884
 885	mutex_lock(&sysfs_lock);
 
 
 
 
 886
 887	desc = &gpio_desc[gpio];
 888
 889	if (test_bit(FLAG_EXPORT, &desc->flags)) {
 
 
 890
 891		dev = class_find_device(&gpio_class, NULL, desc, match_export);
 892		if (dev) {
 893			gpio_setup_irq(desc, dev, 0);
 894			clear_bit(FLAG_EXPORT, &desc->flags);
 895		} else
 896			status = -ENODEV;
 897	}
 898
 899	mutex_unlock(&sysfs_lock);
 900	if (dev) {
 901		device_unregister(dev);
 902		put_device(dev);
 903	}
 904done:
 905	if (status)
 906		pr_debug("%s: gpio%d status %d\n", __func__, gpio, status);
 907}
 908EXPORT_SYMBOL_GPL(gpio_unexport);
 909
 910static int gpiochip_export(struct gpio_chip *chip)
 911{
 912	int		status;
 913	struct device	*dev;
 914
 915	/* Many systems register gpio chips for SOC support very early,
 916	 * before driver model support is available.  In those cases we
 917	 * export this later, in gpiolib_sysfs_init() ... here we just
 918	 * verify that _some_ field of gpio_class got initialized.
 919	 */
 920	if (!gpio_class.p)
 921		return 0;
 922
 923	/* use chip->base for the ID; it's already known to be unique */
 924	mutex_lock(&sysfs_lock);
 925	dev = device_create(&gpio_class, chip->dev, MKDEV(0, 0), chip,
 926				"gpiochip%d", chip->base);
 927	if (!IS_ERR(dev)) {
 928		status = sysfs_create_group(&dev->kobj,
 929				&gpiochip_attr_group);
 930	} else
 931		status = PTR_ERR(dev);
 932	chip->exported = (status == 0);
 933	mutex_unlock(&sysfs_lock);
 934
 935	if (status) {
 936		unsigned long	flags;
 937		unsigned	gpio;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 938
 939		spin_lock_irqsave(&gpio_lock, flags);
 940		gpio = chip->base;
 941		while (gpio_desc[gpio].chip == chip)
 942			gpio_desc[gpio++].chip = NULL;
 943		spin_unlock_irqrestore(&gpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 944
 945		pr_debug("%s: chip %s status %d\n", __func__,
 946				chip->label, status);
 947	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 948
 949	return status;
 950}
 951
 952static void gpiochip_unexport(struct gpio_chip *chip)
 953{
 954	int			status;
 955	struct device		*dev;
 956
 957	mutex_lock(&sysfs_lock);
 958	dev = class_find_device(&gpio_class, NULL, chip, match_export);
 959	if (dev) {
 960		put_device(dev);
 961		device_unregister(dev);
 962		chip->exported = 0;
 963		status = 0;
 964	} else
 965		status = -ENODEV;
 966	mutex_unlock(&sysfs_lock);
 967
 968	if (status)
 969		pr_debug("%s: chip %s status %d\n", __func__,
 970				chip->label, status);
 971}
 
 
 972
 973static int __init gpiolib_sysfs_init(void)
 974{
 975	int		status;
 976	unsigned long	flags;
 977	unsigned	gpio;
 978
 979	status = class_register(&gpio_class);
 980	if (status < 0)
 981		return status;
 982
 983	/* Scan and register the gpio_chips which registered very
 984	 * early (e.g. before the class_register above was called).
 985	 *
 986	 * We run before arch_initcall() so chip->dev nodes can have
 987	 * registered, and so arch_initcall() can always gpio_export().
 988	 */
 989	spin_lock_irqsave(&gpio_lock, flags);
 990	for (gpio = 0; gpio < ARCH_NR_GPIOS; gpio++) {
 991		struct gpio_chip	*chip;
 992
 993		chip = gpio_desc[gpio].chip;
 994		if (!chip || chip->exported)
 995			continue;
 996
 997		spin_unlock_irqrestore(&gpio_lock, flags);
 998		status = gpiochip_export(chip);
 999		spin_lock_irqsave(&gpio_lock, flags);
1000	}
1001	spin_unlock_irqrestore(&gpio_lock, flags);
1002
1003
1004	return status;
1005}
1006postcore_initcall(gpiolib_sysfs_init);
1007
1008#else
1009static inline int gpiochip_export(struct gpio_chip *chip)
1010{
1011	return 0;
 
 
 
1012}
1013
1014static inline void gpiochip_unexport(struct gpio_chip *chip)
1015{
 
1016}
1017
1018#endif /* CONFIG_GPIO_SYSFS */
1019
1020/**
1021 * gpiochip_add() - register a gpio_chip
1022 * @chip: the chip to register, with chip->base initialized
1023 * Context: potentially before irqs or kmalloc will work
1024 *
1025 * Returns a negative errno if the chip can't be registered, such as
1026 * because the chip->base is invalid or already associated with a
1027 * different chip.  Otherwise it returns zero as a success code.
1028 *
1029 * When gpiochip_add() is called very early during boot, so that GPIOs
1030 * can be freely used, the chip->dev device must be registered before
1031 * the gpio framework's arch_initcall().  Otherwise sysfs initialization
1032 * for GPIOs will fail rudely.
1033 *
1034 * If chip->base is negative, this requests dynamic assignment of
1035 * a range of valid GPIOs.
1036 */
1037int gpiochip_add(struct gpio_chip *chip)
1038{
1039	unsigned long	flags;
1040	int		status = 0;
1041	unsigned	id;
1042	int		base = chip->base;
 
 
 
 
1043
1044	if ((!gpio_is_valid(base) || !gpio_is_valid(base + chip->ngpio - 1))
1045			&& base >= 0) {
1046		status = -EINVAL;
1047		goto fail;
 
 
1048	}
1049
1050	spin_lock_irqsave(&gpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1051
1052	if (base < 0) {
1053		base = gpiochip_find_base(chip->ngpio);
1054		if (base < 0) {
1055			status = base;
1056			goto unlock;
1057		}
1058		chip->base = base;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1059	}
1060
1061	/* these GPIO numbers must not be managed by another gpio_chip */
1062	for (id = base; id < base + chip->ngpio; id++) {
1063		if (gpio_desc[id].chip != NULL) {
1064			status = -EBUSY;
1065			break;
1066		}
 
 
1067	}
1068	if (status == 0) {
1069		for (id = base; id < base + chip->ngpio; id++) {
1070			gpio_desc[id].chip = chip;
1071
1072			/* REVISIT:  most hardware initializes GPIOs as
1073			 * inputs (often with pullups enabled) so power
1074			 * usage is minimized.  Linux code should set the
1075			 * gpio direction first thing; but until it does,
1076			 * we may expose the wrong direction in sysfs.
 
 
 
 
 
 
1077			 */
1078			gpio_desc[id].flags = !chip->direction_input
1079				? (1 << FLAG_IS_OUT)
1080				: 0;
1081		}
1082	}
1083
1084	of_gpiochip_add(chip);
1085
1086unlock:
1087	spin_unlock_irqrestore(&gpio_lock, flags);
 
1088
1089	if (status)
1090		goto fail;
1091
1092	status = gpiochip_export(chip);
1093	if (status)
1094		goto fail;
1095
1096	pr_debug("gpiochip_add: registered GPIOs %d to %d on device: %s\n",
1097		chip->base, chip->base + chip->ngpio - 1,
1098		chip->label ? : "generic");
1099
1100	return 0;
1101fail:
1102	/* failures here can mean systems won't boot... */
1103	pr_err("gpiochip_add: gpios %d..%d (%s) failed to register\n",
1104		chip->base, chip->base + chip->ngpio - 1,
1105		chip->label ? : "generic");
1106	return status;
 
1107}
1108EXPORT_SYMBOL_GPL(gpiochip_add);
1109
1110/**
1111 * gpiochip_remove() - unregister a gpio_chip
1112 * @chip: the chip to unregister
1113 *
1114 * A gpio_chip with any GPIOs still requested may not be removed.
1115 */
1116int gpiochip_remove(struct gpio_chip *chip)
1117{
1118	unsigned long	flags;
1119	int		status = 0;
1120	unsigned	id;
 
 
1121
1122	spin_lock_irqsave(&gpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1123
1124	of_gpiochip_remove(chip);
1125
1126	for (id = chip->base; id < chip->base + chip->ngpio; id++) {
1127		if (test_bit(FLAG_REQUESTED, &gpio_desc[id].flags)) {
1128			status = -EBUSY;
1129			break;
1130		}
1131	}
1132	if (status == 0) {
1133		for (id = chip->base; id < chip->base + chip->ngpio; id++)
1134			gpio_desc[id].chip = NULL;
1135	}
1136
1137	spin_unlock_irqrestore(&gpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1138
1139	if (status == 0)
1140		gpiochip_unexport(chip);
1141
1142	return status;
1143}
1144EXPORT_SYMBOL_GPL(gpiochip_remove);
1145
1146/**
1147 * gpiochip_find() - iterator for locating a specific gpio_chip
1148 * @data: data to pass to match function
1149 * @callback: Callback function to check gpio_chip
1150 *
1151 * Similar to bus_find_device.  It returns a reference to a gpio_chip as
1152 * determined by a user supplied @match callback.  The callback should return
1153 * 0 if the device doesn't match and non-zero if it does.  If the callback is
1154 * non-zero, this function will return to the caller and not iterate over any
1155 * more gpio_chips.
1156 */
1157struct gpio_chip *gpiochip_find(void *data,
1158				int (*match)(struct gpio_chip *chip,
1159					     void *data))
1160{
1161	struct gpio_chip *chip = NULL;
1162	unsigned long flags;
1163	int i;
1164
1165	spin_lock_irqsave(&gpio_lock, flags);
1166	for (i = 0; i < ARCH_NR_GPIOS; i++) {
1167		if (!gpio_desc[i].chip)
1168			continue;
1169
1170		if (match(gpio_desc[i].chip, data)) {
1171			chip = gpio_desc[i].chip;
1172			break;
1173		}
 
1174	}
1175	spin_unlock_irqrestore(&gpio_lock, flags);
 
1176
1177	return chip;
1178}
1179EXPORT_SYMBOL_GPL(gpiochip_find);
1180
1181/* These "optional" allocation calls help prevent drivers from stomping
1182 * on each other, and help provide better diagnostics in debugfs.
1183 * They're called even less than the "set direction" calls.
1184 */
1185int gpio_request(unsigned gpio, const char *label)
1186{
1187	struct gpio_desc	*desc;
1188	struct gpio_chip	*chip;
1189	int			status = -EINVAL;
1190	unsigned long		flags;
1191
1192	spin_lock_irqsave(&gpio_lock, flags);
1193
1194	if (!gpio_is_valid(gpio))
1195		goto done;
1196	desc = &gpio_desc[gpio];
1197	chip = desc->chip;
1198	if (chip == NULL)
1199		goto done;
1200
1201	if (!try_module_get(chip->owner))
1202		goto done;
1203
1204	/* NOTE:  gpio_request() can be called in early boot,
1205	 * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
1206	 */
1207
1208	if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
1209		desc_set_label(desc, label ? : "?");
1210		status = 0;
1211	} else {
1212		status = -EBUSY;
1213		module_put(chip->owner);
1214		goto done;
1215	}
1216
1217	if (chip->request) {
1218		/* chip->request may sleep */
1219		spin_unlock_irqrestore(&gpio_lock, flags);
1220		status = chip->request(chip, gpio - chip->base);
1221		spin_lock_irqsave(&gpio_lock, flags);
1222
1223		if (status < 0) {
1224			desc_set_label(desc, NULL);
1225			module_put(chip->owner);
1226			clear_bit(FLAG_REQUESTED, &desc->flags);
 
1227		}
1228	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1229
1230done:
1231	if (status)
1232		pr_debug("gpio_request: gpio-%d (%s) status %d\n",
1233			gpio, label ? : "?", status);
1234	spin_unlock_irqrestore(&gpio_lock, flags);
1235	return status;
1236}
1237EXPORT_SYMBOL_GPL(gpio_request);
1238
1239void gpio_free(unsigned gpio)
1240{
 
1241	unsigned long		flags;
1242	struct gpio_desc	*desc;
1243	struct gpio_chip	*chip;
1244
1245	might_sleep();
1246
1247	if (!gpio_is_valid(gpio)) {
1248		WARN_ON(extra_checks);
1249		return;
1250	}
1251
1252	gpio_unexport(gpio);
1253
1254	spin_lock_irqsave(&gpio_lock, flags);
1255
1256	desc = &gpio_desc[gpio];
1257	chip = desc->chip;
1258	if (chip && test_bit(FLAG_REQUESTED, &desc->flags)) {
1259		if (chip->free) {
1260			spin_unlock_irqrestore(&gpio_lock, flags);
1261			might_sleep_if(chip->can_sleep);
1262			chip->free(chip, gpio - chip->base);
1263			spin_lock_irqsave(&gpio_lock, flags);
1264		}
1265		desc_set_label(desc, NULL);
1266		module_put(desc->chip->owner);
1267		clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
1268		clear_bit(FLAG_REQUESTED, &desc->flags);
1269		clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
1270		clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
1271	} else
1272		WARN_ON(extra_checks);
 
1273
1274	spin_unlock_irqrestore(&gpio_lock, flags);
 
1275}
1276EXPORT_SYMBOL_GPL(gpio_free);
1277
1278/**
1279 * gpio_request_one - request a single GPIO with initial configuration
1280 * @gpio:	the GPIO number
1281 * @flags:	GPIO configuration as specified by GPIOF_*
1282 * @label:	a literal description string of this GPIO
1283 */
1284int gpio_request_one(unsigned gpio, unsigned long flags, const char *label)
1285{
1286	int err;
1287
1288	err = gpio_request(gpio, label);
1289	if (err)
1290		return err;
1291
1292	if (flags & GPIOF_OPEN_DRAIN)
1293		set_bit(FLAG_OPEN_DRAIN, &gpio_desc[gpio].flags);
1294
1295	if (flags & GPIOF_OPEN_SOURCE)
1296		set_bit(FLAG_OPEN_SOURCE, &gpio_desc[gpio].flags);
1297
1298	if (flags & GPIOF_DIR_IN)
1299		err = gpio_direction_input(gpio);
1300	else
1301		err = gpio_direction_output(gpio,
1302				(flags & GPIOF_INIT_HIGH) ? 1 : 0);
1303
1304	if (err)
1305		goto free_gpio;
1306
1307	if (flags & GPIOF_EXPORT) {
1308		err = gpio_export(gpio, flags & GPIOF_EXPORT_CHANGEABLE);
1309		if (err)
1310			goto free_gpio;
1311	}
1312
1313	return 0;
1314
1315 free_gpio:
1316	gpio_free(gpio);
1317	return err;
1318}
1319EXPORT_SYMBOL_GPL(gpio_request_one);
1320
1321/**
1322 * gpio_request_array - request multiple GPIOs in a single call
1323 * @array:	array of the 'struct gpio'
1324 * @num:	how many GPIOs in the array
1325 */
1326int gpio_request_array(const struct gpio *array, size_t num)
1327{
1328	int i, err;
1329
1330	for (i = 0; i < num; i++, array++) {
1331		err = gpio_request_one(array->gpio, array->flags, array->label);
1332		if (err)
1333			goto err_free;
1334	}
1335	return 0;
1336
1337err_free:
1338	while (i--)
1339		gpio_free((--array)->gpio);
1340	return err;
1341}
1342EXPORT_SYMBOL_GPL(gpio_request_array);
1343
1344/**
1345 * gpio_free_array - release multiple GPIOs in a single call
1346 * @array:	array of the 'struct gpio'
1347 * @num:	how many GPIOs in the array
1348 */
1349void gpio_free_array(const struct gpio *array, size_t num)
1350{
1351	while (num--)
1352		gpio_free((array++)->gpio);
1353}
1354EXPORT_SYMBOL_GPL(gpio_free_array);
1355
1356/**
1357 * gpiochip_is_requested - return string iff signal was requested
1358 * @chip: controller managing the signal
1359 * @offset: of signal within controller's 0..(ngpio - 1) range
1360 *
1361 * Returns NULL if the GPIO is not currently requested, else a string.
1362 * If debugfs support is enabled, the string returned is the label passed
1363 * to gpio_request(); otherwise it is a meaningless constant.
1364 *
1365 * This function is for use by GPIO controller drivers.  The label can
1366 * help with diagnostics, and knowing that the signal is used as a GPIO
1367 * can help avoid accidentally multiplexing it to another controller.
1368 */
1369const char *gpiochip_is_requested(struct gpio_chip *chip, unsigned offset)
1370{
1371	unsigned gpio = chip->base + offset;
1372
1373	if (!gpio_is_valid(gpio) || gpio_desc[gpio].chip != chip)
1374		return NULL;
1375	if (test_bit(FLAG_REQUESTED, &gpio_desc[gpio].flags) == 0)
 
 
 
1376		return NULL;
1377#ifdef CONFIG_DEBUG_FS
1378	return gpio_desc[gpio].label;
1379#else
1380	return "?";
1381#endif
1382}
1383EXPORT_SYMBOL_GPL(gpiochip_is_requested);
1384
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1385
1386/* Drivers MUST set GPIO direction before making get/set calls.  In
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1387 * some cases this is done in early boot, before IRQs are enabled.
1388 *
1389 * As a rule these aren't called more than once (except for drivers
1390 * using the open-drain emulation idiom) so these are natural places
1391 * to accumulate extra debugging checks.  Note that we can't (yet)
1392 * rely on gpio_request() having been called beforehand.
1393 */
1394
1395int gpio_direction_input(unsigned gpio)
 
 
 
 
 
 
 
 
 
1396{
1397	unsigned long		flags;
1398	struct gpio_chip	*chip;
1399	struct gpio_desc	*desc = &gpio_desc[gpio];
1400	int			status = -EINVAL;
1401
1402	spin_lock_irqsave(&gpio_lock, flags);
 
1403
1404	if (!gpio_is_valid(gpio))
1405		goto fail;
1406	chip = desc->chip;
1407	if (!chip || !chip->get || !chip->direction_input)
1408		goto fail;
1409	gpio -= chip->base;
1410	if (gpio >= chip->ngpio)
1411		goto fail;
1412	status = gpio_ensure_requested(desc, gpio);
1413	if (status < 0)
1414		goto fail;
1415
1416	/* now we know the gpio is valid and chip won't vanish */
1417
1418	spin_unlock_irqrestore(&gpio_lock, flags);
1419
1420	might_sleep_if(chip->can_sleep);
1421
1422	if (status) {
1423		status = chip->request(chip, gpio);
1424		if (status < 0) {
1425			pr_debug("GPIO-%d: chip request fail, %d\n",
1426				chip->base + gpio, status);
1427			/* and it's not available to anyone else ...
1428			 * gpio_request() is the fully clean solution.
1429			 */
1430			goto lose;
1431		}
1432	}
1433
1434	status = chip->direction_input(chip, gpio);
1435	if (status == 0)
1436		clear_bit(FLAG_IS_OUT, &desc->flags);
1437
1438	trace_gpio_direction(chip->base + gpio, 1, status);
1439lose:
1440	return status;
1441fail:
1442	spin_unlock_irqrestore(&gpio_lock, flags);
1443	if (status)
1444		pr_debug("%s: gpio-%d status %d\n",
1445			__func__, gpio, status);
1446	return status;
1447}
1448EXPORT_SYMBOL_GPL(gpio_direction_input);
1449
1450int gpio_direction_output(unsigned gpio, int value)
1451{
1452	unsigned long		flags;
1453	struct gpio_chip	*chip;
1454	struct gpio_desc	*desc = &gpio_desc[gpio];
1455	int			status = -EINVAL;
1456
 
 
 
 
 
 
 
 
1457	/* Open drain pin should not be driven to 1 */
1458	if (value && test_bit(FLAG_OPEN_DRAIN,  &desc->flags))
1459		return gpio_direction_input(gpio);
1460
1461	/* Open source pin should not be driven to 0 */
1462	if (!value && test_bit(FLAG_OPEN_SOURCE,  &desc->flags))
1463		return gpio_direction_input(gpio);
1464
1465	spin_lock_irqsave(&gpio_lock, flags);
1466
1467	if (!gpio_is_valid(gpio))
1468		goto fail;
1469	chip = desc->chip;
1470	if (!chip || !chip->set || !chip->direction_output)
1471		goto fail;
1472	gpio -= chip->base;
1473	if (gpio >= chip->ngpio)
1474		goto fail;
1475	status = gpio_ensure_requested(desc, gpio);
1476	if (status < 0)
1477		goto fail;
1478
1479	/* now we know the gpio is valid and chip won't vanish */
1480
1481	spin_unlock_irqrestore(&gpio_lock, flags);
1482
1483	might_sleep_if(chip->can_sleep);
1484
1485	if (status) {
1486		status = chip->request(chip, gpio);
1487		if (status < 0) {
1488			pr_debug("GPIO-%d: chip request fail, %d\n",
1489				chip->base + gpio, status);
1490			/* and it's not available to anyone else ...
1491			 * gpio_request() is the fully clean solution.
1492			 */
1493			goto lose;
1494		}
1495	}
1496
1497	status = chip->direction_output(chip, gpio, value);
1498	if (status == 0)
1499		set_bit(FLAG_IS_OUT, &desc->flags);
1500	trace_gpio_value(chip->base + gpio, 0, value);
1501	trace_gpio_direction(chip->base + gpio, 0, status);
1502lose:
1503	return status;
1504fail:
1505	spin_unlock_irqrestore(&gpio_lock, flags);
1506	if (status)
1507		pr_debug("%s: gpio-%d status %d\n",
1508			__func__, gpio, status);
1509	return status;
1510}
1511EXPORT_SYMBOL_GPL(gpio_direction_output);
1512
1513/**
1514 * gpio_set_debounce - sets @debounce time for a @gpio
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1515 * @gpio: the gpio to set debounce time
1516 * @debounce: debounce time is microseconds
 
 
 
1517 */
1518int gpio_set_debounce(unsigned gpio, unsigned debounce)
1519{
1520	unsigned long		flags;
1521	struct gpio_chip	*chip;
1522	struct gpio_desc	*desc = &gpio_desc[gpio];
1523	int			status = -EINVAL;
1524
1525	spin_lock_irqsave(&gpio_lock, flags);
 
 
 
 
 
 
 
1526
1527	if (!gpio_is_valid(gpio))
1528		goto fail;
1529	chip = desc->chip;
1530	if (!chip || !chip->set || !chip->set_debounce)
1531		goto fail;
1532	gpio -= chip->base;
1533	if (gpio >= chip->ngpio)
1534		goto fail;
1535	status = gpio_ensure_requested(desc, gpio);
1536	if (status < 0)
1537		goto fail;
1538
1539	/* now we know the gpio is valid and chip won't vanish */
1540
1541	spin_unlock_irqrestore(&gpio_lock, flags);
1542
1543	might_sleep_if(chip->can_sleep);
1544
1545	return chip->set_debounce(chip, gpio, debounce);
1546
1547fail:
1548	spin_unlock_irqrestore(&gpio_lock, flags);
1549	if (status)
1550		pr_debug("%s: gpio-%d status %d\n",
1551			__func__, gpio, status);
1552
1553	return status;
1554}
1555EXPORT_SYMBOL_GPL(gpio_set_debounce);
1556
1557/* I/O calls are only valid after configuration completed; the relevant
1558 * "is this a valid GPIO" error checks should already have been done.
1559 *
1560 * "Get" operations are often inlinable as reading a pin value register,
1561 * and masking the relevant bit in that register.
1562 *
1563 * When "set" operations are inlinable, they involve writing that mask to
1564 * one register to set a low value, or a different register to set it high.
1565 * Otherwise locking is needed, so there may be little value to inlining.
1566 *
1567 *------------------------------------------------------------------------
1568 *
1569 * IMPORTANT!!!  The hot paths -- get/set value -- assume that callers
1570 * have requested the GPIO.  That can include implicit requesting by
1571 * a direction setting call.  Marking a gpio as requested locks its chip
1572 * in memory, guaranteeing that these table lookups need no more locking
1573 * and that gpiochip_remove() will fail.
1574 *
1575 * REVISIT when debugging, consider adding some instrumentation to ensure
1576 * that the GPIO was actually requested.
1577 */
1578
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1579/**
1580 * __gpio_get_value() - return a gpio's value
1581 * @gpio: gpio whose value will be returned
1582 * Context: any
1583 *
1584 * This is used directly or indirectly to implement gpio_get_value().
1585 * It returns the zero or nonzero value provided by the associated
1586 * gpio_chip.get() method; or zero if no such method is provided.
 
1587 */
1588int __gpio_get_value(unsigned gpio)
1589{
1590	struct gpio_chip	*chip;
1591	int value;
1592
1593	chip = gpio_to_chip(gpio);
1594	/* Should be using gpio_get_value_cansleep() */
1595	WARN_ON(chip->can_sleep);
1596	value = chip->get ? chip->get(chip, gpio - chip->base) : 0;
1597	trace_gpio_value(gpio, 1, value);
 
 
 
 
 
 
1598	return value;
1599}
1600EXPORT_SYMBOL_GPL(__gpio_get_value);
1601
1602/*
1603 *  _gpio_set_open_drain_value() - Set the open drain gpio's value.
1604 * @gpio: Gpio whose state need to be set.
1605 * @chip: Gpio chip.
1606 * @value: Non-zero for setting it HIGH otherise it will set to LOW.
1607 */
1608static void _gpio_set_open_drain_value(unsigned gpio,
1609			struct gpio_chip *chip, int value)
1610{
1611	int err = 0;
 
 
 
1612	if (value) {
1613		err = chip->direction_input(chip, gpio - chip->base);
1614		if (!err)
1615			clear_bit(FLAG_IS_OUT, &gpio_desc[gpio].flags);
1616	} else {
1617		err = chip->direction_output(chip, gpio - chip->base, 0);
1618		if (!err)
1619			set_bit(FLAG_IS_OUT, &gpio_desc[gpio].flags);
1620	}
1621	trace_gpio_direction(gpio, value, err);
1622	if (err < 0)
1623		pr_err("%s: Error in set_value for open drain gpio%d err %d\n",
1624					__func__, gpio, err);
 
1625}
1626
1627/*
1628 *  _gpio_set_open_source() - Set the open source gpio's value.
1629 * @gpio: Gpio whose state need to be set.
1630 * @chip: Gpio chip.
1631 * @value: Non-zero for setting it HIGH otherise it will set to LOW.
1632 */
1633static void _gpio_set_open_source_value(unsigned gpio,
1634			struct gpio_chip *chip, int value)
1635{
1636	int err = 0;
 
 
 
1637	if (value) {
1638		err = chip->direction_output(chip, gpio - chip->base, 1);
1639		if (!err)
1640			set_bit(FLAG_IS_OUT, &gpio_desc[gpio].flags);
1641	} else {
1642		err = chip->direction_input(chip, gpio - chip->base);
1643		if (!err)
1644			clear_bit(FLAG_IS_OUT, &gpio_desc[gpio].flags);
1645	}
1646	trace_gpio_direction(gpio, !value, err);
1647	if (err < 0)
1648		pr_err("%s: Error in set_value for open source gpio%d err %d\n",
1649					__func__, gpio, err);
 
1650}
1651
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1652
1653/**
1654 * __gpio_set_value() - assign a gpio's value
1655 * @gpio: gpio whose value will be assigned
1656 * @value: value to assign
1657 * Context: any
1658 *
1659 * This is used directly or indirectly to implement gpio_set_value().
1660 * It invokes the associated gpio_chip.set() method.
 
 
 
1661 */
1662void __gpio_set_value(unsigned gpio, int value)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1663{
1664	struct gpio_chip	*chip;
 
1665
1666	chip = gpio_to_chip(gpio);
1667	/* Should be using gpio_set_value_cansleep() */
1668	WARN_ON(chip->can_sleep);
1669	trace_gpio_value(gpio, 0, value);
1670	if (test_bit(FLAG_OPEN_DRAIN,  &gpio_desc[gpio].flags))
1671		_gpio_set_open_drain_value(gpio, chip, value);
1672	else if (test_bit(FLAG_OPEN_SOURCE,  &gpio_desc[gpio].flags))
1673		_gpio_set_open_source_value(gpio, chip, value);
1674	else
1675		chip->set(chip, gpio - chip->base, value);
1676}
1677EXPORT_SYMBOL_GPL(__gpio_set_value);
1678
1679/**
1680 * __gpio_cansleep() - report whether gpio value access will sleep
1681 * @gpio: gpio in question
1682 * Context: any
1683 *
1684 * This is used directly or indirectly to implement gpio_cansleep().  It
1685 * returns nonzero if access reading or writing the GPIO value can sleep.
1686 */
1687int __gpio_cansleep(unsigned gpio)
1688{
1689	struct gpio_chip	*chip;
 
1690
1691	/* only call this on GPIOs that are valid! */
1692	chip = gpio_to_chip(gpio);
 
 
 
 
1693
1694	return chip->can_sleep;
 
1695}
1696EXPORT_SYMBOL_GPL(__gpio_cansleep);
1697
1698/**
1699 * __gpio_to_irq() - return the IRQ corresponding to a GPIO
1700 * @gpio: gpio whose IRQ will be returned (already requested)
1701 * Context: any
1702 *
1703 * This is used directly or indirectly to implement gpio_to_irq().
1704 * It returns the number of the IRQ signaled by this (input) GPIO,
1705 * or a negative errno.
1706 */
1707int __gpio_to_irq(unsigned gpio)
 
 
 
 
 
 
 
 
 
1708{
1709	struct gpio_chip	*chip;
 
 
 
 
 
 
 
 
 
 
1710
1711	chip = gpio_to_chip(gpio);
1712	return chip->to_irq ? chip->to_irq(chip, gpio - chip->base) : -ENXIO;
1713}
1714EXPORT_SYMBOL_GPL(__gpio_to_irq);
1715
 
 
 
 
1716
 
 
 
1717
1718/* There's no value in making it easy to inline GPIO calls that may sleep.
1719 * Common examples include ones connected to I2C or SPI chips.
 
 
 
 
 
 
1720 */
 
 
 
 
 
 
 
1721
1722int gpio_get_value_cansleep(unsigned gpio)
 
 
 
 
 
 
 
 
 
1723{
1724	struct gpio_chip	*chip;
1725	int value;
1726
1727	might_sleep_if(extra_checks);
1728	chip = gpio_to_chip(gpio);
1729	value = chip->get ? chip->get(chip, gpio - chip->base) : 0;
1730	trace_gpio_value(gpio, 1, value);
 
 
 
 
 
1731	return value;
1732}
1733EXPORT_SYMBOL_GPL(gpio_get_value_cansleep);
1734
1735void gpio_set_value_cansleep(unsigned gpio, int value)
 
 
 
 
 
 
 
 
 
 
1736{
1737	struct gpio_chip	*chip;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1738
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1739	might_sleep_if(extra_checks);
1740	chip = gpio_to_chip(gpio);
1741	trace_gpio_value(gpio, 0, value);
1742	if (test_bit(FLAG_OPEN_DRAIN,  &gpio_desc[gpio].flags))
1743		_gpio_set_open_drain_value(gpio, chip, value);
1744	else if (test_bit(FLAG_OPEN_SOURCE,  &gpio_desc[gpio].flags))
1745		_gpio_set_open_source_value(gpio, chip, value);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1746	else
1747		chip->set(chip, gpio - chip->base, value);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1748}
1749EXPORT_SYMBOL_GPL(gpio_set_value_cansleep);
1750
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1751
1752#ifdef CONFIG_DEBUG_FS
1753
1754static void gpiolib_dbg_show(struct seq_file *s, struct gpio_chip *chip)
1755{
1756	unsigned		i;
1757	unsigned		gpio = chip->base;
1758	struct gpio_desc	*gdesc = &gpio_desc[gpio];
 
1759	int			is_out;
 
1760
1761	for (i = 0; i < chip->ngpio; i++, gpio++, gdesc++) {
1762		if (!test_bit(FLAG_REQUESTED, &gdesc->flags))
 
 
 
 
1763			continue;
 
1764
 
1765		is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
1766		seq_printf(s, " gpio-%-3d (%-20.20s) %s %s",
1767			gpio, gdesc->label,
 
1768			is_out ? "out" : "in ",
1769			chip->get
1770				? (chip->get(chip, i) ? "hi" : "lo")
1771				: "?  ");
 
1772		seq_printf(s, "\n");
1773	}
1774}
1775
1776static int gpiolib_show(struct seq_file *s, void *unused)
1777{
1778	struct gpio_chip	*chip = NULL;
1779	unsigned		gpio;
1780	int			started = 0;
1781
1782	/* REVISIT this isn't locked against gpio_chip removal ... */
1783
1784	for (gpio = 0; gpio_is_valid(gpio); gpio++) {
1785		struct device *dev;
 
 
 
 
 
 
 
 
1786
1787		if (chip == gpio_desc[gpio].chip)
1788			continue;
1789		chip = gpio_desc[gpio].chip;
1790		if (!chip)
1791			continue;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1792
1793		seq_printf(s, "%sGPIOs %d-%d",
1794				started ? "\n" : "",
1795				chip->base, chip->base + chip->ngpio - 1);
1796		dev = chip->dev;
1797		if (dev)
1798			seq_printf(s, ", %s/%s",
1799				dev->bus ? dev->bus->name : "no-bus",
1800				dev_name(dev));
1801		if (chip->label)
1802			seq_printf(s, ", %s", chip->label);
1803		if (chip->can_sleep)
1804			seq_printf(s, ", can sleep");
1805		seq_printf(s, ":\n");
1806
1807		started = 1;
1808		if (chip->dbg_show)
1809			chip->dbg_show(s, chip);
1810		else
1811			gpiolib_dbg_show(s, chip);
1812	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1813	return 0;
1814}
1815
 
 
 
 
 
 
 
1816static int gpiolib_open(struct inode *inode, struct file *file)
1817{
1818	return single_open(file, gpiolib_show, NULL);
1819}
1820
1821static const struct file_operations gpiolib_operations = {
 
1822	.open		= gpiolib_open,
1823	.read		= seq_read,
1824	.llseek		= seq_lseek,
1825	.release	= single_release,
1826};
1827
1828static int __init gpiolib_debugfs_init(void)
1829{
1830	/* /sys/kernel/debug/gpio */
1831	(void) debugfs_create_file("gpio", S_IFREG | S_IRUGO,
1832				NULL, NULL, &gpiolib_operations);
1833	return 0;
1834}
1835subsys_initcall(gpiolib_debugfs_init);
1836
1837#endif	/* DEBUG_FS */