video: rockchip: fb: delete DISPLAY_POLICY_BOX_TEMP

[firefly-linux-kernel-4.4.55.git] / drivers / iommu / rockchip-iommu.c

diff --git a/drivers/iommu/rockchip-iommu.c b/drivers/iommu/rockchip-iommu.c
index 8ed83e55f3f3a162a54057e6e9a644595ef04742..db5a66d11a3805c5bab30c2a1b640b95a76c8653 100644 (file)
--- a/drivers/iommu/rockchip-iommu.c
+++ b/drivers/iommu/rockchip-iommu.c
@@ -170,12 +170,12 @@ enum iommu_status_bits {
 
 static struct kmem_cache *lv2table_kmem_cache;
 
-static unsigned int *rockchip_section_entry(unsigned int *pgtable, unsigned int iova)
+static unsigned int *rockchip_section_entry(unsigned int *pgtable, unsigned long iova)
 {
        return pgtable + rockchip_lv1ent_offset(iova);
 }
 
-static unsigned int *rockchip_page_entry(unsigned int *sent, unsigned int iova)
+static unsigned int *rockchip_page_entry(unsigned int *sent, unsigned long iova)
 {
        return (unsigned int *)phys_to_virt(rockchip_lv2table_base(sent)) +
                rockchip_lv2ent_offset(iova);
@@ -593,6 +593,8 @@ static irqreturn_t rockchip_iommu_irq(int irq, void *dev_id)
                        if (data->domain)
                                report_iommu_fault(data->domain, data->iommu,
                                                   fault_address, flags);
+                       if (data->fault_handler)
+                               data->fault_handler(data->iommu, IOMMU_PAGEFAULT, dte, fault_address, 1);
 
                        rockchip_iommu_page_fault_done(data->res_bases[i],
                                                       data->dbgname);
@@ -754,11 +756,42 @@ static int rockchip_iommu_enable(struct iommu_drvdata *data, unsigned int pgtabl
        return 0;
 }
 
+int rockchip_iommu_tlb_invalidate_global(struct device *dev)
+{
+       unsigned long flags;
+       struct iommu_drvdata *data = dev_get_drvdata(dev->archdata.iommu);
+       int ret;
+
+       spin_lock_irqsave(&data->data_lock, flags);
+
+       if (rockchip_is_iommu_active(data)) {
+               int i;
+
+               for (i = 0; i < data->num_res_mem; i++) {
+                       ret = rockchip_iommu_zap_tlb(data->res_bases[i]);
+                       if (ret)
+                               dev_err(dev->archdata.iommu, "(%s) %s failed\n",
+                                       data->dbgname, __func__);
+               }
+       } else {
+               dev_dbg(dev->archdata.iommu, "(%s) Disabled. Skipping invalidating TLB.\n",
+                       data->dbgname);
+               ret = -1;
+       }
+
+       spin_unlock_irqrestore(&data->data_lock, flags);
+
+       return ret;
+}
+
 int rockchip_iommu_tlb_invalidate(struct device *dev)
 {
        unsigned long flags;
        struct iommu_drvdata *data = dev_get_drvdata(dev->archdata.iommu);
 
+       if (strstr(data->dbgname, "vpu") || strstr(data->dbgname, "hevc"))
+                       return 0;
+
        spin_lock_irqsave(&data->data_lock, flags);
 
        if (rockchip_is_iommu_active(data)) {
@@ -789,7 +822,7 @@ static phys_addr_t rockchip_iommu_iova_to_phys(struct iommu_domain *domain,
                                               dma_addr_t iova)
 {
        struct rk_iommu_domain *priv = domain->priv;
-       unsigned long *entry;
+       unsigned int *entry;
        unsigned long flags;
        phys_addr_t phys = 0;
 
@@ -816,8 +849,8 @@ static int rockchip_lv2set_page(unsigned int *pent, phys_addr_t paddr,
        return 0;
 }
 
-static unsigned long *rockchip_alloc_lv2entry(unsigned int *sent,
-                                    unsigned int iova, short *pgcounter)
+static unsigned int *rockchip_alloc_lv2entry(unsigned int *sent,
+                                    unsigned long iova, short *pgcounter)
 {
        if (rockchip_lv1ent_fault(sent)) {
                unsigned int *pent;
@@ -837,7 +870,7 @@ static unsigned long *rockchip_alloc_lv2entry(unsigned int *sent,
 }
 
 static size_t rockchip_iommu_unmap(struct iommu_domain *domain,
-                                  unsigned int iova, size_t size)
+                                  unsigned long iova, size_t size)
 {
        struct rk_iommu_domain *priv = domain->priv;
        unsigned long flags;
@@ -870,7 +903,7 @@ static size_t rockchip_iommu_unmap(struct iommu_domain *domain,
        goto done;
 
 done:
-       pr_debug("%s:unmap iova 0x%lx/0x%x bytes\n",
+       pr_debug("%s:unmap iova 0x%lx/%zx bytes\n",
                  __func__, iova,size);
        spin_unlock_irqrestore(&priv->pgtablelock, flags);
 
@@ -932,8 +965,9 @@ static void rockchip_iommu_detach_device(struct iommu_domain *domain, struct dev
        }
 
        if (rockchip_iommu_disable(data)) {
-               dev_dbg(dev->archdata.iommu,"%s: Detached IOMMU with pgtable %08lx\n",
-                       __func__, (unsigned long)virt_to_phys(priv->pgtable));
+               if (!(strstr(data->dbgname, "vpu") || strstr(data->dbgname, "hevc")))
+                       dev_dbg(dev->archdata.iommu,"%s: Detached IOMMU with pgtable %08lx\n",
+                               __func__, (unsigned long)virt_to_phys(priv->pgtable));
                data->domain = NULL;
                list_del_init(&data->node);
 
@@ -971,8 +1005,9 @@ static int rockchip_iommu_attach_device(struct iommu_domain *domain, struct devi
                dev_dbg(dev->archdata.iommu,"%s: IOMMU with pgtable 0x%x already attached\n",
                        __func__, (unsigned int)virt_to_phys(priv->pgtable));
        } else {
-               dev_info(dev->archdata.iommu,"%s: Attached new IOMMU with pgtable 0x%x\n",
-                       __func__, (unsigned int)virt_to_phys(priv->pgtable));
+               if (!(strstr(data->dbgname, "vpu") || strstr(data->dbgname, "hevc")))
+                       dev_info(dev->archdata.iommu,"%s: Attached new IOMMU with pgtable 0x%x\n",
+                               __func__, (unsigned int)virt_to_phys(priv->pgtable));
        }
 
        return ret;
@@ -1035,13 +1070,13 @@ err_pgtable:
 }
 
 static struct iommu_ops rk_iommu_ops = {
-       .domain_init = &rockchip_iommu_domain_init,
-       .domain_destroy = &rockchip_iommu_domain_destroy,
-       .attach_dev = &rockchip_iommu_attach_device,
-       .detach_dev = &rockchip_iommu_detach_device,
-       .map = &rockchip_iommu_map,
-       .unmap = &rockchip_iommu_unmap,
-       .iova_to_phys = &rockchip_iommu_iova_to_phys,
+       .domain_init = rockchip_iommu_domain_init,
+       .domain_destroy = rockchip_iommu_domain_destroy,
+       .attach_dev = rockchip_iommu_attach_device,
+       .detach_dev = rockchip_iommu_detach_device,
+       .map = rockchip_iommu_map,
+       .unmap = rockchip_iommu_unmap,
+       .iova_to_phys = rockchip_iommu_iova_to_phys,
        .pgsize_bitmap = SPAGE_SIZE,
 };
 
@@ -1124,14 +1159,14 @@ static int rockchip_iommu_probe(struct platform_device *pdev)
                        return -ENOMEM;
                }
 
-               dev_dbg(dev,"res->start = 0x%pa ioremap to data->res_bases[%d] = 0x%08x\n",
-                       &res->start, i, (unsigned int)data->res_bases[i]);
+               dev_dbg(dev,"res->start = 0x%pa ioremap to data->res_bases[%d] = %p\n",
+                       &res->start, i, data->res_bases[i]);
 
                if (strstr(data->dbgname, "vop") &&
                    (soc_is_rk3128() || soc_is_rk3126())) {
                        rk312x_vop_mmu_base = data->res_bases[0];
-                       dev_dbg(dev, "rk312x_vop_mmu_base = 0x%08x\n",
-                               (unsigned int)rk312x_vop_mmu_base);
+                       dev_dbg(dev, "rk312x_vop_mmu_base = %p\n",
+                               rk312x_vop_mmu_base);
                }
        }