lkml.org 
[lkml]   [2012]   [Oct]   [17]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH RFC 11/15 v5] gpio-max732x: Add block GPIO API
    Date
    This patch adds block GPIO API support to the gpio-max732x driver.

    Signed-off-by: Roland Stigge <stigge@antcom.de>

    ---
    drivers/gpio/gpio-max732x.c | 59 ++++++++++++++++++++++++++++++++++++++++++++
    1 file changed, 59 insertions(+)

    --- linux-2.6.orig/drivers/gpio/gpio-max732x.c
    +++ linux-2.6/drivers/gpio/gpio-max732x.c
    @@ -219,6 +219,63 @@ out:
    mutex_unlock(&chip->lock);
    }

    +static unsigned long max732x_gpio_get_block(struct gpio_chip *gc,
    + unsigned long mask)
    +{
    + struct max732x_chip *chip;
    + uint8_t lo = 0;
    + uint8_t hi = 0;
    + int ret;
    +
    + chip = container_of(gc, struct max732x_chip, gpio_chip);
    +
    + if (mask & 0xFF) {
    + ret = max732x_readb(chip, is_group_a(chip, 0), &lo);
    + if (ret < 0)
    + return 0;
    + }
    + if (mask & 0xFF00) {
    + ret = max732x_readb(chip, is_group_a(chip, 8), &hi);
    + if (ret < 0)
    + return 0;
    + }
    +
    + return (((unsigned long)hi << 8) | lo) & mask;
    +}
    +
    +static void max732x_gpio_set_block(struct gpio_chip *gc, unsigned long mask,
    + unsigned long values)
    +{
    + struct max732x_chip *chip;
    + uint8_t reg_out;
    + uint8_t lo_mask = mask & 0xFF;
    + uint8_t hi_mask = (mask >> 8) & 0xFF;
    + int ret;
    +
    + chip = container_of(gc, struct max732x_chip, gpio_chip);
    +
    + mutex_lock(&chip->lock);
    +
    + if (lo_mask) {
    + reg_out = (chip->reg_out[0] & ~lo_mask) | (values & lo_mask);
    + ret = max732x_writeb(chip, is_group_a(chip, 0), reg_out);
    + if (ret < 0)
    + goto out;
    + chip->reg_out[0] = reg_out;
    + }
    + if (hi_mask) {
    + reg_out = (chip->reg_out[1] & ~hi_mask) |
    + ((values >> 8) & hi_mask);
    + ret = max732x_writeb(chip, is_group_a(chip, 8), reg_out);
    + if (ret < 0)
    + goto out;
    + chip->reg_out[1] = reg_out;
    + }
    +
    +out:
    + mutex_unlock(&chip->lock);
    +}
    +
    static int max732x_gpio_direction_input(struct gpio_chip *gc, unsigned off)
    {
    struct max732x_chip *chip;
    @@ -562,8 +619,10 @@ static int __devinit max732x_setup_gpio(
    if (chip->dir_output) {
    gc->direction_output = max732x_gpio_direction_output;
    gc->set = max732x_gpio_set_value;
    + gc->set_block = max732x_gpio_set_block;
    }
    gc->get = max732x_gpio_get_value;
    + gc->get_block = max732x_gpio_get_block;
    gc->can_sleep = 1;

    gc->base = gpio_start;

    \
     
     \ /
      Last update: 2012-10-17 15:21    [W:4.671 / U:1.776 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site