This patch adds block GPIO API support to the gpio-vt8500 driver.

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

---
 drivers/gpio/gpio-vt8500.c |   24 ++++++++++++++++++++++++
 1 file changed, 24 insertions(+)

--- linux-2.6.orig/drivers/gpio/gpio-vt8500.c
+++ linux-2.6/drivers/gpio/gpio-vt8500.c
@@ -209,6 +209,28 @@ static void vt8500_gpio_set_value(struct
        writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->data_out);
 }
 
+static unsigned long vt8500_gpio_get_block(struct gpio_chip *chip,
+                                          unsigned long mask)
+{
+       struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip);
+
+       return readl_relaxed(vt8500_chip->base + vt8500_chip->regs->data_in) &
+                                                               mask;
+}
+
+static void vt8500_gpio_set_block(struct gpio_chip *chip, unsigned long mask,
+                                 unsigned long  values)
+{
+       struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip);
+
+       u32 val = readl_relaxed(vt8500_chip->base +
+                               vt8500_chip->regs->data_out);
+       val &= ~mask;
+       val |= values & mask;
+
+       writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->data_out);
+}
+
 static int vt8500_of_xlate(struct gpio_chip *gc,
                            const struct of_phandle_args *gpiospec, u32 *flags)
 {
@@ -251,6 +273,8 @@ static int vt8500_add_chips(struct platf
                chip->direction_output = vt8500_gpio_direction_output;
                chip->get = vt8500_gpio_get_value;
                chip->set = vt8500_gpio_set_value;
+               chip->get_block = vt8500_gpio_get_block;
+               chip->set_block = vt8500_gpio_set_block;
                chip->can_sleep = 0;
                chip->base = pin_cnt;
                chip->ngpio = data->banks[i].ngpio;
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to