We must return the selector from pinctrl_generic_add_group() so
pin controller device drivers can remove the right group if needed
for deferred probe for example. And we now must make sure that a
proper name is passed so we can use it to check if the entry already
exists.

Note that fixes are also needed for the pin controller drivers to
use the selector value.

Fixes: c7059c5ac70a ("pinctrl: core: Add generic pinctrl functions
for managing groups")
Reported-by: H. Nikolaus Schaller <[email protected]>
Cc: Andy Shevchenko <[email protected]>
Cc: Christ van Willegen <[email protected]>
Cc: Haojian Zhuang <[email protected]>
Cc: Jacopo Mondi <[email protected]>
Cc: Paul Cercueil <[email protected]>
Cc: Sean Wang <[email protected]>
Signed-off-by: Tony Lindgren <[email protected]>
---
 drivers/pinctrl/core.c | 35 ++++++++++++++++++++++++++++++++---
 1 file changed, 32 insertions(+), 3 deletions(-)

diff --git a/drivers/pinctrl/core.c b/drivers/pinctrl/core.c
--- a/drivers/pinctrl/core.c
+++ b/drivers/pinctrl/core.c
@@ -617,6 +617,26 @@ struct group_desc *pinctrl_generic_get_group(struct 
pinctrl_dev *pctldev,
 }
 EXPORT_SYMBOL_GPL(pinctrl_generic_get_group);
 
+static int pinctrl_generic_group_name_to_selector(struct pinctrl_dev *pctldev,
+                                                 const char *function)
+{
+       const struct pinctrl_ops *ops = pctldev->desc->pctlops;
+       int ngroups = ops->get_groups_count(pctldev);
+       int selector = 0;
+
+       /* See if this pctldev has this group */
+       while (selector < ngroups) {
+               const char *gname = ops->get_group_name(pctldev, selector);
+
+               if (!strcmp(function, gname))
+                       return selector;
+
+               selector++;
+       }
+
+       return -EINVAL;
+}
+
 /**
  * pinctrl_generic_add_group() - adds a new pin group
  * @pctldev: pin controller device
@@ -631,6 +651,16 @@ int pinctrl_generic_add_group(struct pinctrl_dev *pctldev, 
const char *name,
                              int *pins, int num_pins, void *data)
 {
        struct group_desc *group;
+       int selector;
+
+       if (!name)
+               return -EINVAL;
+
+       selector = pinctrl_generic_group_name_to_selector(pctldev, name);
+       if (selector >= 0)
+               return selector;
+
+       selector = pctldev->num_groups;
 
        group = devm_kzalloc(pctldev->dev, sizeof(*group), GFP_KERNEL);
        if (!group)
@@ -641,12 +671,11 @@ int pinctrl_generic_add_group(struct pinctrl_dev 
*pctldev, const char *name,
        group->num_pins = num_pins;
        group->data = data;
 
-       radix_tree_insert(&pctldev->pin_group_tree, pctldev->num_groups,
-                         group);
+       radix_tree_insert(&pctldev->pin_group_tree, selector, group);
 
        pctldev->num_groups++;
 
-       return 0;
+       return selector;
 }
 EXPORT_SYMBOL_GPL(pinctrl_generic_add_group);
 
-- 
2.17.1

Reply via email to