From: Navneet Kumar <[email protected]>

Allow creating identity and DMA API compatible IOMMU domains. When
creating a DMA API compatible domain, make sure to also create the
required cookie.

Signed-off-by: Navneet Kumar <[email protected]>
Signed-off-by: Thierry Reding <[email protected]>
---
 drivers/iommu/tegra-smmu.c | 47 ++++++++++++++++++++++++--------------
 1 file changed, 30 insertions(+), 17 deletions(-)

diff --git a/drivers/iommu/tegra-smmu.c b/drivers/iommu/tegra-smmu.c
index 6bf7654371c5..40647e1f03ae 100644
--- a/drivers/iommu/tegra-smmu.c
+++ b/drivers/iommu/tegra-smmu.c
@@ -16,6 +16,7 @@
 #include <linux/slab.h>
 #include <linux/spinlock.h>
 #include <linux/dma-mapping.h>
+#include <linux/dma-iommu.h>
 
 #include <soc/tegra/ahb.h>
 #include <soc/tegra/mc.h>
@@ -281,8 +282,11 @@ static bool tegra_smmu_capable(enum iommu_cap cap)
 static struct iommu_domain *tegra_smmu_domain_alloc(unsigned type)
 {
        struct tegra_smmu_as *as;
+       int ret;
 
-       if (type != IOMMU_DOMAIN_UNMANAGED)
+       if (type != IOMMU_DOMAIN_UNMANAGED &&
+           type != IOMMU_DOMAIN_DMA &&
+           type != IOMMU_DOMAIN_IDENTITY)
                return NULL;
 
        as = kzalloc(sizeof(*as), GFP_KERNEL);
@@ -291,26 +295,23 @@ static struct iommu_domain 
*tegra_smmu_domain_alloc(unsigned type)
 
        as->attr = SMMU_PD_READABLE | SMMU_PD_WRITABLE | SMMU_PD_NONSECURE;
 
-       as->pd = alloc_page(GFP_KERNEL | __GFP_DMA | __GFP_ZERO);
-       if (!as->pd) {
-               kfree(as);
-               return NULL;
+       if (type == IOMMU_DOMAIN_DMA) {
+               ret = iommu_get_dma_cookie(&as->domain);
+               if (ret)
+                       goto free_as;
        }
 
+       as->pd = alloc_page(GFP_KERNEL | __GFP_DMA | __GFP_ZERO);
+       if (!as->pd)
+               goto put_dma_cookie;
+
        as->count = kcalloc(SMMU_NUM_PDE, sizeof(u32), GFP_KERNEL);
-       if (!as->count) {
-               __free_page(as->pd);
-               kfree(as);
-               return NULL;
-       }
+       if (!as->count)
+               goto free_pd_range;
 
        as->pts = kcalloc(SMMU_NUM_PDE, sizeof(*as->pts), GFP_KERNEL);
-       if (!as->pts) {
-               kfree(as->count);
-               __free_page(as->pd);
-               kfree(as);
-               return NULL;
-       }
+       if (!as->pts)
+               goto free_pts;
 
        spin_lock_init(&as->lock);
 
@@ -320,6 +321,18 @@ static struct iommu_domain 
*tegra_smmu_domain_alloc(unsigned type)
        as->domain.geometry.force_aperture = true;
 
        return &as->domain;
+
+free_pts:
+       kfree(as->pts);
+free_pd_range:
+       __free_page(as->pd);
+put_dma_cookie:
+       if (type == IOMMU_DOMAIN_DMA)
+               iommu_put_dma_cookie(&as->domain);
+free_as:
+       kfree(as);
+
+       return NULL;
 }
 
 static void tegra_smmu_domain_free(struct iommu_domain *domain)
@@ -1051,7 +1064,7 @@ static const struct iommu_ops tegra_smmu_ops = {
        .map = tegra_smmu_map,
        .unmap = tegra_smmu_unmap,
        .iova_to_phys = tegra_smmu_iova_to_phys,
-       .get_resv_regions = of_iommu_get_resv_regions,
+       .get_resv_regions = iommu_dma_get_resv_regions,
        .put_resv_regions = generic_iommu_put_resv_regions,
        .apply_resv_region = tegra_smmu_apply_resv_region,
        .of_xlate = tegra_smmu_of_xlate,
-- 
2.30.2

_______________________________________________
iommu mailing list
[email protected]
https://lists.linuxfoundation.org/mailman/listinfo/iommu

Reply via email to