1caab277bSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 2871d812aSRob Clark /* 3871d812aSRob Clark * Copyright (C) 2013 Red Hat 4871d812aSRob Clark * Author: Rob Clark <robdclark@gmail.com> 5871d812aSRob Clark */ 6871d812aSRob Clark 7871d812aSRob Clark #include "msm_drv.h" 8871d812aSRob Clark #include "msm_mmu.h" 9871d812aSRob Clark 10871d812aSRob Clark struct msm_iommu { 11871d812aSRob Clark struct msm_mmu base; 12871d812aSRob Clark struct iommu_domain *domain; 13871d812aSRob Clark }; 14871d812aSRob Clark #define to_msm_iommu(x) container_of(x, struct msm_iommu, base) 15871d812aSRob Clark 167f8036b7SRob Clark static int msm_fault_handler(struct iommu_domain *domain, struct device *dev, 17871d812aSRob Clark unsigned long iova, int flags, void *arg) 18871d812aSRob Clark { 197f8036b7SRob Clark struct msm_iommu *iommu = arg; 207f8036b7SRob Clark if (iommu->base.handler) 217f8036b7SRob Clark return iommu->base.handler(iommu->base.arg, iova, flags); 22bdad5c53SJordan Crouse pr_warn_ratelimited("*** fault: iova=%16lx, flags=%d\n", iova, flags); 236814dbf9SRob Clark return 0; 24871d812aSRob Clark } 25871d812aSRob Clark 26*53bf7f7aSDrew Davenport static int msm_iommu_attach(struct msm_mmu *mmu) 27871d812aSRob Clark { 28871d812aSRob Clark struct msm_iommu *iommu = to_msm_iommu(mmu); 29cc692726SRob Clark 30a6bb79abSJordan Crouse return iommu_attach_device(iommu->domain, mmu->dev); 31871d812aSRob Clark } 32871d812aSRob Clark 33*53bf7f7aSDrew Davenport static void msm_iommu_detach(struct msm_mmu *mmu) 3487e956e9SStephane Viau { 3587e956e9SStephane Viau struct msm_iommu *iommu = to_msm_iommu(mmu); 36cc692726SRob Clark 37944fc36cSRob Clark iommu_detach_device(iommu->domain, mmu->dev); 3887e956e9SStephane Viau } 3987e956e9SStephane Viau 4078babc16SRob Clark static int msm_iommu_map(struct msm_mmu *mmu, uint64_t iova, 41871d812aSRob Clark struct sg_table *sgt, unsigned len, int prot) 42871d812aSRob Clark { 43871d812aSRob Clark struct msm_iommu *iommu = to_msm_iommu(mmu); 44f9000049SRob Clark size_t ret; 45871d812aSRob Clark 46f9000049SRob Clark ret = iommu_map_sg(iommu->domain, iova, sgt->sgl, sgt->nents, prot); 47098336deSWen Yang WARN_ON(!ret); 48871d812aSRob Clark 49f9000049SRob Clark return (ret == len) ? 0 : -EINVAL; 50871d812aSRob Clark } 51871d812aSRob Clark 5270dc51b4SJordan Crouse static int msm_iommu_unmap(struct msm_mmu *mmu, uint64_t iova, unsigned len) 53871d812aSRob Clark { 54871d812aSRob Clark struct msm_iommu *iommu = to_msm_iommu(mmu); 55871d812aSRob Clark 56f9000049SRob Clark iommu_unmap(iommu->domain, iova, len); 57871d812aSRob Clark 58871d812aSRob Clark return 0; 59871d812aSRob Clark } 60871d812aSRob Clark 61871d812aSRob Clark static void msm_iommu_destroy(struct msm_mmu *mmu) 62871d812aSRob Clark { 63871d812aSRob Clark struct msm_iommu *iommu = to_msm_iommu(mmu); 64871d812aSRob Clark iommu_domain_free(iommu->domain); 65871d812aSRob Clark kfree(iommu); 66871d812aSRob Clark } 67871d812aSRob Clark 68871d812aSRob Clark static const struct msm_mmu_funcs funcs = { 69871d812aSRob Clark .attach = msm_iommu_attach, 7087e956e9SStephane Viau .detach = msm_iommu_detach, 71871d812aSRob Clark .map = msm_iommu_map, 72871d812aSRob Clark .unmap = msm_iommu_unmap, 73871d812aSRob Clark .destroy = msm_iommu_destroy, 74871d812aSRob Clark }; 75871d812aSRob Clark 76944fc36cSRob Clark struct msm_mmu *msm_iommu_new(struct device *dev, struct iommu_domain *domain) 77871d812aSRob Clark { 78871d812aSRob Clark struct msm_iommu *iommu; 79871d812aSRob Clark 80871d812aSRob Clark iommu = kzalloc(sizeof(*iommu), GFP_KERNEL); 81871d812aSRob Clark if (!iommu) 82871d812aSRob Clark return ERR_PTR(-ENOMEM); 83871d812aSRob Clark 84871d812aSRob Clark iommu->domain = domain; 85871d812aSRob Clark msm_mmu_init(&iommu->base, dev, &funcs); 867f8036b7SRob Clark iommu_set_fault_handler(domain, msm_fault_handler, iommu); 87871d812aSRob Clark 88871d812aSRob Clark return &iommu->base; 89871d812aSRob Clark } 90