[PATCH 04/13] soc/fsl/qman-portal: map CENA area in the iommu

[laurentiu . tudor]

From: Laurentiu Tudor <laurentiu.tu...@nxp.com>

Add a one-to-one iommu mapping for qman portal CENA register area.
This is required for QMAN stashing to work without faults behind
an iommu.

Signed-off-by: Laurentiu Tudor <laurentiu.tu...@nxp.com>
---
 drivers/soc/fsl/qbman/qman_portal.c | 17 +++++++++++++++++
 1 file changed, 17 insertions(+)

diff --git a/drivers/soc/fsl/qbman/qman_portal.c 
b/drivers/soc/fsl/qbman/qman_portal.c
index 661c9b234d32..dfb62f9815e9 100644
--- a/drivers/soc/fsl/qbman/qman_portal.c
+++ b/drivers/soc/fsl/qbman/qman_portal.c
@@ -29,6 +29,7 @@
  */
 
 #include "qman_priv.h"
+#include <linux/iommu.h>
 
 struct qman_portal *qman_dma_portal;
 EXPORT_SYMBOL(qman_dma_portal);
@@ -224,6 +225,7 @@ static int qman_portal_probe(struct platform_device *pdev)
 {
        struct device *dev = &pdev->dev;
        struct device_node *node = dev->of_node;
+       struct iommu_domain *domain;
        struct qm_portal_config *pcfg;
        struct resource *addr_phys[2];
        int irq, cpu, err;
@@ -286,6 +288,21 @@ static int qman_portal_probe(struct platform_device *pdev)
                goto err_ioremap2;
        }
 
+       /* Create an 1-to-1 iommu mapping for cena portal area */
+       domain = iommu_get_domain_for_dev(dev);
+       if (domain) {
+               /*
+                * Note: not mapping this as cacheable triggers the infamous
+                * QMan CIDE error.
+                */
+               err = iommu_map(domain,
+                               addr_phys[0]->start, addr_phys[0]->start,
+                               resource_size(addr_phys[0]),
+                               IOMMU_READ | IOMMU_WRITE | IOMMU_CACHE);
+               if (err)
+                       dev_warn(dev, "failed to iommu_map() %d\n", err);
+       }
+
        pcfg->pools = qm_get_pools_sdqcr();
 
        spin_lock(&qman_lock);
-- 
2.17.1