If device registration fails, remove sysfs attribute
and if setting bus callbacks fails, unregister the device
and cleanup the sysfs attribute.

Signed-off-by: Amey Narkhede <[email protected]>
---
 drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c | 14 ++++++++++++--
 drivers/iommu/arm/arm-smmu/arm-smmu.c       | 15 ++++++++++++---
 drivers/iommu/arm/arm-smmu/qcom_iommu.c     | 13 +++++++++++--
 3 files changed, 35 insertions(+), 7 deletions(-)

diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c 
b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c
index 54b2f27b81d4..de2499754025 100644
--- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c
+++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c
@@ -3669,10 +3669,20 @@ static int arm_smmu_device_probe(struct platform_device 
*pdev)
        ret = iommu_device_register(&smmu->iommu, &arm_smmu_ops, dev);
        if (ret) {
                dev_err(dev, "Failed to register iommu\n");
-               return ret;
+               goto err_sysfs_remove;
        }

-       return arm_smmu_set_bus_ops(&arm_smmu_ops);
+       ret = arm_smmu_set_bus_ops(&arm_smmu_ops);
+       if (ret)
+               goto err_unregister_device;
+
+       return 0;
+
+err_unregister_device:
+       iommu_device_unregister(&smmu->iommu);
+err_sysfs_remove:
+       iommu_device_sysfs_remove(&smmu->iommu);
+       return ret;
 }

 static int arm_smmu_device_remove(struct platform_device *pdev)
diff --git a/drivers/iommu/arm/arm-smmu/arm-smmu.c 
b/drivers/iommu/arm/arm-smmu/arm-smmu.c
index 6f72c4d208ca..88a3023676ce 100644
--- a/drivers/iommu/arm/arm-smmu/arm-smmu.c
+++ b/drivers/iommu/arm/arm-smmu/arm-smmu.c
@@ -2164,7 +2164,7 @@ static int arm_smmu_device_probe(struct platform_device 
*pdev)
        err = iommu_device_register(&smmu->iommu, &arm_smmu_ops, dev);
        if (err) {
                dev_err(dev, "Failed to register iommu\n");
-               return err;
+               goto err_sysfs_remove;
        }

        platform_set_drvdata(pdev, smmu);
@@ -2187,10 +2187,19 @@ static int arm_smmu_device_probe(struct platform_device 
*pdev)
         * any device which might need it, so we want the bus ops in place
         * ready to handle default domain setup as soon as any SMMU exists.
         */
-       if (!using_legacy_binding)
-               return arm_smmu_bus_init(&arm_smmu_ops);
+       if (!using_legacy_binding) {
+               err = arm_smmu_bus_init(&arm_smmu_ops);
+               if (err)
+                       goto err_unregister_device;
+       }

        return 0;
+
+err_unregister_device:
+       iommu_device_unregister(&smmu->iommu);
+err_sysfs_remove:
+       iommu_device_sysfs_remove(&smmu->iommu);
+       return err;
 }

 static int arm_smmu_device_remove(struct platform_device *pdev)
diff --git a/drivers/iommu/arm/arm-smmu/qcom_iommu.c 
b/drivers/iommu/arm/arm-smmu/qcom_iommu.c
index 4294abe389b2..b785d9fb7602 100644
--- a/drivers/iommu/arm/arm-smmu/qcom_iommu.c
+++ b/drivers/iommu/arm/arm-smmu/qcom_iommu.c
@@ -850,10 +850,12 @@ static int qcom_iommu_device_probe(struct platform_device 
*pdev)
        ret = iommu_device_register(&qcom_iommu->iommu, &qcom_iommu_ops, dev);
        if (ret) {
                dev_err(dev, "Failed to register iommu\n");
-               return ret;
+               goto err_sysfs_remove;
        }

-       bus_set_iommu(&platform_bus_type, &qcom_iommu_ops);
+       ret = bus_set_iommu(&platform_bus_type, &qcom_iommu_ops);
+       if (ret)
+               goto err_unregister_device;

        if (qcom_iommu->local_base) {
                pm_runtime_get_sync(dev);
@@ -862,6 +864,13 @@ static int qcom_iommu_device_probe(struct platform_device 
*pdev)
        }

        return 0;
+
+err_unregister_device:
+       iommu_device_unregister(&qcom_iommu->iommu);
+
+err_sysfs_remove:
+       iommu_device_sysfs_remove(&qcom_iommu->iommu);
+       return ret;
 }

 static int qcom_iommu_device_remove(struct platform_device *pdev)
--
2.31.1
_______________________________________________
iommu mailing list
[email protected]
https://lists.linuxfoundation.org/mailman/listinfo/iommu

Reply via email to