Commit | Line | Data |
---|---|---|
62c476c7 BAY |
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 | |
221d059d AK |
19 | * Copyright 2010 Red Hat, Inc. and/or its affiliates. |
20 | * | |
62c476c7 BAY |
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/pci.h> | |
29 | #include <linux/dmar.h> | |
19de40a8 | 30 | #include <linux/iommu.h> |
62c476c7 BAY |
31 | #include <linux/intel-iommu.h> |
32 | ||
33 | static int kvm_iommu_unmap_memslots(struct kvm *kvm); | |
34 | static void kvm_iommu_put_pages(struct kvm *kvm, | |
35 | gfn_t base_gfn, unsigned long npages); | |
36 | ||
fcd95807 JR |
37 | static pfn_t kvm_pin_pages(struct kvm *kvm, struct kvm_memory_slot *slot, |
38 | gfn_t gfn, unsigned long size) | |
39 | { | |
40 | gfn_t end_gfn; | |
41 | pfn_t pfn; | |
42 | ||
43 | pfn = gfn_to_pfn_memslot(kvm, slot, gfn); | |
44 | end_gfn = gfn + (size >> PAGE_SHIFT); | |
45 | gfn += 1; | |
46 | ||
47 | if (is_error_pfn(pfn)) | |
48 | return pfn; | |
49 | ||
50 | while (gfn < end_gfn) | |
51 | gfn_to_pfn_memslot(kvm, slot, gfn++); | |
52 | ||
53 | return pfn; | |
54 | } | |
55 | ||
3ad26d81 | 56 | int kvm_iommu_map_pages(struct kvm *kvm, struct kvm_memory_slot *slot) |
62c476c7 | 57 | { |
fcd95807 | 58 | gfn_t gfn, end_gfn; |
62c476c7 | 59 | pfn_t pfn; |
fcd95807 | 60 | int r = 0; |
19de40a8 | 61 | struct iommu_domain *domain = kvm->arch.iommu_domain; |
522c68c4 | 62 | int flags; |
62c476c7 BAY |
63 | |
64 | /* check if iommu exists and in use */ | |
65 | if (!domain) | |
66 | return 0; | |
67 | ||
fcd95807 JR |
68 | gfn = slot->base_gfn; |
69 | end_gfn = gfn + slot->npages; | |
70 | ||
522c68c4 SY |
71 | flags = IOMMU_READ | IOMMU_WRITE; |
72 | if (kvm->arch.iommu_flags & KVM_IOMMU_CACHE_COHERENCY) | |
73 | flags |= IOMMU_CACHE; | |
74 | ||
fcd95807 JR |
75 | |
76 | while (gfn < end_gfn) { | |
77 | unsigned long page_size; | |
78 | ||
79 | /* Check if already mapped */ | |
80 | if (iommu_iova_to_phys(domain, gfn_to_gpa(gfn))) { | |
81 | gfn += 1; | |
82 | continue; | |
83 | } | |
84 | ||
85 | /* Get the page size we could use to map */ | |
86 | page_size = kvm_host_page_size(kvm, gfn); | |
87 | ||
88 | /* Make sure the page_size does not exceed the memslot */ | |
89 | while ((gfn + (page_size >> PAGE_SHIFT)) > end_gfn) | |
90 | page_size >>= 1; | |
91 | ||
92 | /* Make sure gfn is aligned to the page size we want to map */ | |
93 | while ((gfn << PAGE_SHIFT) & (page_size - 1)) | |
94 | page_size >>= 1; | |
95 | ||
96 | /* | |
97 | * Pin all pages we are about to map in memory. This is | |
98 | * important because we unmap and unpin in 4kb steps later. | |
99 | */ | |
100 | pfn = kvm_pin_pages(kvm, slot, gfn, page_size); | |
101 | if (is_error_pfn(pfn)) { | |
102 | gfn += 1; | |
62c476c7 | 103 | continue; |
fcd95807 | 104 | } |
62c476c7 | 105 | |
fcd95807 JR |
106 | /* Map into IO address space */ |
107 | r = iommu_map(domain, gfn_to_gpa(gfn), pfn_to_hpa(pfn), | |
108 | get_order(page_size), flags); | |
e5fcfc82 | 109 | if (r) { |
260782bc | 110 | printk(KERN_ERR "kvm_iommu_map_address:" |
e5fcfc82 | 111 | "iommu failed to map pfn=%lx\n", pfn); |
62c476c7 BAY |
112 | goto unmap_pages; |
113 | } | |
fcd95807 JR |
114 | |
115 | gfn += page_size >> PAGE_SHIFT; | |
116 | ||
117 | ||
62c476c7 | 118 | } |
fcd95807 | 119 | |
62c476c7 BAY |
120 | return 0; |
121 | ||
122 | unmap_pages: | |
fcd95807 | 123 | kvm_iommu_put_pages(kvm, slot->base_gfn, gfn); |
62c476c7 BAY |
124 | return r; |
125 | } | |
126 | ||
127 | static int kvm_iommu_map_memslots(struct kvm *kvm) | |
128 | { | |
95c87e2b | 129 | int i, idx, r = 0; |
46a26bf5 | 130 | struct kvm_memslots *slots; |
62c476c7 | 131 | |
95c87e2b | 132 | idx = srcu_read_lock(&kvm->srcu); |
90d83dc3 | 133 | slots = kvm_memslots(kvm); |
46a26bf5 MT |
134 | |
135 | for (i = 0; i < slots->nmemslots; i++) { | |
3ad26d81 | 136 | r = kvm_iommu_map_pages(kvm, &slots->memslots[i]); |
62c476c7 BAY |
137 | if (r) |
138 | break; | |
139 | } | |
95c87e2b | 140 | srcu_read_unlock(&kvm->srcu, idx); |
682edb4c | 141 | |
62c476c7 BAY |
142 | return r; |
143 | } | |
144 | ||
260782bc WH |
145 | int kvm_assign_device(struct kvm *kvm, |
146 | struct kvm_assigned_dev_kernel *assigned_dev) | |
62c476c7 BAY |
147 | { |
148 | struct pci_dev *pdev = NULL; | |
19de40a8 | 149 | struct iommu_domain *domain = kvm->arch.iommu_domain; |
522c68c4 | 150 | int r, last_flags; |
62c476c7 | 151 | |
260782bc WH |
152 | /* check if iommu exists and in use */ |
153 | if (!domain) | |
154 | return 0; | |
155 | ||
156 | pdev = assigned_dev->dev; | |
157 | if (pdev == NULL) | |
62c476c7 | 158 | return -ENODEV; |
260782bc | 159 | |
19de40a8 | 160 | r = iommu_attach_device(domain, &pdev->dev); |
260782bc | 161 | if (r) { |
ab9f4ecb ZE |
162 | printk(KERN_ERR "assign device %x:%x:%x.%x failed", |
163 | pci_domain_nr(pdev->bus), | |
260782bc WH |
164 | pdev->bus->number, |
165 | PCI_SLOT(pdev->devfn), | |
166 | PCI_FUNC(pdev->devfn)); | |
167 | return r; | |
62c476c7 BAY |
168 | } |
169 | ||
522c68c4 SY |
170 | last_flags = kvm->arch.iommu_flags; |
171 | if (iommu_domain_has_cap(kvm->arch.iommu_domain, | |
172 | IOMMU_CAP_CACHE_COHERENCY)) | |
173 | kvm->arch.iommu_flags |= KVM_IOMMU_CACHE_COHERENCY; | |
174 | ||
175 | /* Check if need to update IOMMU page table for guest memory */ | |
176 | if ((last_flags ^ kvm->arch.iommu_flags) == | |
177 | KVM_IOMMU_CACHE_COHERENCY) { | |
178 | kvm_iommu_unmap_memslots(kvm); | |
179 | r = kvm_iommu_map_memslots(kvm); | |
180 | if (r) | |
181 | goto out_unmap; | |
182 | } | |
183 | ||
ab9f4ecb ZE |
184 | printk(KERN_DEBUG "assign device %x:%x:%x.%x\n", |
185 | assigned_dev->host_segnr, | |
260782bc WH |
186 | assigned_dev->host_busnr, |
187 | PCI_SLOT(assigned_dev->host_devfn), | |
188 | PCI_FUNC(assigned_dev->host_devfn)); | |
62c476c7 | 189 | |
260782bc | 190 | return 0; |
522c68c4 SY |
191 | out_unmap: |
192 | kvm_iommu_unmap_memslots(kvm); | |
193 | return r; | |
260782bc | 194 | } |
62c476c7 | 195 | |
0a920356 WH |
196 | int kvm_deassign_device(struct kvm *kvm, |
197 | struct kvm_assigned_dev_kernel *assigned_dev) | |
198 | { | |
19de40a8 | 199 | struct iommu_domain *domain = kvm->arch.iommu_domain; |
0a920356 WH |
200 | struct pci_dev *pdev = NULL; |
201 | ||
202 | /* check if iommu exists and in use */ | |
203 | if (!domain) | |
204 | return 0; | |
205 | ||
206 | pdev = assigned_dev->dev; | |
207 | if (pdev == NULL) | |
208 | return -ENODEV; | |
209 | ||
19de40a8 | 210 | iommu_detach_device(domain, &pdev->dev); |
0a920356 | 211 | |
ab9f4ecb ZE |
212 | printk(KERN_DEBUG "deassign device %x:%x:%x.%x\n", |
213 | assigned_dev->host_segnr, | |
0a920356 WH |
214 | assigned_dev->host_busnr, |
215 | PCI_SLOT(assigned_dev->host_devfn), | |
216 | PCI_FUNC(assigned_dev->host_devfn)); | |
217 | ||
218 | return 0; | |
219 | } | |
220 | ||
260782bc WH |
221 | int kvm_iommu_map_guest(struct kvm *kvm) |
222 | { | |
223 | int r; | |
224 | ||
19de40a8 JR |
225 | if (!iommu_found()) { |
226 | printk(KERN_ERR "%s: iommu not found\n", __func__); | |
62c476c7 BAY |
227 | return -ENODEV; |
228 | } | |
229 | ||
19de40a8 JR |
230 | kvm->arch.iommu_domain = iommu_domain_alloc(); |
231 | if (!kvm->arch.iommu_domain) | |
260782bc | 232 | return -ENOMEM; |
62c476c7 BAY |
233 | |
234 | r = kvm_iommu_map_memslots(kvm); | |
235 | if (r) | |
236 | goto out_unmap; | |
237 | ||
62c476c7 BAY |
238 | return 0; |
239 | ||
240 | out_unmap: | |
241 | kvm_iommu_unmap_memslots(kvm); | |
242 | return r; | |
243 | } | |
244 | ||
fcd95807 JR |
245 | static void kvm_unpin_pages(struct kvm *kvm, pfn_t pfn, unsigned long npages) |
246 | { | |
247 | unsigned long i; | |
248 | ||
249 | for (i = 0; i < npages; ++i) | |
250 | kvm_release_pfn_clean(pfn + i); | |
251 | } | |
252 | ||
62c476c7 | 253 | static void kvm_iommu_put_pages(struct kvm *kvm, |
260782bc | 254 | gfn_t base_gfn, unsigned long npages) |
62c476c7 | 255 | { |
fcd95807 JR |
256 | struct iommu_domain *domain; |
257 | gfn_t end_gfn, gfn; | |
62c476c7 | 258 | pfn_t pfn; |
260782bc WH |
259 | u64 phys; |
260 | ||
fcd95807 JR |
261 | domain = kvm->arch.iommu_domain; |
262 | end_gfn = base_gfn + npages; | |
263 | gfn = base_gfn; | |
264 | ||
260782bc WH |
265 | /* check if iommu exists and in use */ |
266 | if (!domain) | |
267 | return; | |
62c476c7 | 268 | |
fcd95807 JR |
269 | while (gfn < end_gfn) { |
270 | unsigned long unmap_pages; | |
271 | int order; | |
272 | ||
273 | /* Get physical address */ | |
19de40a8 | 274 | phys = iommu_iova_to_phys(domain, gfn_to_gpa(gfn)); |
fcd95807 JR |
275 | pfn = phys >> PAGE_SHIFT; |
276 | ||
277 | /* Unmap address from IO address space */ | |
05b782ab | 278 | order = iommu_unmap(domain, gfn_to_gpa(gfn), 0); |
fcd95807 | 279 | unmap_pages = 1ULL << order; |
260782bc | 280 | |
fcd95807 JR |
281 | /* Unpin all pages we just unmapped to not leak any memory */ |
282 | kvm_unpin_pages(kvm, pfn, unmap_pages); | |
283 | ||
284 | gfn += unmap_pages; | |
285 | } | |
62c476c7 BAY |
286 | } |
287 | ||
288 | static int kvm_iommu_unmap_memslots(struct kvm *kvm) | |
289 | { | |
95c87e2b | 290 | int i, idx; |
46a26bf5 MT |
291 | struct kvm_memslots *slots; |
292 | ||
95c87e2b | 293 | idx = srcu_read_lock(&kvm->srcu); |
90d83dc3 | 294 | slots = kvm_memslots(kvm); |
682edb4c | 295 | |
46a26bf5 MT |
296 | for (i = 0; i < slots->nmemslots; i++) { |
297 | kvm_iommu_put_pages(kvm, slots->memslots[i].base_gfn, | |
298 | slots->memslots[i].npages); | |
62c476c7 | 299 | } |
95c87e2b | 300 | srcu_read_unlock(&kvm->srcu, idx); |
62c476c7 BAY |
301 | |
302 | return 0; | |
303 | } | |
304 | ||
305 | int kvm_iommu_unmap_guest(struct kvm *kvm) | |
306 | { | |
19de40a8 | 307 | struct iommu_domain *domain = kvm->arch.iommu_domain; |
62c476c7 BAY |
308 | |
309 | /* check if iommu exists and in use */ | |
310 | if (!domain) | |
311 | return 0; | |
312 | ||
62c476c7 | 313 | kvm_iommu_unmap_memslots(kvm); |
19de40a8 | 314 | iommu_domain_free(domain); |
62c476c7 BAY |
315 | return 0; |
316 | } |