git.openwrt.org Git - openwrt/staging/jogo.git/blob

   1 From 02638b2627104cd02aff7484bb250d029e05dc5f Mon Sep 17 00:00:00 2001
   2 From: Laurentiu Tudor <laurentiu.tudor@nxp.com>
   3 Date: Tue, 3 Apr 2018 18:08:48 +0300
   4 Subject: [PATCH] soc/fsl/qman: map FQD and PFDR areas in the iommu
   5
   6 Add a one-to-one iommu mapping for qman private data memory areas
   7 (FQD and PFDR). This is required for QMAN to work without faults
   8 behind an iommu.
   9
  10 Signed-off-by: Laurentiu Tudor <laurentiu.tudor@nxp.com>
  11 ---
  12  drivers/soc/fsl/qbman/qman_ccsr.c | 15 +++++++++++++++
  13  1 file changed, 15 insertions(+)
  14
  15 --- a/drivers/soc/fsl/qbman/qman_ccsr.c
  16 +++ b/drivers/soc/fsl/qbman/qman_ccsr.c
  17 @@ -29,6 +29,7 @@
  18   */
  19
  20  #include "qman_priv.h"
  21 +#include <linux/iommu.h>
  22
  23  u16 qman_ip_rev;
  24  EXPORT_SYMBOL(qman_ip_rev);
  25 @@ -755,6 +756,7 @@ static int fsl_qman_probe(struct platfor
  26  {
  27         struct device *dev = &pdev->dev;
  28         struct device_node *node = dev->of_node;
  29 +       struct iommu_domain *domain;
  30         struct resource *res;
  31         int ret, err_irq;
  32         u16 id;
  33 @@ -834,6 +836,19 @@ static int fsl_qman_probe(struct platfor
  34         }
  35         dev_dbg(dev, "Allocated PFDR 0x%llx 0x%zx\n", pfdr_a, pfdr_sz);
  36
  37 +       /* Create an 1-to-1 iommu mapping for fqd and pfdr areas */
  38 +       domain = iommu_get_domain_for_dev(dev);
  39 +       if (domain) {
  40 +               ret = iommu_map(domain, fqd_a, fqd_a, fqd_sz,
  41 +                               IOMMU_READ | IOMMU_WRITE | IOMMU_CACHE);
  42 +               if (ret)
  43 +                       dev_warn(dev, "iommu_map(fqd) failed %d\n", ret);
  44 +               ret = iommu_map(domain, pfdr_a, pfdr_a, pfdr_sz,
  45 +                               IOMMU_READ | IOMMU_WRITE | IOMMU_CACHE);
  46 +               if (ret)
  47 +                       dev_warn(dev, "iommu_map(pfdr) failed %d\n", ret);
  48 +       }
  49 +
  50         ret = qman_init_ccsr(dev);
  51         if (ret) {
  52                 dev_err(dev, "CCSR setup failed\n");