pinctrl-msm: Tidy up error handling

Signed-off-by: Bjorn Andersson <bjorn.andersson@sonymobile.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>

1 files changed, 26 insertions, 50 deletions

diff --git a/drivers/pinctrl/pinctrl-msm.c b/drivers/pinctrl/pinctrl-msm.c
index 322bc0a26040..c1a3053ff4c7 100644
--- a/drivers/pinctrl/pinctrl-msm.c
+++ b/drivers/pinctrl/pinctrl-msm.c
@@ -57,7 +57,7 @@ struct msm_pinctrl {
         struct pinctrl_dev *pctrl;
         struct irq_domain *domain;
         struct gpio_chip chip;
-        unsigned irq;
+        int irq;
 
         spinlock_t lock;
 
@@ -201,7 +201,7 @@ static const struct pinmux_ops msm_pinmux_ops = {
 static int msm_config_reg(struct msm_pinctrl *pctrl,
                           const struct msm_pingroup *g,
                           unsigned param,
-                          unsigned *reg,
+                          s16 *reg,
                           unsigned *mask,
                           unsigned *bit)
 {
@@ -272,7 +272,7 @@ static int msm_config_group_get(struct pinctrl_dev *pctldev,
         unsigned mask;
         unsigned arg;
         unsigned bit;
-        unsigned reg;
+        s16 reg;
         int ret;
         u32 val;
 
@@ -322,7 +322,7 @@ static int msm_config_group_set(struct pinctrl_dev *pctldev,
         unsigned mask;
         unsigned arg;
         unsigned bit;
-        unsigned reg;
+        s16 reg;
         int ret;
         u32 val;
         int i;
@@ -350,7 +350,7 @@ static int msm_config_group_set(struct pinctrl_dev *pctldev,
                         break;
                 case PIN_CONFIG_DRIVE_STRENGTH:
                         /* Check for invalid values */
-                        if (arg > ARRAY_SIZE(msm_drive_to_regval))
+                        if (arg >= ARRAY_SIZE(msm_drive_to_regval))
                                 arg = -1;
                         else
                                 arg = msm_drive_to_regval[arg];
@@ -399,12 +399,8 @@ static int msm_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
         unsigned long flags;
         u32 val;
 
-        if (WARN_ON(offset >= pctrl->soc->ngroups))
-                return -EINVAL;
-
         g = &pctrl->soc->groups[offset];
-
-        if (WARN_ON(g->oe_bit < 0))
+        if (WARN_ON(g->io_reg < 0))
                 return -EINVAL;
 
         spin_lock_irqsave(&pctrl->lock, flags);
@@ -425,12 +421,8 @@ static int msm_gpio_direction_output(struct gpio_chip *chip, unsigned offset, in
         unsigned long flags;
         u32 val;
 
-        if (WARN_ON(offset >= pctrl->soc->ngroups))
-                return -EINVAL;
-
         g = &pctrl->soc->groups[offset];
-
-        if (WARN_ON(g->oe_bit < 0))
+        if (WARN_ON(g->io_reg < 0))
                 return -EINVAL;
 
         spin_lock_irqsave(&pctrl->lock, flags);
@@ -452,10 +444,9 @@ static int msm_gpio_get(struct gpio_chip *chip, unsigned offset)
         struct msm_pinctrl *pctrl = container_of(chip, struct msm_pinctrl, chip);
         u32 val;
 
-        if (WARN_ON(offset >= pctrl->soc->ngroups))
-                return -EINVAL;
-
         g = &pctrl->soc->groups[offset];
+        if (WARN_ON(g->io_reg < 0))
+                return -EINVAL;
 
         val = readl(pctrl->regs + g->io_reg);
         return !!(val & BIT(g->in_bit));
@@ -468,10 +459,9 @@ static void msm_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
         unsigned long flags;
         u32 val;
 
-        if (WARN_ON(offset >= pctrl->soc->ngroups))
-                return;
-
         g = &pctrl->soc->groups[offset];
+        if (WARN_ON(g->io_reg < 0))
+                return;
 
         spin_lock_irqsave(&pctrl->lock, flags);
 
@@ -616,13 +606,9 @@ static void msm_gpio_irq_mask(struct irq_data *d)
         u32 val;
 
         pctrl = irq_data_get_irq_chip_data(d);
-        if (!pctrl)
-                return;
-
-        if (WARN_ON(d->hwirq >= pctrl->soc->ngroups))
-                return;
-
         g = &pctrl->soc->groups[d->hwirq];
+        if (WARN_ON(g->intr_cfg_reg < 0))
+                return;
 
         spin_lock_irqsave(&pctrl->lock, flags);
 
@@ -643,13 +629,9 @@ static void msm_gpio_irq_unmask(struct irq_data *d)
         u32 val;
 
         pctrl = irq_data_get_irq_chip_data(d);
-        if (!pctrl)
-                return;
-
-        if (WARN_ON(d->hwirq >= pctrl->soc->ngroups))
-                return;
-
         g = &pctrl->soc->groups[d->hwirq];
+        if (WARN_ON(g->intr_status_reg < 0))
+                return;
 
         spin_lock_irqsave(&pctrl->lock, flags);
 
@@ -674,13 +656,9 @@ static void msm_gpio_irq_ack(struct irq_data *d)
         u32 val;
 
         pctrl = irq_data_get_irq_chip_data(d);
-        if (!pctrl)
-                return;
-
-        if (WARN_ON(d->hwirq >= pctrl->soc->ngroups))
-                return;
-
         g = &pctrl->soc->groups[d->hwirq];
+        if (WARN_ON(g->intr_status_reg < 0))
+                return;
 
         spin_lock_irqsave(&pctrl->lock, flags);
 
@@ -704,13 +682,9 @@ static int msm_gpio_irq_set_type(struct irq_data *d, unsigned int type)
         u32 val;
 
         pctrl = irq_data_get_irq_chip_data(d);
-        if (!pctrl)
-                return -EINVAL;
-
-        if (WARN_ON(d->hwirq >= pctrl->soc->ngroups))
-                return -EINVAL;
-
         g = &pctrl->soc->groups[d->hwirq];
+        if (WARN_ON(g->intr_cfg_reg < 0))
+                return -EINVAL;
 
         spin_lock_irqsave(&pctrl->lock, flags);
 
@@ -802,9 +776,6 @@ static int msm_gpio_irq_set_wake(struct irq_data *d, unsigned int on)
         unsigned ngpio;
 
         pctrl = irq_data_get_irq_chip_data(d);
-        if (!pctrl)
-                return -EINVAL;
-
         ngpio = pctrl->chip.ngpio;
 
         spin_lock_irqsave(&pctrl->lock, flags);
@@ -983,7 +954,7 @@ int msm_pinctrl_probe(struct platform_device *pdev,
         if (IS_ERR(pctrl->regs))
                 return PTR_ERR(pctrl->regs);
 
-        pctrl->irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
+        pctrl->irq = platform_get_irq(pdev, 0);
         if (pctrl->irq < 0) {
                 dev_err(&pdev->dev, "No interrupt defined for msmgpio\n");
                 return pctrl->irq;
@@ -1017,9 +988,14 @@ int msm_pinctrl_remove(struct platform_device *pdev)
         struct msm_pinctrl *pctrl = platform_get_drvdata(pdev);
         int ret;
 
+        ret = gpiochip_remove(&pctrl->chip);
+        if (ret) {
+                dev_err(&pdev->dev, "Failed to remove gpiochip\n");
+                return ret;
+        }
+
         irq_set_chained_handler(pctrl->irq, NULL);
         irq_domain_remove(pctrl->domain);
-        ret = gpiochip_remove(&pctrl->chip);
         pinctrl_unregister(pctrl->pctrl);
 
         return 0;