diff options
Diffstat (limited to 'ANDROID_3.4.5/drivers/gpio')
| -rw-r--r-- | ANDROID_3.4.5/drivers/gpio/gpiolib.c | 39 |
1 files changed, 39 insertions, 0 deletions
diff --git a/ANDROID_3.4.5/drivers/gpio/gpiolib.c b/ANDROID_3.4.5/drivers/gpio/gpiolib.c index 5a75510d..c4c68359 100644 --- a/ANDROID_3.4.5/drivers/gpio/gpiolib.c +++ b/ANDROID_3.4.5/drivers/gpio/gpiolib.c @@ -310,6 +310,7 @@ static ssize_t gpio_value_store(struct device *dev, if (status == 0) { if (test_bit(FLAG_ACTIVE_LOW, &desc->flags)) value = !value; + printk("[GPIO] %d, %ld\n", gpio, value); gpio_set_value_cansleep(gpio, value != 0); status = size; } @@ -1500,6 +1501,44 @@ fail: } EXPORT_SYMBOL_GPL(gpio_direction_output); +int gpio_re_enabled(unsigned gpio) +{ + unsigned long flags; + struct gpio_chip *chip; + struct gpio_desc *desc = &gpio_desc[gpio]; + int status = -EINVAL; + + spin_lock_irqsave(&gpio_lock, flags); + if (!gpio_is_valid(gpio)) + goto fail; + chip = desc->chip; + if (!chip || !chip->set || !chip->direction_output) + goto fail; + gpio -= chip->base; + if (gpio >= chip->ngpio) + goto fail; + status = gpio_ensure_requested(desc, gpio); + if (status < 0) + goto fail; + + spin_unlock_irqrestore(&gpio_lock, flags); + + status = chip->request(chip, gpio); + if (status < 0) { + pr_debug("GPIO-%d: chip request fail, %d\n", + chip->base + gpio, status); + } + return status; + +fail: + spin_unlock_irqrestore(&gpio_lock, flags); + if (status) + pr_debug("%s: gpio-%d status %d\n", + __func__, gpio, status); + return status; +} +EXPORT_SYMBOL_GPL(gpio_re_enabled); + /** * gpio_set_debounce - sets @debounce time for a @gpio * @gpio: the gpio to set debounce time |