72a130bc448aa97adb1ca35a2dfff09a102b717d
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / virt / kvm / iommu.c
1 /*
2 * Copyright (c) 2006, Intel Corporation.
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms and conditions of the GNU General Public License,
6 * version 2, as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope it will be useful, but WITHOUT
9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
11 * more details.
12 *
13 * You should have received a copy of the GNU General Public License along with
14 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
15 * Place - Suite 330, Boston, MA 02111-1307 USA.
16 *
17 * Copyright (C) 2006-2008 Intel Corporation
18 * Copyright IBM Corporation, 2008
19 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
20 *
21 * Author: Allen M. Kay <allen.m.kay@intel.com>
22 * Author: Weidong Han <weidong.han@intel.com>
23 * Author: Ben-Ami Yassour <benami@il.ibm.com>
24 */
25
26 #include <linux/list.h>
27 #include <linux/kvm_host.h>
28 #include <linux/module.h>
29 #include <linux/pci.h>
30 #include <linux/stat.h>
31 #include <linux/dmar.h>
32 #include <linux/iommu.h>
33 #include <linux/intel-iommu.h>
34
35 static bool allow_unsafe_assigned_interrupts;
36 module_param_named(allow_unsafe_assigned_interrupts,
37 allow_unsafe_assigned_interrupts, bool, S_IRUGO | S_IWUSR);
38 MODULE_PARM_DESC(allow_unsafe_assigned_interrupts,
39 "Enable device assignment on platforms without interrupt remapping support.");
40
41 static int kvm_iommu_unmap_memslots(struct kvm *kvm);
42 static void kvm_iommu_put_pages(struct kvm *kvm,
43 gfn_t base_gfn, unsigned long npages);
44
45 static pfn_t kvm_pin_pages(struct kvm_memory_slot *slot, gfn_t gfn,
46 unsigned long size)
47 {
48 gfn_t end_gfn;
49 pfn_t pfn;
50
51 pfn = gfn_to_pfn_memslot(slot, gfn);
52 end_gfn = gfn + (size >> PAGE_SHIFT);
53 gfn += 1;
54
55 if (is_error_noslot_pfn(pfn))
56 return pfn;
57
58 while (gfn < end_gfn)
59 gfn_to_pfn_memslot(slot, gfn++);
60
61 return pfn;
62 }
63
64 int kvm_iommu_map_pages(struct kvm *kvm, struct kvm_memory_slot *slot)
65 {
66 gfn_t gfn, end_gfn;
67 pfn_t pfn;
68 int r = 0;
69 struct iommu_domain *domain = kvm->arch.iommu_domain;
70 int flags;
71
72 /* check if iommu exists and in use */
73 if (!domain)
74 return 0;
75
76 gfn = slot->base_gfn;
77 end_gfn = gfn + slot->npages;
78
79 flags = IOMMU_READ;
80 if (!(slot->flags & KVM_MEM_READONLY))
81 flags |= IOMMU_WRITE;
82 if (kvm->arch.iommu_flags & KVM_IOMMU_CACHE_COHERENCY)
83 flags |= IOMMU_CACHE;
84
85
86 while (gfn < end_gfn) {
87 unsigned long page_size;
88
89 /* Check if already mapped */
90 if (iommu_iova_to_phys(domain, gfn_to_gpa(gfn))) {
91 gfn += 1;
92 continue;
93 }
94
95 /* Get the page size we could use to map */
96 page_size = kvm_host_page_size(kvm, gfn);
97
98 /* Make sure the page_size does not exceed the memslot */
99 while ((gfn + (page_size >> PAGE_SHIFT)) > end_gfn)
100 page_size >>= 1;
101
102 /* Make sure gfn is aligned to the page size we want to map */
103 while ((gfn << PAGE_SHIFT) & (page_size - 1))
104 page_size >>= 1;
105
106 /*
107 * Pin all pages we are about to map in memory. This is
108 * important because we unmap and unpin in 4kb steps later.
109 */
110 pfn = kvm_pin_pages(slot, gfn, page_size);
111 if (is_error_noslot_pfn(pfn)) {
112 gfn += 1;
113 continue;
114 }
115
116 /* Map into IO address space */
117 r = iommu_map(domain, gfn_to_gpa(gfn), pfn_to_hpa(pfn),
118 page_size, flags);
119 if (r) {
120 printk(KERN_ERR "kvm_iommu_map_address:"
121 "iommu failed to map pfn=%llx\n", pfn);
122 goto unmap_pages;
123 }
124
125 gfn += page_size >> PAGE_SHIFT;
126
127
128 }
129
130 return 0;
131
132 unmap_pages:
133 kvm_iommu_put_pages(kvm, slot->base_gfn, gfn);
134 return r;
135 }
136
137 static int kvm_iommu_map_memslots(struct kvm *kvm)
138 {
139 int idx, r = 0;
140 struct kvm_memslots *slots;
141 struct kvm_memory_slot *memslot;
142
143 idx = srcu_read_lock(&kvm->srcu);
144 slots = kvm_memslots(kvm);
145
146 kvm_for_each_memslot(memslot, slots) {
147 r = kvm_iommu_map_pages(kvm, memslot);
148 if (r)
149 break;
150 }
151 srcu_read_unlock(&kvm->srcu, idx);
152
153 return r;
154 }
155
156 int kvm_assign_device(struct kvm *kvm,
157 struct kvm_assigned_dev_kernel *assigned_dev)
158 {
159 struct pci_dev *pdev = NULL;
160 struct iommu_domain *domain = kvm->arch.iommu_domain;
161 int r, last_flags;
162
163 /* check if iommu exists and in use */
164 if (!domain)
165 return 0;
166
167 pdev = assigned_dev->dev;
168 if (pdev == NULL)
169 return -ENODEV;
170
171 r = iommu_attach_device(domain, &pdev->dev);
172 if (r) {
173 dev_err(&pdev->dev, "kvm assign device failed ret %d", r);
174 return r;
175 }
176
177 last_flags = kvm->arch.iommu_flags;
178 if (iommu_domain_has_cap(kvm->arch.iommu_domain,
179 IOMMU_CAP_CACHE_COHERENCY))
180 kvm->arch.iommu_flags |= KVM_IOMMU_CACHE_COHERENCY;
181
182 /* Check if need to update IOMMU page table for guest memory */
183 if ((last_flags ^ kvm->arch.iommu_flags) ==
184 KVM_IOMMU_CACHE_COHERENCY) {
185 kvm_iommu_unmap_memslots(kvm);
186 r = kvm_iommu_map_memslots(kvm);
187 if (r)
188 goto out_unmap;
189 }
190
191 pdev->dev_flags |= PCI_DEV_FLAGS_ASSIGNED;
192
193 printk(KERN_DEBUG "assign device %x:%x:%x.%x\n",
194 assigned_dev->host_segnr,
195 assigned_dev->host_busnr,
196 PCI_SLOT(assigned_dev->host_devfn),
197 PCI_FUNC(assigned_dev->host_devfn));
198
199 return 0;
200 out_unmap:
201 kvm_iommu_unmap_memslots(kvm);
202 return r;
203 }
204
205 int kvm_deassign_device(struct kvm *kvm,
206 struct kvm_assigned_dev_kernel *assigned_dev)
207 {
208 struct iommu_domain *domain = kvm->arch.iommu_domain;
209 struct pci_dev *pdev = NULL;
210
211 /* check if iommu exists and in use */
212 if (!domain)
213 return 0;
214
215 pdev = assigned_dev->dev;
216 if (pdev == NULL)
217 return -ENODEV;
218
219 iommu_detach_device(domain, &pdev->dev);
220
221 pdev->dev_flags &= ~PCI_DEV_FLAGS_ASSIGNED;
222
223 printk(KERN_DEBUG "deassign device %x:%x:%x.%x\n",
224 assigned_dev->host_segnr,
225 assigned_dev->host_busnr,
226 PCI_SLOT(assigned_dev->host_devfn),
227 PCI_FUNC(assigned_dev->host_devfn));
228
229 return 0;
230 }
231
232 int kvm_iommu_map_guest(struct kvm *kvm)
233 {
234 int r;
235
236 if (!iommu_present(&pci_bus_type)) {
237 printk(KERN_ERR "%s: iommu not found\n", __func__);
238 return -ENODEV;
239 }
240
241 mutex_lock(&kvm->slots_lock);
242
243 kvm->arch.iommu_domain = iommu_domain_alloc(&pci_bus_type);
244 if (!kvm->arch.iommu_domain) {
245 r = -ENOMEM;
246 goto out_unlock;
247 }
248
249 if (!allow_unsafe_assigned_interrupts &&
250 !iommu_domain_has_cap(kvm->arch.iommu_domain,
251 IOMMU_CAP_INTR_REMAP)) {
252 printk(KERN_WARNING "%s: No interrupt remapping support,"
253 " disallowing device assignment."
254 " Re-enble with \"allow_unsafe_assigned_interrupts=1\""
255 " module option.\n", __func__);
256 iommu_domain_free(kvm->arch.iommu_domain);
257 kvm->arch.iommu_domain = NULL;
258 r = -EPERM;
259 goto out_unlock;
260 }
261
262 r = kvm_iommu_map_memslots(kvm);
263 if (r)
264 kvm_iommu_unmap_memslots(kvm);
265
266 out_unlock:
267 mutex_unlock(&kvm->slots_lock);
268 return r;
269 }
270
271 static void kvm_unpin_pages(struct kvm *kvm, pfn_t pfn, unsigned long npages)
272 {
273 unsigned long i;
274
275 for (i = 0; i < npages; ++i)
276 kvm_release_pfn_clean(pfn + i);
277 }
278
279 static void kvm_iommu_put_pages(struct kvm *kvm,
280 gfn_t base_gfn, unsigned long npages)
281 {
282 struct iommu_domain *domain;
283 gfn_t end_gfn, gfn;
284 pfn_t pfn;
285 u64 phys;
286
287 domain = kvm->arch.iommu_domain;
288 end_gfn = base_gfn + npages;
289 gfn = base_gfn;
290
291 /* check if iommu exists and in use */
292 if (!domain)
293 return;
294
295 while (gfn < end_gfn) {
296 unsigned long unmap_pages;
297 size_t size;
298
299 /* Get physical address */
300 phys = iommu_iova_to_phys(domain, gfn_to_gpa(gfn));
301
302 if (!phys) {
303 gfn++;
304 continue;
305 }
306
307 pfn = phys >> PAGE_SHIFT;
308
309 /* Unmap address from IO address space */
310 size = iommu_unmap(domain, gfn_to_gpa(gfn), PAGE_SIZE);
311 unmap_pages = 1ULL << get_order(size);
312
313 /* Unpin all pages we just unmapped to not leak any memory */
314 kvm_unpin_pages(kvm, pfn, unmap_pages);
315
316 gfn += unmap_pages;
317 }
318 }
319
320 void kvm_iommu_unmap_pages(struct kvm *kvm, struct kvm_memory_slot *slot)
321 {
322 kvm_iommu_put_pages(kvm, slot->base_gfn, slot->npages);
323 }
324
325 static int kvm_iommu_unmap_memslots(struct kvm *kvm)
326 {
327 int idx;
328 struct kvm_memslots *slots;
329 struct kvm_memory_slot *memslot;
330
331 idx = srcu_read_lock(&kvm->srcu);
332 slots = kvm_memslots(kvm);
333
334 kvm_for_each_memslot(memslot, slots)
335 kvm_iommu_unmap_pages(kvm, memslot);
336
337 srcu_read_unlock(&kvm->srcu, idx);
338
339 return 0;
340 }
341
342 int kvm_iommu_unmap_guest(struct kvm *kvm)
343 {
344 struct iommu_domain *domain = kvm->arch.iommu_domain;
345
346 /* check if iommu exists and in use */
347 if (!domain)
348 return 0;
349
350 mutex_lock(&kvm->slots_lock);
351 kvm_iommu_unmap_memslots(kvm);
352 kvm->arch.iommu_domain = NULL;
353 mutex_unlock(&kvm->slots_lock);
354
355 iommu_domain_free(domain);
356 return 0;
357 }