Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 358762
b: refs/heads/master
c: 1a989d0
h: refs/heads/master
v: v3
  • Loading branch information
Alexandre Courbot authored and Grant Likely committed Feb 9, 2013
1 parent 69491b1 commit 9401202
Show file tree
Hide file tree
Showing 3 changed files with 47 additions and 8 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 0fa2fd9a0d4f1305a54a396d44975894e90eed7b
refs/heads/master: 1a989d0f1de8f5a150b35e1e8181cc1abc139162
51 changes: 44 additions & 7 deletions trunk/drivers/gpio/gpiolib.c
Original file line number Diff line number Diff line change
Expand Up @@ -3,6 +3,7 @@
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/spinlock.h>
#include <linux/list.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/debugfs.h>
Expand Down Expand Up @@ -71,6 +72,8 @@ struct gpio_desc {
};
static struct gpio_desc gpio_desc[ARCH_NR_GPIOS];

static LIST_HEAD(gpio_chips);

#ifdef CONFIG_GPIO_SYSFS
static DEFINE_IDR(dirent_idr);
#endif
Expand Down Expand Up @@ -1014,6 +1017,43 @@ static inline void gpiochip_unexport(struct gpio_chip *chip)

#endif /* CONFIG_GPIO_SYSFS */

/*
* Add a new chip to the global chips list, keeping the list of chips sorted
* by base order.
*
* Return -EBUSY if the new chip overlaps with some other chip's integer
* space.
*/
static int gpiochip_add_to_list(struct gpio_chip *chip)
{
struct list_head *pos = &gpio_chips;
struct gpio_chip *_chip;
int err = 0;

/* find where to insert our chip */
list_for_each(pos, &gpio_chips) {
_chip = list_entry(pos, struct gpio_chip, list);
/* shall we insert before _chip? */
if (_chip->base >= chip->base + chip->ngpio)
break;
}

/* are we stepping on the chip right before? */
if (pos != &gpio_chips && pos->prev != &gpio_chips) {
_chip = list_entry(pos->prev, struct gpio_chip, list);
if (_chip->base + _chip->ngpio > chip->base) {
dev_err(chip->dev,
"GPIO integer space overlap, cannot add chip\n");
err = -EBUSY;
}
}

if (!err)
list_add_tail(&chip->list, pos);

return err;
}

/**
* gpiochip_add() - register a gpio_chip
* @chip: the chip to register, with chip->base initialized
Expand Down Expand Up @@ -1055,13 +1095,8 @@ int gpiochip_add(struct gpio_chip *chip)
chip->base = base;
}

/* these GPIO numbers must not be managed by another gpio_chip */
for (id = base; id < base + chip->ngpio; id++) {
if (gpio_desc[id].chip != NULL) {
status = -EBUSY;
break;
}
}
status = gpiochip_add_to_list(chip);

if (status == 0) {
for (id = base; id < base + chip->ngpio; id++) {
gpio_desc[id].chip = chip;
Expand Down Expand Up @@ -1135,6 +1170,8 @@ int gpiochip_remove(struct gpio_chip *chip)
if (status == 0) {
for (id = chip->base; id < chip->base + chip->ngpio; id++)
gpio_desc[id].chip = NULL;

list_del(&chip->list);
}

spin_unlock_irqrestore(&gpio_lock, flags);
Expand Down
2 changes: 2 additions & 0 deletions trunk/include/asm-generic/gpio.h
Original file line number Diff line number Diff line change
Expand Up @@ -53,6 +53,7 @@ struct device_node;
* @label: for diagnostics
* @dev: optional device providing the GPIOs
* @owner: helps prevent removal of modules exporting active GPIOs
* @list: links gpio_chips together for traversal
* @request: optional hook for chip-specific activation, such as
* enabling module power and clock; may sleep
* @free: optional hook for chip-specific deactivation, such as
Expand Down Expand Up @@ -98,6 +99,7 @@ struct gpio_chip {
const char *label;
struct device *dev;
struct module *owner;
struct list_head list;

int (*request)(struct gpio_chip *chip,
unsigned offset);
Expand Down

0 comments on commit 9401202

Please sign in to comment.