1 /* 2 * Copyright (C) 2016 Red Hat 3 * Author: Rob Clark <robdclark@gmail.com> 4 * 5 * This program is free software; you can redistribute it and/or modify it 6 * under the terms of the GNU General Public License version 2 as published by 7 * the Free Software Foundation. 8 * 9 * This program is distributed in the hope that it will be useful, but WITHOUT 10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12 * more details. 13 * 14 * You should have received a copy of the GNU General Public License along with 15 * this program. If not, see <http://www.gnu.org/licenses/>. 16 */ 17 18 #include "msm_drv.h" 19 #include "msm_gem.h" 20 #include "msm_mmu.h" 21 22 static void 23 msm_gem_address_space_destroy(struct kref *kref) 24 { 25 struct msm_gem_address_space *aspace = container_of(kref, 26 struct msm_gem_address_space, kref); 27 28 drm_mm_takedown(&aspace->mm); 29 if (aspace->mmu) 30 aspace->mmu->funcs->destroy(aspace->mmu); 31 kfree(aspace); 32 } 33 34 35 void msm_gem_address_space_put(struct msm_gem_address_space *aspace) 36 { 37 if (aspace) 38 kref_put(&aspace->kref, msm_gem_address_space_destroy); 39 } 40 41 void 42 msm_gem_unmap_vma(struct msm_gem_address_space *aspace, 43 struct msm_gem_vma *vma) 44 { 45 if (!aspace || !vma->iova) 46 return; 47 48 if (aspace->mmu) { 49 unsigned size = vma->node.size << PAGE_SHIFT; 50 aspace->mmu->funcs->unmap(aspace->mmu, vma->iova, size); 51 } 52 53 spin_lock(&aspace->lock); 54 drm_mm_remove_node(&vma->node); 55 spin_unlock(&aspace->lock); 56 57 vma->iova = 0; 58 vma->mapped = false; 59 60 msm_gem_address_space_put(aspace); 61 } 62 63 int 64 msm_gem_map_vma(struct msm_gem_address_space *aspace, 65 struct msm_gem_vma *vma, struct sg_table *sgt, int npages) 66 { 67 unsigned size = npages << PAGE_SHIFT; 68 int ret = 0; 69 70 if (WARN_ON(!vma->iova)) 71 return -EINVAL; 72 73 if (vma->mapped) 74 return 0; 75 76 vma->mapped = true; 77 78 if (aspace->mmu) 79 ret = aspace->mmu->funcs->map(aspace->mmu, vma->iova, sgt, 80 size, IOMMU_READ | IOMMU_WRITE); 81 82 if (ret) 83 vma->mapped = false; 84 85 return ret; 86 } 87 88 /* Initialize a new vma and allocate an iova for it */ 89 int msm_gem_init_vma(struct msm_gem_address_space *aspace, 90 struct msm_gem_vma *vma, int npages) 91 { 92 int ret; 93 94 if (WARN_ON(vma->iova)) 95 return -EBUSY; 96 97 spin_lock(&aspace->lock); 98 ret = drm_mm_insert_node(&aspace->mm, &vma->node, npages); 99 spin_unlock(&aspace->lock); 100 101 if (ret) 102 return ret; 103 104 vma->iova = vma->node.start << PAGE_SHIFT; 105 vma->mapped = false; 106 107 kref_get(&aspace->kref); 108 109 return 0; 110 } 111 112 struct msm_gem_address_space * 113 msm_gem_address_space_create(struct device *dev, struct iommu_domain *domain, 114 const char *name) 115 { 116 struct msm_gem_address_space *aspace; 117 u64 size = domain->geometry.aperture_end - 118 domain->geometry.aperture_start; 119 120 aspace = kzalloc(sizeof(*aspace), GFP_KERNEL); 121 if (!aspace) 122 return ERR_PTR(-ENOMEM); 123 124 spin_lock_init(&aspace->lock); 125 aspace->name = name; 126 aspace->mmu = msm_iommu_new(dev, domain); 127 128 drm_mm_init(&aspace->mm, (domain->geometry.aperture_start >> PAGE_SHIFT), 129 size >> PAGE_SHIFT); 130 131 kref_init(&aspace->kref); 132 133 return aspace; 134 } 135