From: Bartosz Golaszewski <bgolaszew...@baylibre.com>

In order to simplify resource management and error paths in probe(), add
a devm action that calls clk_disable_unprepare() at driver detach.

Signed-off-by: Bartosz Golaszewski <bgolaszew...@baylibre.com>
---
 drivers/iio/adc/xilinx-xadc-core.c | 17 +++++++++++++----
 1 file changed, 13 insertions(+), 4 deletions(-)

diff --git a/drivers/iio/adc/xilinx-xadc-core.c 
b/drivers/iio/adc/xilinx-xadc-core.c
index b516280ccbd4..e0da6258092c 100644
--- a/drivers/iio/adc/xilinx-xadc-core.c
+++ b/drivers/iio/adc/xilinx-xadc-core.c
@@ -1185,6 +1185,13 @@ static int xadc_parse_dt(struct iio_dev *indio_dev, 
struct device_node *np,
        return 0;
 }
 
+static void xadc_clk_disable_unprepare(void *data)
+{
+       struct clk *clk = data;
+
+       clk_disable_unprepare(clk);
+}
+
 static int xadc_probe(struct platform_device *pdev)
 {
        struct device *dev = &pdev->dev;
@@ -1262,6 +1269,11 @@ static int xadc_probe(struct platform_device *pdev)
        if (ret)
                goto err_free_samplerate_trigger;
 
+       ret = devm_add_action_or_reset(dev,
+                                      xadc_clk_disable_unprepare, xadc->clk);
+       if (ret)
+               goto err_free_samplerate_trigger;
+
        /*
         * Make sure not to exceed the maximum samplerate since otherwise the
         * resulting interrupt storm will soft-lock the system.
@@ -1280,7 +1292,7 @@ static int xadc_probe(struct platform_device *pdev)
        ret = request_irq(xadc->irq, xadc->ops->interrupt_handler, 0,
                          dev_name(dev), indio_dev);
        if (ret)
-               goto err_clk_disable_unprepare;
+               goto err_free_samplerate_trigger;
 
        ret = xadc->ops->setup(pdev, indio_dev, xadc->irq);
        if (ret)
@@ -1344,8 +1356,6 @@ static int xadc_probe(struct platform_device *pdev)
 err_free_irq:
        free_irq(xadc->irq, indio_dev);
        cancel_delayed_work_sync(&xadc->zynq_unmask_work);
-err_clk_disable_unprepare:
-       clk_disable_unprepare(xadc->clk);
 err_free_samplerate_trigger:
        if (xadc->ops->flags & XADC_FLAGS_BUFFERED)
                iio_trigger_free(xadc->samplerate_trigger);
@@ -1372,7 +1382,6 @@ static int xadc_remove(struct platform_device *pdev)
        }
        free_irq(xadc->irq, indio_dev);
        cancel_delayed_work_sync(&xadc->zynq_unmask_work);
-       clk_disable_unprepare(xadc->clk);
 
        return 0;
 }
-- 
2.29.1

Reply via email to