pinctrl: msm: Fix set gpio setting
authorAxel Lin <axel.lin@ingics.com>
Fri, 13 Dec 2013 13:35:55 +0000 (21:35 +0800)
committerLinus Walleij <linus.walleij@linaro.org>
Fri, 20 Dec 2013 09:13:23 +0000 (10:13 +0100)
Set g->out_bit bit for gpio output high, clear g->out_bit bit for gpio output
low.

Signed-off-by: Axel Lin <axel.lin@ingics.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
drivers/pinctrl/pinctrl-msm.c

index 011e263..ef2bf31 100644 (file)
@@ -429,7 +429,12 @@ static int msm_gpio_direction_output(struct gpio_chip *chip, unsigned offset, in
 
        spin_lock_irqsave(&pctrl->lock, flags);
 
-       writel(value ? BIT(g->out_bit) : 0, pctrl->regs + g->io_reg);
+       val = readl(pctrl->regs + g->io_reg);
+       if (value)
+               val |= BIT(g->out_bit);
+       else
+               val &= ~BIT(g->out_bit);
+       writel(val, pctrl->regs + g->io_reg);
 
        val = readl(pctrl->regs + g->ctl_reg);
        val |= BIT(g->oe_bit);
@@ -468,7 +473,10 @@ static void msm_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
        spin_lock_irqsave(&pctrl->lock, flags);
 
        val = readl(pctrl->regs + g->io_reg);
-       val |= BIT(g->out_bit);
+       if (value)
+               val |= BIT(g->out_bit);
+       else
+               val &= ~BIT(g->out_bit);
        writel(val, pctrl->regs + g->io_reg);
 
        spin_unlock_irqrestore(&pctrl->lock, flags);