Create a dedicated function to add a GPIO desc in the forwarder. Instead of
saving a GPIO descs array pointer, now the GPIO descs are passed one by one
to the forwarder which registers them in its own array. So after the call
of gpiochip_fwd_create(), the passed array can be free.

Reviewed-by: Andy Shevchenko <a...@kernel.org>
Signed-off-by: Thomas Richard <thomas.rich...@bootlin.com>
---
 drivers/gpio/gpio-aggregator.c | 59 ++++++++++++++++++++++++++++--------------
 1 file changed, 40 insertions(+), 19 deletions(-)

diff --git a/drivers/gpio/gpio-aggregator.c b/drivers/gpio/gpio-aggregator.c
index f79bb4e12b20..6285c3e8f6b8 100644
--- a/drivers/gpio/gpio-aggregator.c
+++ b/drivers/gpio/gpio-aggregator.c
@@ -485,6 +485,10 @@ devm_gpiochip_fwd_alloc(struct device *dev, unsigned int 
ngpios)
        if (!fwd)
                return ERR_PTR(-ENOMEM);
 
+       fwd->descs = devm_kcalloc(dev, ngpios, sizeof(*fwd->descs), GFP_KERNEL);
+       if (!fwd->descs)
+               return ERR_PTR(-ENOMEM);
+
        chip = &fwd->chip;
 
        chip->label = dev_name(dev);
@@ -504,13 +508,43 @@ devm_gpiochip_fwd_alloc(struct device *dev, unsigned int 
ngpios)
        return fwd;
 }
 
+static int gpiochip_fwd_desc_add(struct gpiochip_fwd *fwd,
+                                struct gpio_desc *desc,
+                                unsigned int offset)
+{
+       struct gpio_chip *parent = gpiod_to_chip(desc);
+       struct gpio_chip *chip = &fwd->chip;
+
+       if (offset > chip->ngpio)
+               return -EINVAL;
+
+       /*
+        * If any of the GPIO lines are sleeping, then the entire forwarder
+        * will be sleeping.
+        * If any of the chips support .set_config(), then the forwarder will
+        * support setting configs.
+        */
+       if (gpiod_cansleep(desc))
+               chip->can_sleep = true;
+
+       if (parent && parent->set_config)
+               chip->set_config = gpio_fwd_set_config;
+
+       fwd->descs[offset] = desc;
+
+       dev_dbg(chip->parent, "%u => gpio %d irq %d\n", offset,
+               desc_to_gpio(desc), gpiod_to_irq(desc));
+
+       return 0;
+}
+
 /**
  * gpiochip_fwd_create() - Create a new GPIO forwarder
  * @dev: Parent device pointer
  * @ngpios: Number of GPIOs in the forwarder.
  * @descs: Array containing the GPIO descriptors to forward to.
- *         This array must contain @ngpios entries, and must not be deallocated
- *         before the forwarder has been destroyed again.
+ *         This array must contain @ngpios entries, and can be deallocated
+ *         as the forwarder has its own array.
  * @features: Bitwise ORed features as defined with FWD_FEATURE_*.
  *
  * This function creates a new gpiochip, which forwards all GPIO operations to
@@ -535,26 +569,12 @@ static struct gpiochip_fwd *gpiochip_fwd_create(struct 
device *dev,
 
        chip = &fwd->chip;
 
-       /*
-        * If any of the GPIO lines are sleeping, then the entire forwarder
-        * will be sleeping.
-        * If any of the chips support .set_config(), then the forwarder will
-        * support setting configs.
-        */
        for (i = 0; i < ngpios; i++) {
-               struct gpio_chip *parent = gpiod_to_chip(descs[i]);
-
-               dev_dbg(dev, "%u => gpio %d irq %d\n", i,
-                       desc_to_gpio(descs[i]), gpiod_to_irq(descs[i]));
-
-               if (gpiod_cansleep(descs[i]))
-                       chip->can_sleep = true;
-               if (parent && parent->set_config)
-                       chip->set_config = gpio_fwd_set_config;
+               error = gpiochip_fwd_desc_add(fwd, descs[i], i);
+               if (error)
+                       return ERR_PTR(error);
        }
 
-       fwd->descs = descs;
-
        if (chip->can_sleep)
                mutex_init(&fwd->mlock);
        else
@@ -1348,6 +1368,7 @@ static int gpio_aggregator_probe(struct platform_device 
*pdev)
                return PTR_ERR(fwd);
 
        platform_set_drvdata(pdev, fwd);
+       devm_kfree(dev, descs);
        return 0;
 }
 

-- 
2.39.5


Reply via email to