1 files changed, 33 insertions, 29 deletions

diff --git a/drivers/pinctrl/nomadik/pinctrl-nomadik.c b/drivers/pinctrl/nomadik/pinctrl-nomadik.c
index 6c9667a44b7b..09efb8c1a2eb 100644
--- a/drivers/pinctrl/nomadik/pinctrl-nomadik.c
+++ b/drivers/pinctrl/nomadik/pinctrl-nomadik.c
@@ -1505,51 +1505,55 @@ static int nmk_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev,
         const char *function = NULL;
         unsigned long configs = 0;
         bool has_config = 0;
-        unsigned reserve = 0;
         struct property *prop;
         const char *group, *gpio_name;
         struct device_node *np_config;
 
         ret = of_property_read_string(np, "ste,function", &function);
-        if (ret >= 0)
-                reserve = 1;
-
-        has_config = nmk_pinctrl_dt_get_config(np, &configs);
-
-        np_config = of_parse_phandle(np, "ste,config", 0);
-        if (np_config)
-                has_config |= nmk_pinctrl_dt_get_config(np_config, &configs);
-
-        ret = of_property_count_strings(np, "ste,pins");
-        if (ret < 0)
-                goto exit;
-
-        if (has_config)
-                reserve++;
-
-        reserve *= ret;
-
-        ret = pinctrl_utils_reserve_map(pctldev, map, reserved_maps, num_maps, reserve);
-        if (ret < 0)
-                goto exit;
-
-        of_property_for_each_string(np, "ste,pins", prop, group) {
-                if (function) {
+        if (ret >= 0) {
+                ret = of_property_count_strings(np, "ste,pins");
+                if (ret < 0)
+                        goto exit;
+
+                ret = pinctrl_utils_reserve_map(pctldev, map,
+                                                reserved_maps,
+                                                num_maps, ret);
+                if (ret < 0)
+                        goto exit;
+
+                of_property_for_each_string(np, "ste,pins", prop, group) {
                         ret = nmk_dt_add_map_mux(map, reserved_maps, num_maps,
                                           group, function);
                         if (ret < 0)
                                 goto exit;
                 }
-                if (has_config) {
+        }
+
+        has_config = nmk_pinctrl_dt_get_config(np, &configs);
+        np_config = of_parse_phandle(np, "ste,config", 0);
+        if (np_config)
+                has_config |= nmk_pinctrl_dt_get_config(np_config, &configs);
+        if (has_config) {
+                ret = of_property_count_strings(np, "ste,pins");
+                if (ret < 0)
+                        goto exit;
+                ret = pinctrl_utils_reserve_map(pctldev, map,
+                                                reserved_maps,
+                                                num_maps, ret);
+                if (ret < 0)
+                        goto exit;
+
+                of_property_for_each_string(np, "ste,pins", prop, group) {
                         gpio_name = nmk_find_pin_name(pctldev, group);
 
-                        ret = nmk_dt_add_map_configs(map, reserved_maps, num_maps,
-                                              gpio_name, &configs, 1);
+                        ret = nmk_dt_add_map_configs(map, reserved_maps,
+                                                     num_maps,
+                                                     gpio_name, &configs, 1);
                         if (ret < 0)
                                 goto exit;
                 }
-
         }
+
 exit:
         return ret;
 }