bus: qcom-ssc-block-bus: Fix the error handling path of qcom_ssc_block_bus_probe()

If qcom_ssc_block_bus_pds_enable() fails, the previous call to
qcom_ssc_block_bus_pds_attach() must be undone, as already done in the
remove function.

In order to do that, move the code related to the power domains management
to the end of the function, in order to avoid many changes in all the error
handling path that would need to go through the new error handling path.

Fixes: 97d485edc1d9 ("bus: add driver for initializing the SSC bus on (some) qcom SoCs")
Signed-off-by: Christophe JAILLET <christophe.jaillet@wanadoo.fr>
Link: https://lore.kernel.org/r/1b89ec7438c9a893c09083e8591772c8ad3cb599.1740932040.git.christophe.jaillet@wanadoo.fr
Signed-off-by: Bjorn Andersson <andersson@kernel.org>

diff --git a/drivers/bus/qcom-ssc-block-bus.c b/drivers/bus/qcom-ssc-block-bus.c
index c95a985e349881d841dbb2ef178c6246a3750996..7f5fd4e0940dc15e6c4d305f787a25b2e11a26b2 100644 (file)
--- a/drivers/bus/qcom-ssc-block-bus.c
+++ b/drivers/bus/qcom-ssc-block-bus.c
@@ -264,18 +264,6 @@ static int qcom_ssc_block_bus_probe(struct platform_device *pdev)
 
        platform_set_drvdata(pdev, data);
 
-       data->pd_names = qcom_ssc_block_pd_names;
-       data->num_pds = ARRAY_SIZE(qcom_ssc_block_pd_names);
-
-       /* power domains */
-       ret = qcom_ssc_block_bus_pds_attach(&pdev->dev, data->pds, data->pd_names, data->num_pds);
-       if (ret < 0)
-               return dev_err_probe(&pdev->dev, ret, "error when attaching power domains\n");
-
-       ret = qcom_ssc_block_bus_pds_enable(data->pds, data->num_pds);
-       if (ret < 0)
-               return dev_err_probe(&pdev->dev, ret, "error when enabling power domains\n");
-
        /* low level overrides for when the HW logic doesn't "just work" */
        res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpm_sscaon_config0");
        data->reg_mpm_sscaon_config0 = devm_ioremap_resource(&pdev->dev, res);
@@ -343,11 +331,30 @@ static int qcom_ssc_block_bus_probe(struct platform_device *pdev)
 
        data->ssc_axi_halt = halt_args.args[0];
 
+       /* power domains */
+       data->pd_names = qcom_ssc_block_pd_names;
+       data->num_pds = ARRAY_SIZE(qcom_ssc_block_pd_names);
+
+       ret = qcom_ssc_block_bus_pds_attach(&pdev->dev, data->pds, data->pd_names, data->num_pds);
+       if (ret < 0)
+               return dev_err_probe(&pdev->dev, ret, "error when attaching power domains\n");
+
+       ret = qcom_ssc_block_bus_pds_enable(data->pds, data->num_pds);
+       if (ret < 0) {
+               dev_err_probe(&pdev->dev, ret, "error when enabling power domains\n");
+               goto err_detach_pds_bus;
+       }
+
        qcom_ssc_block_bus_init(&pdev->dev);
 
        of_platform_populate(np, NULL, NULL, &pdev->dev);
 
        return 0;
+
+err_detach_pds_bus:
+       qcom_ssc_block_bus_pds_detach(&pdev->dev, data->pds, data->num_pds);
+
+       return ret;
 }
 
 static void qcom_ssc_block_bus_remove(struct platform_device *pdev)