reset: Add acquire/release support for arrays

Add implementations that apply acquire and release operations to all
reset controls part of a reset control array.

Signed-off-by: Thierry Reding <treding@nvidia.com>
Reviewed-by: Philipp Zabel <p.zabel@pengutronix.de>
Signed-off-by: Philipp Zabel <p.zabel@pengutronix.de>

diff --git a/drivers/reset/core.c b/drivers/reset/core.c
index f94da91c22affccf4c81ea6e30467adbd27c7d71..81ea77cba123bce54749d69fa727e9027eed450f 100644 (file)
--- a/drivers/reset/core.c
+++ b/drivers/reset/core.c
@@ -245,6 +245,34 @@ err:
        return ret;
 }
 
+static int reset_control_array_acquire(struct reset_control_array *resets)
+{
+       unsigned int i;
+       int err;
+
+       for (i = 0; i < resets->num_rstcs; i++) {
+               err = reset_control_acquire(resets->rstc[i]);
+               if (err < 0)
+                       goto release;
+       }
+
+       return 0;
+
+release:
+       while (i--)
+               reset_control_release(resets->rstc[i]);
+
+       return err;
+}
+
+static void reset_control_array_release(struct reset_control_array *resets)
+{
+       unsigned int i;
+
+       for (i = 0; i < resets->num_rstcs; i++)
+               reset_control_release(resets->rstc[i]);
+}
+
 static inline bool reset_control_is_array(struct reset_control *rstc)
 {
        return rstc->array;
@@ -464,6 +492,9 @@ int reset_control_acquire(struct reset_control *rstc)
        if (WARN_ON(IS_ERR(rstc)))
                return -EINVAL;
 
+       if (reset_control_is_array(rstc))
+               return reset_control_array_acquire(rstc_to_array(rstc));
+
        mutex_lock(&reset_list_mutex);
 
        if (rstc->acquired) {
@@ -502,7 +533,10 @@ void reset_control_release(struct reset_control *rstc)
        if (!rstc || WARN_ON(IS_ERR(rstc)))
                return;
 
-       rstc->acquired = false;
+       if (reset_control_is_array(rstc))
+               reset_control_array_release(rstc_to_array(rstc));
+       else
+               rstc->acquired = false;
 }
 EXPORT_SYMBOL_GPL(reset_control_release);
 

diff --git a/include/linux/reset.h b/include/linux/reset.h
index a01b32bf51d405fa701570439d947a956920868a..95d555c2130a0b97581a932e1a8fd62f62f4d2f3 100644 (file)
--- a/include/linux/reset.h
+++ b/include/linux/reset.h
@@ -470,6 +470,12 @@ of_reset_control_array_get_exclusive(struct device_node *node)
        return of_reset_control_array_get(node, false, false, true);
 }
 
+static inline struct reset_control *
+of_reset_control_array_get_exclusive_released(struct device_node *node)
+{
+       return of_reset_control_array_get(node, false, false, false);
+}
+
 static inline struct reset_control *
 of_reset_control_array_get_shared(struct device_node *node)
 {