1 /*
2 * KVMGT - the implementation of Intel mediated pass-through framework for KVM
3 *
4 * Copyright(c) 2011-2016 Intel Corporation. All rights reserved.
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a
7 * copy of this software and associated documentation files (the "Software"),
8 * to deal in the Software without restriction, including without limitation
9 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10 * and/or sell copies of the Software, and to permit persons to whom the
11 * Software is furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice (including the next
14 * paragraph) shall be included in all copies or substantial portions of the
15 * Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
23 * SOFTWARE.
24 *
25 * Authors:
26 * Kevin Tian <kevin.tian@intel.com>
27 * Jike Song <jike.song@intel.com>
28 * Xiaoguang Chen <xiaoguang.chen@intel.com>
29 * Eddie Dong <eddie.dong@intel.com>
30 *
31 * Contributors:
32 * Niu Bing <bing.niu@intel.com>
33 * Zhi Wang <zhi.a.wang@intel.com>
34 */
35
36 #include <linux/init.h>
37 #include <linux/mm.h>
38 #include <linux/kthread.h>
39 #include <linux/sched/mm.h>
40 #include <linux/types.h>
41 #include <linux/list.h>
42 #include <linux/rbtree.h>
43 #include <linux/spinlock.h>
44 #include <linux/eventfd.h>
45 #include <linux/mdev.h>
46 #include <linux/debugfs.h>
47
48 #include <linux/nospec.h>
49
50 #include <drm/drm_edid.h>
51 #include <drm/drm_print.h>
52
53 #include "i915_drv.h"
54 #include "intel_gvt.h"
55 #include "gvt.h"
56
57 MODULE_IMPORT_NS("DMA_BUF");
58 MODULE_IMPORT_NS("I915_GVT");
59
60 /* helper macros copied from vfio-pci */
61 #define VFIO_PCI_OFFSET_SHIFT 40
62 #define VFIO_PCI_OFFSET_TO_INDEX(off) (off >> VFIO_PCI_OFFSET_SHIFT)
63 #define VFIO_PCI_INDEX_TO_OFFSET(index) ((u64)(index) << VFIO_PCI_OFFSET_SHIFT)
64 #define VFIO_PCI_OFFSET_MASK (((u64)(1) << VFIO_PCI_OFFSET_SHIFT) - 1)
65
66 #define EDID_BLOB_OFFSET (PAGE_SIZE/2)
67
68 #define OPREGION_SIGNATURE "IntelGraphicsMem"
69
70 struct vfio_region;
71 struct intel_vgpu_regops {
72 size_t (*rw)(struct intel_vgpu *vgpu, char *buf,
73 size_t count, loff_t *ppos, bool iswrite);
74 void (*release)(struct intel_vgpu *vgpu,
75 struct vfio_region *region);
76 };
77
78 struct vfio_region {
79 u32 type;
80 u32 subtype;
81 size_t size;
82 u32 flags;
83 const struct intel_vgpu_regops *ops;
84 void *data;
85 };
86
87 struct vfio_edid_region {
88 struct vfio_region_gfx_edid vfio_edid_regs;
89 void *edid_blob;
90 };
91
92 struct kvmgt_pgfn {
93 gfn_t gfn;
94 struct hlist_node hnode;
95 };
96
97 struct gvt_dma {
98 struct intel_vgpu *vgpu;
99 struct rb_node gfn_node;
100 struct rb_node dma_addr_node;
101 gfn_t gfn;
102 dma_addr_t dma_addr;
103 unsigned long size;
104 struct kref ref;
105 };
106
107 #define vfio_dev_to_vgpu(vfio_dev) \
108 container_of((vfio_dev), struct intel_vgpu, vfio_device)
109
110 static void kvmgt_page_track_write(gpa_t gpa, const u8 *val, int len,
111 struct kvm_page_track_notifier_node *node);
112 static void kvmgt_page_track_remove_region(gfn_t gfn, unsigned long nr_pages,
113 struct kvm_page_track_notifier_node *node);
114
intel_vgpu_show_description(struct mdev_type * mtype,char * buf)115 static ssize_t intel_vgpu_show_description(struct mdev_type *mtype, char *buf)
116 {
117 struct intel_vgpu_type *type =
118 container_of(mtype, struct intel_vgpu_type, type);
119
120 return sprintf(buf, "low_gm_size: %dMB\nhigh_gm_size: %dMB\n"
121 "fence: %d\nresolution: %s\n"
122 "weight: %d\n",
123 BYTES_TO_MB(type->conf->low_mm),
124 BYTES_TO_MB(type->conf->high_mm),
125 type->conf->fence, vgpu_edid_str(type->conf->edid),
126 type->conf->weight);
127 }
128
gvt_unpin_guest_page(struct intel_vgpu * vgpu,unsigned long gfn,unsigned long size)129 static void gvt_unpin_guest_page(struct intel_vgpu *vgpu, unsigned long gfn,
130 unsigned long size)
131 {
132 vfio_unpin_pages(&vgpu->vfio_device, gfn << PAGE_SHIFT,
133 DIV_ROUND_UP(size, PAGE_SIZE));
134 }
135
136 /* Pin a normal or compound guest page for dma. */
gvt_pin_guest_page(struct intel_vgpu * vgpu,unsigned long gfn,unsigned long size,struct page ** page)137 static int gvt_pin_guest_page(struct intel_vgpu *vgpu, unsigned long gfn,
138 unsigned long size, struct page **page)
139 {
140 int total_pages = DIV_ROUND_UP(size, PAGE_SIZE);
141 struct page *base_page = NULL;
142 int npage;
143 int ret;
144
145 /*
146 * We pin the pages one-by-one to avoid allocating a big array
147 * on stack to hold pfns.
148 */
149 for (npage = 0; npage < total_pages; npage++) {
150 dma_addr_t cur_iova = (gfn + npage) << PAGE_SHIFT;
151 struct page *cur_page;
152
153 ret = vfio_pin_pages(&vgpu->vfio_device, cur_iova, 1,
154 IOMMU_READ | IOMMU_WRITE, &cur_page);
155 if (ret != 1) {
156 gvt_vgpu_err("vfio_pin_pages failed for iova %pad, ret %d\n",
157 &cur_iova, ret);
158 goto err;
159 }
160
161 if (npage == 0)
162 base_page = cur_page;
163 else if (page_to_pfn(base_page) + npage != page_to_pfn(cur_page)) {
164 ret = -EINVAL;
165 npage++;
166 goto err;
167 }
168 }
169
170 *page = base_page;
171 return 0;
172 err:
173 if (npage)
174 gvt_unpin_guest_page(vgpu, gfn, npage * PAGE_SIZE);
175 return ret;
176 }
177
gvt_dma_map_page(struct intel_vgpu * vgpu,unsigned long gfn,dma_addr_t * dma_addr,unsigned long size)178 static int gvt_dma_map_page(struct intel_vgpu *vgpu, unsigned long gfn,
179 dma_addr_t *dma_addr, unsigned long size)
180 {
181 struct device *dev = vgpu->gvt->gt->i915->drm.dev;
182 struct page *page = NULL;
183 int ret;
184
185 ret = gvt_pin_guest_page(vgpu, gfn, size, &page);
186 if (ret)
187 return ret;
188
189 /* Setup DMA mapping. */
190 *dma_addr = dma_map_page(dev, page, 0, size, DMA_BIDIRECTIONAL);
191 if (dma_mapping_error(dev, *dma_addr)) {
192 gvt_vgpu_err("DMA mapping failed for pfn 0x%lx, ret %d\n",
193 page_to_pfn(page), ret);
194 gvt_unpin_guest_page(vgpu, gfn, size);
195 return -ENOMEM;
196 }
197
198 return 0;
199 }
200
gvt_dma_unmap_page(struct intel_vgpu * vgpu,unsigned long gfn,dma_addr_t dma_addr,unsigned long size)201 static void gvt_dma_unmap_page(struct intel_vgpu *vgpu, unsigned long gfn,
202 dma_addr_t dma_addr, unsigned long size)
203 {
204 struct device *dev = vgpu->gvt->gt->i915->drm.dev;
205
206 dma_unmap_page(dev, dma_addr, size, DMA_BIDIRECTIONAL);
207 gvt_unpin_guest_page(vgpu, gfn, size);
208 }
209
__gvt_cache_find_dma_addr(struct intel_vgpu * vgpu,dma_addr_t dma_addr)210 static struct gvt_dma *__gvt_cache_find_dma_addr(struct intel_vgpu *vgpu,
211 dma_addr_t dma_addr)
212 {
213 struct rb_node *node = vgpu->dma_addr_cache.rb_node;
214 struct gvt_dma *itr;
215
216 while (node) {
217 itr = rb_entry(node, struct gvt_dma, dma_addr_node);
218
219 if (dma_addr < itr->dma_addr)
220 node = node->rb_left;
221 else if (dma_addr > itr->dma_addr)
222 node = node->rb_right;
223 else
224 return itr;
225 }
226 return NULL;
227 }
228
__gvt_cache_find_gfn(struct intel_vgpu * vgpu,gfn_t gfn)229 static struct gvt_dma *__gvt_cache_find_gfn(struct intel_vgpu *vgpu, gfn_t gfn)
230 {
231 struct rb_node *node = vgpu->gfn_cache.rb_node;
232 struct gvt_dma *itr;
233
234 while (node) {
235 itr = rb_entry(node, struct gvt_dma, gfn_node);
236
237 if (gfn < itr->gfn)
238 node = node->rb_left;
239 else if (gfn > itr->gfn)
240 node = node->rb_right;
241 else
242 return itr;
243 }
244 return NULL;
245 }
246
__gvt_cache_add(struct intel_vgpu * vgpu,gfn_t gfn,dma_addr_t dma_addr,unsigned long size)247 static int __gvt_cache_add(struct intel_vgpu *vgpu, gfn_t gfn,
248 dma_addr_t dma_addr, unsigned long size)
249 {
250 struct gvt_dma *new, *itr;
251 struct rb_node **link, *parent = NULL;
252
253 new = kzalloc(sizeof(struct gvt_dma), GFP_KERNEL);
254 if (!new)
255 return -ENOMEM;
256
257 new->vgpu = vgpu;
258 new->gfn = gfn;
259 new->dma_addr = dma_addr;
260 new->size = size;
261 kref_init(&new->ref);
262
263 /* gfn_cache maps gfn to struct gvt_dma. */
264 link = &vgpu->gfn_cache.rb_node;
265 while (*link) {
266 parent = *link;
267 itr = rb_entry(parent, struct gvt_dma, gfn_node);
268
269 if (gfn < itr->gfn)
270 link = &parent->rb_left;
271 else
272 link = &parent->rb_right;
273 }
274 rb_link_node(&new->gfn_node, parent, link);
275 rb_insert_color(&new->gfn_node, &vgpu->gfn_cache);
276
277 /* dma_addr_cache maps dma addr to struct gvt_dma. */
278 parent = NULL;
279 link = &vgpu->dma_addr_cache.rb_node;
280 while (*link) {
281 parent = *link;
282 itr = rb_entry(parent, struct gvt_dma, dma_addr_node);
283
284 if (dma_addr < itr->dma_addr)
285 link = &parent->rb_left;
286 else
287 link = &parent->rb_right;
288 }
289 rb_link_node(&new->dma_addr_node, parent, link);
290 rb_insert_color(&new->dma_addr_node, &vgpu->dma_addr_cache);
291
292 vgpu->nr_cache_entries++;
293 return 0;
294 }
295
__gvt_cache_remove_entry(struct intel_vgpu * vgpu,struct gvt_dma * entry)296 static void __gvt_cache_remove_entry(struct intel_vgpu *vgpu,
297 struct gvt_dma *entry)
298 {
299 rb_erase(&entry->gfn_node, &vgpu->gfn_cache);
300 rb_erase(&entry->dma_addr_node, &vgpu->dma_addr_cache);
301 kfree(entry);
302 vgpu->nr_cache_entries--;
303 }
304
gvt_cache_destroy(struct intel_vgpu * vgpu)305 static void gvt_cache_destroy(struct intel_vgpu *vgpu)
306 {
307 struct gvt_dma *dma;
308 struct rb_node *node = NULL;
309
310 for (;;) {
311 mutex_lock(&vgpu->cache_lock);
312 node = rb_first(&vgpu->gfn_cache);
313 if (!node) {
314 mutex_unlock(&vgpu->cache_lock);
315 break;
316 }
317 dma = rb_entry(node, struct gvt_dma, gfn_node);
318 gvt_dma_unmap_page(vgpu, dma->gfn, dma->dma_addr, dma->size);
319 __gvt_cache_remove_entry(vgpu, dma);
320 mutex_unlock(&vgpu->cache_lock);
321 }
322 }
323
gvt_cache_init(struct intel_vgpu * vgpu)324 static void gvt_cache_init(struct intel_vgpu *vgpu)
325 {
326 vgpu->gfn_cache = RB_ROOT;
327 vgpu->dma_addr_cache = RB_ROOT;
328 vgpu->nr_cache_entries = 0;
329 mutex_init(&vgpu->cache_lock);
330 }
331
kvmgt_protect_table_init(struct intel_vgpu * info)332 static void kvmgt_protect_table_init(struct intel_vgpu *info)
333 {
334 hash_init(info->ptable);
335 }
336
kvmgt_protect_table_destroy(struct intel_vgpu * info)337 static void kvmgt_protect_table_destroy(struct intel_vgpu *info)
338 {
339 struct kvmgt_pgfn *p;
340 struct hlist_node *tmp;
341 int i;
342
343 hash_for_each_safe(info->ptable, i, tmp, p, hnode) {
344 hash_del(&p->hnode);
345 kfree(p);
346 }
347 }
348
349 static struct kvmgt_pgfn *
__kvmgt_protect_table_find(struct intel_vgpu * info,gfn_t gfn)350 __kvmgt_protect_table_find(struct intel_vgpu *info, gfn_t gfn)
351 {
352 struct kvmgt_pgfn *p, *res = NULL;
353
354 lockdep_assert_held(&info->vgpu_lock);
355
356 hash_for_each_possible(info->ptable, p, hnode, gfn) {
357 if (gfn == p->gfn) {
358 res = p;
359 break;
360 }
361 }
362
363 return res;
364 }
365
kvmgt_gfn_is_write_protected(struct intel_vgpu * info,gfn_t gfn)366 static bool kvmgt_gfn_is_write_protected(struct intel_vgpu *info, gfn_t gfn)
367 {
368 struct kvmgt_pgfn *p;
369
370 p = __kvmgt_protect_table_find(info, gfn);
371 return !!p;
372 }
373
kvmgt_protect_table_add(struct intel_vgpu * info,gfn_t gfn)374 static void kvmgt_protect_table_add(struct intel_vgpu *info, gfn_t gfn)
375 {
376 struct kvmgt_pgfn *p;
377
378 if (kvmgt_gfn_is_write_protected(info, gfn))
379 return;
380
381 p = kzalloc(sizeof(struct kvmgt_pgfn), GFP_ATOMIC);
382 if (WARN(!p, "gfn: 0x%llx\n", gfn))
383 return;
384
385 p->gfn = gfn;
386 hash_add(info->ptable, &p->hnode, gfn);
387 }
388
kvmgt_protect_table_del(struct intel_vgpu * info,gfn_t gfn)389 static void kvmgt_protect_table_del(struct intel_vgpu *info, gfn_t gfn)
390 {
391 struct kvmgt_pgfn *p;
392
393 p = __kvmgt_protect_table_find(info, gfn);
394 if (p) {
395 hash_del(&p->hnode);
396 kfree(p);
397 }
398 }
399
intel_vgpu_reg_rw_opregion(struct intel_vgpu * vgpu,char * buf,size_t count,loff_t * ppos,bool iswrite)400 static size_t intel_vgpu_reg_rw_opregion(struct intel_vgpu *vgpu, char *buf,
401 size_t count, loff_t *ppos, bool iswrite)
402 {
403 unsigned int i = VFIO_PCI_OFFSET_TO_INDEX(*ppos) -
404 VFIO_PCI_NUM_REGIONS;
405 void *base = vgpu->region[i].data;
406 loff_t pos = *ppos & VFIO_PCI_OFFSET_MASK;
407
408
409 if (pos >= vgpu->region[i].size || iswrite) {
410 gvt_vgpu_err("invalid op or offset for Intel vgpu OpRegion\n");
411 return -EINVAL;
412 }
413 count = min(count, (size_t)(vgpu->region[i].size - pos));
414 memcpy(buf, base + pos, count);
415
416 return count;
417 }
418
intel_vgpu_reg_release_opregion(struct intel_vgpu * vgpu,struct vfio_region * region)419 static void intel_vgpu_reg_release_opregion(struct intel_vgpu *vgpu,
420 struct vfio_region *region)
421 {
422 }
423
424 static const struct intel_vgpu_regops intel_vgpu_regops_opregion = {
425 .rw = intel_vgpu_reg_rw_opregion,
426 .release = intel_vgpu_reg_release_opregion,
427 };
428
edid_valid(const void * edid,size_t size)429 static bool edid_valid(const void *edid, size_t size)
430 {
431 const struct drm_edid *drm_edid;
432 bool is_valid;
433
434 drm_edid = drm_edid_alloc(edid, size);
435 is_valid = drm_edid_valid(drm_edid);
436 drm_edid_free(drm_edid);
437
438 return is_valid;
439 }
440
handle_edid_regs(struct intel_vgpu * vgpu,struct vfio_edid_region * region,char * buf,size_t count,u16 offset,bool is_write)441 static int handle_edid_regs(struct intel_vgpu *vgpu,
442 struct vfio_edid_region *region, char *buf,
443 size_t count, u16 offset, bool is_write)
444 {
445 struct vfio_region_gfx_edid *regs = ®ion->vfio_edid_regs;
446 unsigned int data;
447
448 if (offset + count > sizeof(*regs))
449 return -EINVAL;
450
451 if (count != 4)
452 return -EINVAL;
453
454 if (is_write) {
455 data = *((unsigned int *)buf);
456 switch (offset) {
457 case offsetof(struct vfio_region_gfx_edid, link_state):
458 if (data == VFIO_DEVICE_GFX_LINK_STATE_UP) {
459 if (!edid_valid(region->edid_blob, EDID_SIZE)) {
460 gvt_vgpu_err("invalid EDID blob\n");
461 return -EINVAL;
462 }
463 intel_vgpu_emulate_hotplug(vgpu, true);
464 } else if (data == VFIO_DEVICE_GFX_LINK_STATE_DOWN)
465 intel_vgpu_emulate_hotplug(vgpu, false);
466 else {
467 gvt_vgpu_err("invalid EDID link state %d\n",
468 regs->link_state);
469 return -EINVAL;
470 }
471 regs->link_state = data;
472 break;
473 case offsetof(struct vfio_region_gfx_edid, edid_size):
474 if (data > regs->edid_max_size) {
475 gvt_vgpu_err("EDID size is bigger than %d!\n",
476 regs->edid_max_size);
477 return -EINVAL;
478 }
479 regs->edid_size = data;
480 break;
481 default:
482 /* read-only regs */
483 gvt_vgpu_err("write read-only EDID region at offset %d\n",
484 offset);
485 return -EPERM;
486 }
487 } else {
488 memcpy(buf, (char *)regs + offset, count);
489 }
490
491 return count;
492 }
493
handle_edid_blob(struct vfio_edid_region * region,char * buf,size_t count,u16 offset,bool is_write)494 static int handle_edid_blob(struct vfio_edid_region *region, char *buf,
495 size_t count, u16 offset, bool is_write)
496 {
497 if (offset + count > region->vfio_edid_regs.edid_size)
498 return -EINVAL;
499
500 if (is_write)
501 memcpy(region->edid_blob + offset, buf, count);
502 else
503 memcpy(buf, region->edid_blob + offset, count);
504
505 return count;
506 }
507
intel_vgpu_reg_rw_edid(struct intel_vgpu * vgpu,char * buf,size_t count,loff_t * ppos,bool iswrite)508 static size_t intel_vgpu_reg_rw_edid(struct intel_vgpu *vgpu, char *buf,
509 size_t count, loff_t *ppos, bool iswrite)
510 {
511 int ret;
512 unsigned int i = VFIO_PCI_OFFSET_TO_INDEX(*ppos) -
513 VFIO_PCI_NUM_REGIONS;
514 struct vfio_edid_region *region = vgpu->region[i].data;
515 loff_t pos = *ppos & VFIO_PCI_OFFSET_MASK;
516
517 if (pos < region->vfio_edid_regs.edid_offset) {
518 ret = handle_edid_regs(vgpu, region, buf, count, pos, iswrite);
519 } else {
520 pos -= EDID_BLOB_OFFSET;
521 ret = handle_edid_blob(region, buf, count, pos, iswrite);
522 }
523
524 if (ret < 0)
525 gvt_vgpu_err("failed to access EDID region\n");
526
527 return ret;
528 }
529
intel_vgpu_reg_release_edid(struct intel_vgpu * vgpu,struct vfio_region * region)530 static void intel_vgpu_reg_release_edid(struct intel_vgpu *vgpu,
531 struct vfio_region *region)
532 {
533 kfree(region->data);
534 }
535
536 static const struct intel_vgpu_regops intel_vgpu_regops_edid = {
537 .rw = intel_vgpu_reg_rw_edid,
538 .release = intel_vgpu_reg_release_edid,
539 };
540
intel_vgpu_register_reg(struct intel_vgpu * vgpu,unsigned int type,unsigned int subtype,const struct intel_vgpu_regops * ops,size_t size,u32 flags,void * data)541 static int intel_vgpu_register_reg(struct intel_vgpu *vgpu,
542 unsigned int type, unsigned int subtype,
543 const struct intel_vgpu_regops *ops,
544 size_t size, u32 flags, void *data)
545 {
546 struct vfio_region *region;
547
548 region = krealloc(vgpu->region,
549 (vgpu->num_regions + 1) * sizeof(*region),
550 GFP_KERNEL);
551 if (!region)
552 return -ENOMEM;
553
554 vgpu->region = region;
555 vgpu->region[vgpu->num_regions].type = type;
556 vgpu->region[vgpu->num_regions].subtype = subtype;
557 vgpu->region[vgpu->num_regions].ops = ops;
558 vgpu->region[vgpu->num_regions].size = size;
559 vgpu->region[vgpu->num_regions].flags = flags;
560 vgpu->region[vgpu->num_regions].data = data;
561 vgpu->num_regions++;
562 return 0;
563 }
564
intel_gvt_set_opregion(struct intel_vgpu * vgpu)565 int intel_gvt_set_opregion(struct intel_vgpu *vgpu)
566 {
567 void *base;
568 int ret;
569
570 /* Each vgpu has its own opregion, although VFIO would create another
571 * one later. This one is used to expose opregion to VFIO. And the
572 * other one created by VFIO later, is used by guest actually.
573 */
574 base = vgpu_opregion(vgpu)->va;
575 if (!base)
576 return -ENOMEM;
577
578 if (memcmp(base, OPREGION_SIGNATURE, 16)) {
579 memunmap(base);
580 return -EINVAL;
581 }
582
583 ret = intel_vgpu_register_reg(vgpu,
584 PCI_VENDOR_ID_INTEL | VFIO_REGION_TYPE_PCI_VENDOR_TYPE,
585 VFIO_REGION_SUBTYPE_INTEL_IGD_OPREGION,
586 &intel_vgpu_regops_opregion, INTEL_GVT_OPREGION_SIZE,
587 VFIO_REGION_INFO_FLAG_READ, base);
588
589 return ret;
590 }
591
intel_gvt_set_edid(struct intel_vgpu * vgpu,int port_num)592 int intel_gvt_set_edid(struct intel_vgpu *vgpu, int port_num)
593 {
594 struct intel_vgpu_port *port = intel_vgpu_port(vgpu, port_num);
595 struct vfio_edid_region *base;
596 int ret;
597
598 base = kzalloc(sizeof(*base), GFP_KERNEL);
599 if (!base)
600 return -ENOMEM;
601
602 /* TODO: Add multi-port and EDID extension block support */
603 base->vfio_edid_regs.edid_offset = EDID_BLOB_OFFSET;
604 base->vfio_edid_regs.edid_max_size = EDID_SIZE;
605 base->vfio_edid_regs.edid_size = EDID_SIZE;
606 base->vfio_edid_regs.max_xres = vgpu_edid_xres(port->id);
607 base->vfio_edid_regs.max_yres = vgpu_edid_yres(port->id);
608 base->edid_blob = port->edid->edid_block;
609
610 ret = intel_vgpu_register_reg(vgpu,
611 VFIO_REGION_TYPE_GFX,
612 VFIO_REGION_SUBTYPE_GFX_EDID,
613 &intel_vgpu_regops_edid, EDID_SIZE,
614 VFIO_REGION_INFO_FLAG_READ |
615 VFIO_REGION_INFO_FLAG_WRITE |
616 VFIO_REGION_INFO_FLAG_CAPS, base);
617
618 return ret;
619 }
620
intel_vgpu_dma_unmap(struct vfio_device * vfio_dev,u64 iova,u64 length)621 static void intel_vgpu_dma_unmap(struct vfio_device *vfio_dev, u64 iova,
622 u64 length)
623 {
624 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
625 struct gvt_dma *entry;
626 u64 iov_pfn = iova >> PAGE_SHIFT;
627 u64 end_iov_pfn = iov_pfn + length / PAGE_SIZE;
628
629 mutex_lock(&vgpu->cache_lock);
630 for (; iov_pfn < end_iov_pfn; iov_pfn++) {
631 entry = __gvt_cache_find_gfn(vgpu, iov_pfn);
632 if (!entry)
633 continue;
634
635 gvt_dma_unmap_page(vgpu, entry->gfn, entry->dma_addr,
636 entry->size);
637 __gvt_cache_remove_entry(vgpu, entry);
638 }
639 mutex_unlock(&vgpu->cache_lock);
640 }
641
__kvmgt_vgpu_exist(struct intel_vgpu * vgpu)642 static bool __kvmgt_vgpu_exist(struct intel_vgpu *vgpu)
643 {
644 struct intel_vgpu *itr;
645 int id;
646 bool ret = false;
647
648 mutex_lock(&vgpu->gvt->lock);
649 for_each_active_vgpu(vgpu->gvt, itr, id) {
650 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, itr->status))
651 continue;
652
653 if (vgpu->vfio_device.kvm == itr->vfio_device.kvm) {
654 ret = true;
655 goto out;
656 }
657 }
658 out:
659 mutex_unlock(&vgpu->gvt->lock);
660 return ret;
661 }
662
intel_vgpu_open_device(struct vfio_device * vfio_dev)663 static int intel_vgpu_open_device(struct vfio_device *vfio_dev)
664 {
665 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
666 int ret;
667
668 if (__kvmgt_vgpu_exist(vgpu))
669 return -EEXIST;
670
671 vgpu->track_node.track_write = kvmgt_page_track_write;
672 vgpu->track_node.track_remove_region = kvmgt_page_track_remove_region;
673 ret = kvm_page_track_register_notifier(vgpu->vfio_device.kvm,
674 &vgpu->track_node);
675 if (ret) {
676 gvt_vgpu_err("KVM is required to use Intel vGPU\n");
677 return ret;
678 }
679
680 set_bit(INTEL_VGPU_STATUS_ATTACHED, vgpu->status);
681
682 debugfs_create_ulong(KVMGT_DEBUGFS_FILENAME, 0444, vgpu->debugfs,
683 &vgpu->nr_cache_entries);
684
685 intel_gvt_activate_vgpu(vgpu);
686
687 return 0;
688 }
689
intel_vgpu_release_msi_eventfd_ctx(struct intel_vgpu * vgpu)690 static void intel_vgpu_release_msi_eventfd_ctx(struct intel_vgpu *vgpu)
691 {
692 struct eventfd_ctx *trigger;
693
694 trigger = vgpu->msi_trigger;
695 if (trigger) {
696 eventfd_ctx_put(trigger);
697 vgpu->msi_trigger = NULL;
698 }
699 }
700
intel_vgpu_close_device(struct vfio_device * vfio_dev)701 static void intel_vgpu_close_device(struct vfio_device *vfio_dev)
702 {
703 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
704
705 intel_gvt_release_vgpu(vgpu);
706
707 clear_bit(INTEL_VGPU_STATUS_ATTACHED, vgpu->status);
708
709 debugfs_lookup_and_remove(KVMGT_DEBUGFS_FILENAME, vgpu->debugfs);
710
711 kvm_page_track_unregister_notifier(vgpu->vfio_device.kvm,
712 &vgpu->track_node);
713
714 kvmgt_protect_table_destroy(vgpu);
715 gvt_cache_destroy(vgpu);
716
717 WARN_ON(vgpu->nr_cache_entries);
718
719 vgpu->gfn_cache = RB_ROOT;
720 vgpu->dma_addr_cache = RB_ROOT;
721
722 intel_vgpu_release_msi_eventfd_ctx(vgpu);
723 }
724
intel_vgpu_get_bar_addr(struct intel_vgpu * vgpu,int bar)725 static u64 intel_vgpu_get_bar_addr(struct intel_vgpu *vgpu, int bar)
726 {
727 u32 start_lo, start_hi;
728 u32 mem_type;
729
730 start_lo = (*(u32 *)(vgpu->cfg_space.virtual_cfg_space + bar)) &
731 PCI_BASE_ADDRESS_MEM_MASK;
732 mem_type = (*(u32 *)(vgpu->cfg_space.virtual_cfg_space + bar)) &
733 PCI_BASE_ADDRESS_MEM_TYPE_MASK;
734
735 switch (mem_type) {
736 case PCI_BASE_ADDRESS_MEM_TYPE_64:
737 start_hi = (*(u32 *)(vgpu->cfg_space.virtual_cfg_space
738 + bar + 4));
739 break;
740 case PCI_BASE_ADDRESS_MEM_TYPE_32:
741 case PCI_BASE_ADDRESS_MEM_TYPE_1M:
742 /* 1M mem BAR treated as 32-bit BAR */
743 default:
744 /* mem unknown type treated as 32-bit BAR */
745 start_hi = 0;
746 break;
747 }
748
749 return ((u64)start_hi << 32) | start_lo;
750 }
751
intel_vgpu_bar_rw(struct intel_vgpu * vgpu,int bar,u64 off,void * buf,unsigned int count,bool is_write)752 static int intel_vgpu_bar_rw(struct intel_vgpu *vgpu, int bar, u64 off,
753 void *buf, unsigned int count, bool is_write)
754 {
755 u64 bar_start = intel_vgpu_get_bar_addr(vgpu, bar);
756 int ret;
757
758 if (is_write)
759 ret = intel_vgpu_emulate_mmio_write(vgpu,
760 bar_start + off, buf, count);
761 else
762 ret = intel_vgpu_emulate_mmio_read(vgpu,
763 bar_start + off, buf, count);
764 return ret;
765 }
766
intel_vgpu_in_aperture(struct intel_vgpu * vgpu,u64 off)767 static inline bool intel_vgpu_in_aperture(struct intel_vgpu *vgpu, u64 off)
768 {
769 return off >= vgpu_aperture_offset(vgpu) &&
770 off < vgpu_aperture_offset(vgpu) + vgpu_aperture_sz(vgpu);
771 }
772
intel_vgpu_aperture_rw(struct intel_vgpu * vgpu,u64 off,void * buf,unsigned long count,bool is_write)773 static int intel_vgpu_aperture_rw(struct intel_vgpu *vgpu, u64 off,
774 void *buf, unsigned long count, bool is_write)
775 {
776 void __iomem *aperture_va;
777
778 if (!intel_vgpu_in_aperture(vgpu, off) ||
779 !intel_vgpu_in_aperture(vgpu, off + count)) {
780 gvt_vgpu_err("Invalid aperture offset %llu\n", off);
781 return -EINVAL;
782 }
783
784 aperture_va = io_mapping_map_wc(&vgpu->gvt->gt->ggtt->iomap,
785 ALIGN_DOWN(off, PAGE_SIZE),
786 count + offset_in_page(off));
787 if (!aperture_va)
788 return -EIO;
789
790 if (is_write)
791 memcpy_toio(aperture_va + offset_in_page(off), buf, count);
792 else
793 memcpy_fromio(buf, aperture_va + offset_in_page(off), count);
794
795 io_mapping_unmap(aperture_va);
796
797 return 0;
798 }
799
intel_vgpu_rw(struct intel_vgpu * vgpu,char * buf,size_t count,loff_t * ppos,bool is_write)800 static ssize_t intel_vgpu_rw(struct intel_vgpu *vgpu, char *buf,
801 size_t count, loff_t *ppos, bool is_write)
802 {
803 unsigned int index = VFIO_PCI_OFFSET_TO_INDEX(*ppos);
804 u64 pos = *ppos & VFIO_PCI_OFFSET_MASK;
805 int ret = -EINVAL;
806
807
808 if (index >= VFIO_PCI_NUM_REGIONS + vgpu->num_regions) {
809 gvt_vgpu_err("invalid index: %u\n", index);
810 return -EINVAL;
811 }
812
813 switch (index) {
814 case VFIO_PCI_CONFIG_REGION_INDEX:
815 if (is_write)
816 ret = intel_vgpu_emulate_cfg_write(vgpu, pos,
817 buf, count);
818 else
819 ret = intel_vgpu_emulate_cfg_read(vgpu, pos,
820 buf, count);
821 break;
822 case VFIO_PCI_BAR0_REGION_INDEX:
823 ret = intel_vgpu_bar_rw(vgpu, PCI_BASE_ADDRESS_0, pos,
824 buf, count, is_write);
825 break;
826 case VFIO_PCI_BAR2_REGION_INDEX:
827 ret = intel_vgpu_aperture_rw(vgpu, pos, buf, count, is_write);
828 break;
829 case VFIO_PCI_BAR1_REGION_INDEX:
830 case VFIO_PCI_BAR3_REGION_INDEX:
831 case VFIO_PCI_BAR4_REGION_INDEX:
832 case VFIO_PCI_BAR5_REGION_INDEX:
833 case VFIO_PCI_VGA_REGION_INDEX:
834 case VFIO_PCI_ROM_REGION_INDEX:
835 break;
836 default:
837 if (index >= VFIO_PCI_NUM_REGIONS + vgpu->num_regions)
838 return -EINVAL;
839
840 index -= VFIO_PCI_NUM_REGIONS;
841 return vgpu->region[index].ops->rw(vgpu, buf, count,
842 ppos, is_write);
843 }
844
845 return ret == 0 ? count : ret;
846 }
847
gtt_entry(struct intel_vgpu * vgpu,loff_t * ppos)848 static bool gtt_entry(struct intel_vgpu *vgpu, loff_t *ppos)
849 {
850 unsigned int index = VFIO_PCI_OFFSET_TO_INDEX(*ppos);
851 struct intel_gvt *gvt = vgpu->gvt;
852 int offset;
853
854 /* Only allow MMIO GGTT entry access */
855 if (index != PCI_BASE_ADDRESS_0)
856 return false;
857
858 offset = (u64)(*ppos & VFIO_PCI_OFFSET_MASK) -
859 intel_vgpu_get_bar_gpa(vgpu, PCI_BASE_ADDRESS_0);
860
861 return (offset >= gvt->device_info.gtt_start_offset &&
862 offset < gvt->device_info.gtt_start_offset + gvt_ggtt_sz(gvt)) ?
863 true : false;
864 }
865
intel_vgpu_read(struct vfio_device * vfio_dev,char __user * buf,size_t count,loff_t * ppos)866 static ssize_t intel_vgpu_read(struct vfio_device *vfio_dev, char __user *buf,
867 size_t count, loff_t *ppos)
868 {
869 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
870 unsigned int done = 0;
871 int ret;
872
873 while (count) {
874 size_t filled;
875
876 /* Only support GGTT entry 8 bytes read */
877 if (count >= 8 && !(*ppos % 8) &&
878 gtt_entry(vgpu, ppos)) {
879 u64 val;
880
881 ret = intel_vgpu_rw(vgpu, (char *)&val, sizeof(val),
882 ppos, false);
883 if (ret <= 0)
884 goto read_err;
885
886 if (copy_to_user(buf, &val, sizeof(val)))
887 goto read_err;
888
889 filled = 8;
890 } else if (count >= 4 && !(*ppos % 4)) {
891 u32 val;
892
893 ret = intel_vgpu_rw(vgpu, (char *)&val, sizeof(val),
894 ppos, false);
895 if (ret <= 0)
896 goto read_err;
897
898 if (copy_to_user(buf, &val, sizeof(val)))
899 goto read_err;
900
901 filled = 4;
902 } else if (count >= 2 && !(*ppos % 2)) {
903 u16 val;
904
905 ret = intel_vgpu_rw(vgpu, (char *)&val, sizeof(val),
906 ppos, false);
907 if (ret <= 0)
908 goto read_err;
909
910 if (copy_to_user(buf, &val, sizeof(val)))
911 goto read_err;
912
913 filled = 2;
914 } else {
915 u8 val;
916
917 ret = intel_vgpu_rw(vgpu, &val, sizeof(val), ppos,
918 false);
919 if (ret <= 0)
920 goto read_err;
921
922 if (copy_to_user(buf, &val, sizeof(val)))
923 goto read_err;
924
925 filled = 1;
926 }
927
928 count -= filled;
929 done += filled;
930 *ppos += filled;
931 buf += filled;
932 }
933
934 return done;
935
936 read_err:
937 return -EFAULT;
938 }
939
intel_vgpu_write(struct vfio_device * vfio_dev,const char __user * buf,size_t count,loff_t * ppos)940 static ssize_t intel_vgpu_write(struct vfio_device *vfio_dev,
941 const char __user *buf,
942 size_t count, loff_t *ppos)
943 {
944 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
945 unsigned int done = 0;
946 int ret;
947
948 while (count) {
949 size_t filled;
950
951 /* Only support GGTT entry 8 bytes write */
952 if (count >= 8 && !(*ppos % 8) &&
953 gtt_entry(vgpu, ppos)) {
954 u64 val;
955
956 if (copy_from_user(&val, buf, sizeof(val)))
957 goto write_err;
958
959 ret = intel_vgpu_rw(vgpu, (char *)&val, sizeof(val),
960 ppos, true);
961 if (ret <= 0)
962 goto write_err;
963
964 filled = 8;
965 } else if (count >= 4 && !(*ppos % 4)) {
966 u32 val;
967
968 if (copy_from_user(&val, buf, sizeof(val)))
969 goto write_err;
970
971 ret = intel_vgpu_rw(vgpu, (char *)&val, sizeof(val),
972 ppos, true);
973 if (ret <= 0)
974 goto write_err;
975
976 filled = 4;
977 } else if (count >= 2 && !(*ppos % 2)) {
978 u16 val;
979
980 if (copy_from_user(&val, buf, sizeof(val)))
981 goto write_err;
982
983 ret = intel_vgpu_rw(vgpu, (char *)&val,
984 sizeof(val), ppos, true);
985 if (ret <= 0)
986 goto write_err;
987
988 filled = 2;
989 } else {
990 u8 val;
991
992 if (copy_from_user(&val, buf, sizeof(val)))
993 goto write_err;
994
995 ret = intel_vgpu_rw(vgpu, &val, sizeof(val),
996 ppos, true);
997 if (ret <= 0)
998 goto write_err;
999
1000 filled = 1;
1001 }
1002
1003 count -= filled;
1004 done += filled;
1005 *ppos += filled;
1006 buf += filled;
1007 }
1008
1009 return done;
1010 write_err:
1011 return -EFAULT;
1012 }
1013
intel_vgpu_mmap(struct vfio_device * vfio_dev,struct vm_area_struct * vma)1014 static int intel_vgpu_mmap(struct vfio_device *vfio_dev,
1015 struct vm_area_struct *vma)
1016 {
1017 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
1018 unsigned int index;
1019 u64 virtaddr;
1020 unsigned long req_size, pgoff, req_start;
1021 pgprot_t pg_prot;
1022
1023 index = vma->vm_pgoff >> (VFIO_PCI_OFFSET_SHIFT - PAGE_SHIFT);
1024 if (index >= VFIO_PCI_ROM_REGION_INDEX)
1025 return -EINVAL;
1026
1027 if (vma->vm_end < vma->vm_start)
1028 return -EINVAL;
1029 if ((vma->vm_flags & VM_SHARED) == 0)
1030 return -EINVAL;
1031 if (index != VFIO_PCI_BAR2_REGION_INDEX)
1032 return -EINVAL;
1033
1034 pg_prot = vma->vm_page_prot;
1035 virtaddr = vma->vm_start;
1036 req_size = vma->vm_end - vma->vm_start;
1037 pgoff = vma->vm_pgoff &
1038 ((1U << (VFIO_PCI_OFFSET_SHIFT - PAGE_SHIFT)) - 1);
1039 req_start = pgoff << PAGE_SHIFT;
1040
1041 if (!intel_vgpu_in_aperture(vgpu, req_start))
1042 return -EINVAL;
1043 if (req_start + req_size >
1044 vgpu_aperture_offset(vgpu) + vgpu_aperture_sz(vgpu))
1045 return -EINVAL;
1046
1047 pgoff = (gvt_aperture_pa_base(vgpu->gvt) >> PAGE_SHIFT) + pgoff;
1048
1049 return remap_pfn_range(vma, virtaddr, pgoff, req_size, pg_prot);
1050 }
1051
intel_vgpu_get_irq_count(struct intel_vgpu * vgpu,int type)1052 static int intel_vgpu_get_irq_count(struct intel_vgpu *vgpu, int type)
1053 {
1054 if (type == VFIO_PCI_INTX_IRQ_INDEX || type == VFIO_PCI_MSI_IRQ_INDEX)
1055 return 1;
1056
1057 return 0;
1058 }
1059
intel_vgpu_set_intx_mask(struct intel_vgpu * vgpu,unsigned int index,unsigned int start,unsigned int count,u32 flags,void * data)1060 static int intel_vgpu_set_intx_mask(struct intel_vgpu *vgpu,
1061 unsigned int index, unsigned int start,
1062 unsigned int count, u32 flags,
1063 void *data)
1064 {
1065 return 0;
1066 }
1067
intel_vgpu_set_intx_unmask(struct intel_vgpu * vgpu,unsigned int index,unsigned int start,unsigned int count,u32 flags,void * data)1068 static int intel_vgpu_set_intx_unmask(struct intel_vgpu *vgpu,
1069 unsigned int index, unsigned int start,
1070 unsigned int count, u32 flags, void *data)
1071 {
1072 return 0;
1073 }
1074
intel_vgpu_set_intx_trigger(struct intel_vgpu * vgpu,unsigned int index,unsigned int start,unsigned int count,u32 flags,void * data)1075 static int intel_vgpu_set_intx_trigger(struct intel_vgpu *vgpu,
1076 unsigned int index, unsigned int start, unsigned int count,
1077 u32 flags, void *data)
1078 {
1079 return 0;
1080 }
1081
intel_vgpu_set_msi_trigger(struct intel_vgpu * vgpu,unsigned int index,unsigned int start,unsigned int count,u32 flags,void * data)1082 static int intel_vgpu_set_msi_trigger(struct intel_vgpu *vgpu,
1083 unsigned int index, unsigned int start, unsigned int count,
1084 u32 flags, void *data)
1085 {
1086 struct eventfd_ctx *trigger;
1087
1088 if (flags & VFIO_IRQ_SET_DATA_EVENTFD) {
1089 int fd = *(int *)data;
1090
1091 trigger = eventfd_ctx_fdget(fd);
1092 if (IS_ERR(trigger)) {
1093 gvt_vgpu_err("eventfd_ctx_fdget failed\n");
1094 return PTR_ERR(trigger);
1095 }
1096 vgpu->msi_trigger = trigger;
1097 } else if ((flags & VFIO_IRQ_SET_DATA_NONE) && !count)
1098 intel_vgpu_release_msi_eventfd_ctx(vgpu);
1099
1100 return 0;
1101 }
1102
intel_vgpu_set_irqs(struct intel_vgpu * vgpu,u32 flags,unsigned int index,unsigned int start,unsigned int count,void * data)1103 static int intel_vgpu_set_irqs(struct intel_vgpu *vgpu, u32 flags,
1104 unsigned int index, unsigned int start, unsigned int count,
1105 void *data)
1106 {
1107 int (*func)(struct intel_vgpu *vgpu, unsigned int index,
1108 unsigned int start, unsigned int count, u32 flags,
1109 void *data) = NULL;
1110
1111 switch (index) {
1112 case VFIO_PCI_INTX_IRQ_INDEX:
1113 switch (flags & VFIO_IRQ_SET_ACTION_TYPE_MASK) {
1114 case VFIO_IRQ_SET_ACTION_MASK:
1115 func = intel_vgpu_set_intx_mask;
1116 break;
1117 case VFIO_IRQ_SET_ACTION_UNMASK:
1118 func = intel_vgpu_set_intx_unmask;
1119 break;
1120 case VFIO_IRQ_SET_ACTION_TRIGGER:
1121 func = intel_vgpu_set_intx_trigger;
1122 break;
1123 }
1124 break;
1125 case VFIO_PCI_MSI_IRQ_INDEX:
1126 switch (flags & VFIO_IRQ_SET_ACTION_TYPE_MASK) {
1127 case VFIO_IRQ_SET_ACTION_MASK:
1128 case VFIO_IRQ_SET_ACTION_UNMASK:
1129 /* XXX Need masking support exported */
1130 break;
1131 case VFIO_IRQ_SET_ACTION_TRIGGER:
1132 func = intel_vgpu_set_msi_trigger;
1133 break;
1134 }
1135 break;
1136 }
1137
1138 if (!func)
1139 return -ENOTTY;
1140
1141 return func(vgpu, index, start, count, flags, data);
1142 }
1143
intel_vgpu_ioctl_get_region_info(struct vfio_device * vfio_dev,struct vfio_region_info * info,struct vfio_info_cap * caps)1144 static int intel_vgpu_ioctl_get_region_info(struct vfio_device *vfio_dev,
1145 struct vfio_region_info *info,
1146 struct vfio_info_cap *caps)
1147 {
1148 struct vfio_region_info_cap_sparse_mmap *sparse = NULL;
1149 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
1150 int nr_areas = 1;
1151 int cap_type_id;
1152 unsigned int i;
1153 int ret;
1154
1155 switch (info->index) {
1156 case VFIO_PCI_CONFIG_REGION_INDEX:
1157 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1158 info->size = vgpu->gvt->device_info.cfg_space_size;
1159 info->flags = VFIO_REGION_INFO_FLAG_READ |
1160 VFIO_REGION_INFO_FLAG_WRITE;
1161 break;
1162 case VFIO_PCI_BAR0_REGION_INDEX:
1163 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1164 info->size = vgpu->cfg_space.bar[info->index].size;
1165 if (!info->size) {
1166 info->flags = 0;
1167 break;
1168 }
1169
1170 info->flags = VFIO_REGION_INFO_FLAG_READ |
1171 VFIO_REGION_INFO_FLAG_WRITE;
1172 break;
1173 case VFIO_PCI_BAR1_REGION_INDEX:
1174 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1175 info->size = 0;
1176 info->flags = 0;
1177 break;
1178 case VFIO_PCI_BAR2_REGION_INDEX:
1179 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1180 info->flags = VFIO_REGION_INFO_FLAG_CAPS |
1181 VFIO_REGION_INFO_FLAG_MMAP |
1182 VFIO_REGION_INFO_FLAG_READ |
1183 VFIO_REGION_INFO_FLAG_WRITE;
1184 info->size = gvt_aperture_sz(vgpu->gvt);
1185
1186 sparse = kzalloc(struct_size(sparse, areas, nr_areas),
1187 GFP_KERNEL);
1188 if (!sparse)
1189 return -ENOMEM;
1190
1191 sparse->header.id = VFIO_REGION_INFO_CAP_SPARSE_MMAP;
1192 sparse->header.version = 1;
1193 sparse->nr_areas = nr_areas;
1194 cap_type_id = VFIO_REGION_INFO_CAP_SPARSE_MMAP;
1195 sparse->areas[0].offset =
1196 PAGE_ALIGN(vgpu_aperture_offset(vgpu));
1197 sparse->areas[0].size = vgpu_aperture_sz(vgpu);
1198 break;
1199
1200 case VFIO_PCI_BAR3_REGION_INDEX ... VFIO_PCI_BAR5_REGION_INDEX:
1201 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1202 info->size = 0;
1203 info->flags = 0;
1204
1205 gvt_dbg_core("get region info bar:%d\n", info->index);
1206 break;
1207
1208 case VFIO_PCI_ROM_REGION_INDEX:
1209 case VFIO_PCI_VGA_REGION_INDEX:
1210 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1211 info->size = 0;
1212 info->flags = 0;
1213
1214 gvt_dbg_core("get region info index:%d\n", info->index);
1215 break;
1216 default: {
1217 struct vfio_region_info_cap_type cap_type = {
1218 .header.id = VFIO_REGION_INFO_CAP_TYPE,
1219 .header.version = 1
1220 };
1221
1222 if (info->index >= VFIO_PCI_NUM_REGIONS + vgpu->num_regions)
1223 return -EINVAL;
1224 info->index = array_index_nospec(
1225 info->index, VFIO_PCI_NUM_REGIONS + vgpu->num_regions);
1226
1227 i = info->index - VFIO_PCI_NUM_REGIONS;
1228
1229 info->offset = VFIO_PCI_INDEX_TO_OFFSET(info->index);
1230 info->size = vgpu->region[i].size;
1231 info->flags = vgpu->region[i].flags;
1232
1233 cap_type.type = vgpu->region[i].type;
1234 cap_type.subtype = vgpu->region[i].subtype;
1235
1236 ret = vfio_info_add_capability(caps, &cap_type.header,
1237 sizeof(cap_type));
1238 if (ret)
1239 return ret;
1240 }
1241 }
1242
1243 if ((info->flags & VFIO_REGION_INFO_FLAG_CAPS) && sparse) {
1244 ret = -EINVAL;
1245 if (cap_type_id == VFIO_REGION_INFO_CAP_SPARSE_MMAP) {
1246 ret = vfio_info_add_capability(
1247 caps, &sparse->header,
1248 struct_size(sparse, areas, sparse->nr_areas));
1249 }
1250 if (ret) {
1251 kfree(sparse);
1252 return ret;
1253 }
1254 }
1255
1256 kfree(sparse);
1257 return 0;
1258 }
1259
intel_vgpu_ioctl(struct vfio_device * vfio_dev,unsigned int cmd,unsigned long arg)1260 static long intel_vgpu_ioctl(struct vfio_device *vfio_dev, unsigned int cmd,
1261 unsigned long arg)
1262 {
1263 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
1264 unsigned long minsz;
1265
1266 gvt_dbg_core("vgpu%d ioctl, cmd: %d\n", vgpu->id, cmd);
1267
1268 if (cmd == VFIO_DEVICE_GET_INFO) {
1269 struct vfio_device_info info;
1270
1271 minsz = offsetofend(struct vfio_device_info, num_irqs);
1272
1273 if (copy_from_user(&info, (void __user *)arg, minsz))
1274 return -EFAULT;
1275
1276 if (info.argsz < minsz)
1277 return -EINVAL;
1278
1279 info.flags = VFIO_DEVICE_FLAGS_PCI;
1280 info.flags |= VFIO_DEVICE_FLAGS_RESET;
1281 info.num_regions = VFIO_PCI_NUM_REGIONS +
1282 vgpu->num_regions;
1283 info.num_irqs = VFIO_PCI_NUM_IRQS;
1284
1285 return copy_to_user((void __user *)arg, &info, minsz) ?
1286 -EFAULT : 0;
1287
1288 } else if (cmd == VFIO_DEVICE_GET_IRQ_INFO) {
1289 struct vfio_irq_info info;
1290
1291 minsz = offsetofend(struct vfio_irq_info, count);
1292
1293 if (copy_from_user(&info, (void __user *)arg, minsz))
1294 return -EFAULT;
1295
1296 if (info.argsz < minsz || info.index >= VFIO_PCI_NUM_IRQS)
1297 return -EINVAL;
1298
1299 switch (info.index) {
1300 case VFIO_PCI_INTX_IRQ_INDEX:
1301 case VFIO_PCI_MSI_IRQ_INDEX:
1302 break;
1303 default:
1304 return -EINVAL;
1305 }
1306
1307 info.flags = VFIO_IRQ_INFO_EVENTFD;
1308
1309 info.count = intel_vgpu_get_irq_count(vgpu, info.index);
1310
1311 if (info.index == VFIO_PCI_INTX_IRQ_INDEX)
1312 info.flags |= (VFIO_IRQ_INFO_MASKABLE |
1313 VFIO_IRQ_INFO_AUTOMASKED);
1314 else
1315 info.flags |= VFIO_IRQ_INFO_NORESIZE;
1316
1317 return copy_to_user((void __user *)arg, &info, minsz) ?
1318 -EFAULT : 0;
1319 } else if (cmd == VFIO_DEVICE_SET_IRQS) {
1320 struct vfio_irq_set hdr;
1321 u8 *data = NULL;
1322 int ret = 0;
1323 size_t data_size = 0;
1324
1325 minsz = offsetofend(struct vfio_irq_set, count);
1326
1327 if (copy_from_user(&hdr, (void __user *)arg, minsz))
1328 return -EFAULT;
1329
1330 if (!is_power_of_2(hdr.flags & VFIO_IRQ_SET_DATA_TYPE_MASK) ||
1331 !is_power_of_2(hdr.flags & VFIO_IRQ_SET_ACTION_TYPE_MASK))
1332 return -EINVAL;
1333
1334 if (!(hdr.flags & VFIO_IRQ_SET_DATA_NONE)) {
1335 int max = intel_vgpu_get_irq_count(vgpu, hdr.index);
1336
1337 if (!hdr.count)
1338 return -EINVAL;
1339
1340 ret = vfio_set_irqs_validate_and_prepare(&hdr, max,
1341 VFIO_PCI_NUM_IRQS, &data_size);
1342 if (ret) {
1343 gvt_vgpu_err("vfio_set_irqs_validate_and_prepare failed\n");
1344 return ret;
1345 }
1346
1347 data = memdup_user((void __user *)(arg + minsz),
1348 data_size);
1349 if (IS_ERR(data))
1350 return PTR_ERR(data);
1351 }
1352
1353 ret = intel_vgpu_set_irqs(vgpu, hdr.flags, hdr.index,
1354 hdr.start, hdr.count, data);
1355 kfree(data);
1356
1357 return ret;
1358 } else if (cmd == VFIO_DEVICE_RESET) {
1359 intel_gvt_reset_vgpu(vgpu);
1360 return 0;
1361 } else if (cmd == VFIO_DEVICE_QUERY_GFX_PLANE) {
1362 struct vfio_device_gfx_plane_info dmabuf = {};
1363 int ret = 0;
1364
1365 minsz = offsetofend(struct vfio_device_gfx_plane_info,
1366 dmabuf_id);
1367 if (copy_from_user(&dmabuf, (void __user *)arg, minsz))
1368 return -EFAULT;
1369 if (dmabuf.argsz < minsz)
1370 return -EINVAL;
1371
1372 ret = intel_vgpu_query_plane(vgpu, &dmabuf);
1373 if (ret != 0)
1374 return ret;
1375
1376 return copy_to_user((void __user *)arg, &dmabuf, minsz) ?
1377 -EFAULT : 0;
1378 } else if (cmd == VFIO_DEVICE_GET_GFX_DMABUF) {
1379 __u32 dmabuf_id;
1380
1381 if (get_user(dmabuf_id, (__u32 __user *)arg))
1382 return -EFAULT;
1383 return intel_vgpu_get_dmabuf(vgpu, dmabuf_id);
1384 }
1385
1386 return -ENOTTY;
1387 }
1388
1389 static ssize_t
vgpu_id_show(struct device * dev,struct device_attribute * attr,char * buf)1390 vgpu_id_show(struct device *dev, struct device_attribute *attr,
1391 char *buf)
1392 {
1393 struct intel_vgpu *vgpu = dev_get_drvdata(dev);
1394
1395 return sprintf(buf, "%d\n", vgpu->id);
1396 }
1397
1398 static DEVICE_ATTR_RO(vgpu_id);
1399
1400 static struct attribute *intel_vgpu_attrs[] = {
1401 &dev_attr_vgpu_id.attr,
1402 NULL
1403 };
1404
1405 static const struct attribute_group intel_vgpu_group = {
1406 .name = "intel_vgpu",
1407 .attrs = intel_vgpu_attrs,
1408 };
1409
1410 static const struct attribute_group *intel_vgpu_groups[] = {
1411 &intel_vgpu_group,
1412 NULL,
1413 };
1414
intel_vgpu_init_dev(struct vfio_device * vfio_dev)1415 static int intel_vgpu_init_dev(struct vfio_device *vfio_dev)
1416 {
1417 struct mdev_device *mdev = to_mdev_device(vfio_dev->dev);
1418 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
1419 struct intel_vgpu_type *type =
1420 container_of(mdev->type, struct intel_vgpu_type, type);
1421 int ret;
1422
1423 vgpu->gvt = kdev_to_i915(mdev->type->parent->dev)->gvt;
1424 ret = intel_gvt_create_vgpu(vgpu, type->conf);
1425 if (ret)
1426 return ret;
1427
1428 kvmgt_protect_table_init(vgpu);
1429 gvt_cache_init(vgpu);
1430
1431 return 0;
1432 }
1433
intel_vgpu_release_dev(struct vfio_device * vfio_dev)1434 static void intel_vgpu_release_dev(struct vfio_device *vfio_dev)
1435 {
1436 struct intel_vgpu *vgpu = vfio_dev_to_vgpu(vfio_dev);
1437
1438 intel_gvt_destroy_vgpu(vgpu);
1439 }
1440
1441 static const struct vfio_device_ops intel_vgpu_dev_ops = {
1442 .init = intel_vgpu_init_dev,
1443 .release = intel_vgpu_release_dev,
1444 .open_device = intel_vgpu_open_device,
1445 .close_device = intel_vgpu_close_device,
1446 .read = intel_vgpu_read,
1447 .write = intel_vgpu_write,
1448 .mmap = intel_vgpu_mmap,
1449 .ioctl = intel_vgpu_ioctl,
1450 .get_region_info_caps = intel_vgpu_ioctl_get_region_info,
1451 .dma_unmap = intel_vgpu_dma_unmap,
1452 .bind_iommufd = vfio_iommufd_emulated_bind,
1453 .unbind_iommufd = vfio_iommufd_emulated_unbind,
1454 .attach_ioas = vfio_iommufd_emulated_attach_ioas,
1455 .detach_ioas = vfio_iommufd_emulated_detach_ioas,
1456 };
1457
intel_vgpu_probe(struct mdev_device * mdev)1458 static int intel_vgpu_probe(struct mdev_device *mdev)
1459 {
1460 struct intel_vgpu *vgpu;
1461 int ret;
1462
1463 vgpu = vfio_alloc_device(intel_vgpu, vfio_device, &mdev->dev,
1464 &intel_vgpu_dev_ops);
1465 if (IS_ERR(vgpu)) {
1466 gvt_err("failed to create intel vgpu: %ld\n", PTR_ERR(vgpu));
1467 return PTR_ERR(vgpu);
1468 }
1469
1470 dev_set_drvdata(&mdev->dev, vgpu);
1471 ret = vfio_register_emulated_iommu_dev(&vgpu->vfio_device);
1472 if (ret)
1473 goto out_put_vdev;
1474
1475 gvt_dbg_core("intel_vgpu_create succeeded for mdev: %s\n",
1476 dev_name(mdev_dev(mdev)));
1477 return 0;
1478
1479 out_put_vdev:
1480 vfio_put_device(&vgpu->vfio_device);
1481 return ret;
1482 }
1483
intel_vgpu_remove(struct mdev_device * mdev)1484 static void intel_vgpu_remove(struct mdev_device *mdev)
1485 {
1486 struct intel_vgpu *vgpu = dev_get_drvdata(&mdev->dev);
1487
1488 vfio_unregister_group_dev(&vgpu->vfio_device);
1489 vfio_put_device(&vgpu->vfio_device);
1490 }
1491
intel_vgpu_get_available(struct mdev_type * mtype)1492 static unsigned int intel_vgpu_get_available(struct mdev_type *mtype)
1493 {
1494 struct intel_vgpu_type *type =
1495 container_of(mtype, struct intel_vgpu_type, type);
1496 struct intel_gvt *gvt = kdev_to_i915(mtype->parent->dev)->gvt;
1497 unsigned int low_gm_avail, high_gm_avail, fence_avail;
1498
1499 mutex_lock(&gvt->lock);
1500 low_gm_avail = gvt_aperture_sz(gvt) - HOST_LOW_GM_SIZE -
1501 gvt->gm.vgpu_allocated_low_gm_size;
1502 high_gm_avail = gvt_hidden_sz(gvt) - HOST_HIGH_GM_SIZE -
1503 gvt->gm.vgpu_allocated_high_gm_size;
1504 fence_avail = gvt_fence_sz(gvt) - HOST_FENCE -
1505 gvt->fence.vgpu_allocated_fence_num;
1506 mutex_unlock(&gvt->lock);
1507
1508 return min3(low_gm_avail / type->conf->low_mm,
1509 high_gm_avail / type->conf->high_mm,
1510 fence_avail / type->conf->fence);
1511 }
1512
1513 static struct mdev_driver intel_vgpu_mdev_driver = {
1514 .device_api = VFIO_DEVICE_API_PCI_STRING,
1515 .driver = {
1516 .name = "intel_vgpu_mdev",
1517 .owner = THIS_MODULE,
1518 .dev_groups = intel_vgpu_groups,
1519 },
1520 .probe = intel_vgpu_probe,
1521 .remove = intel_vgpu_remove,
1522 .get_available = intel_vgpu_get_available,
1523 .show_description = intel_vgpu_show_description,
1524 };
1525
intel_gvt_page_track_add(struct intel_vgpu * info,u64 gfn)1526 int intel_gvt_page_track_add(struct intel_vgpu *info, u64 gfn)
1527 {
1528 int r;
1529
1530 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, info->status))
1531 return -ESRCH;
1532
1533 if (kvmgt_gfn_is_write_protected(info, gfn))
1534 return 0;
1535
1536 r = kvm_write_track_add_gfn(info->vfio_device.kvm, gfn);
1537 if (r)
1538 return r;
1539
1540 kvmgt_protect_table_add(info, gfn);
1541 return 0;
1542 }
1543
intel_gvt_page_track_remove(struct intel_vgpu * info,u64 gfn)1544 int intel_gvt_page_track_remove(struct intel_vgpu *info, u64 gfn)
1545 {
1546 int r;
1547
1548 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, info->status))
1549 return -ESRCH;
1550
1551 if (!kvmgt_gfn_is_write_protected(info, gfn))
1552 return 0;
1553
1554 r = kvm_write_track_remove_gfn(info->vfio_device.kvm, gfn);
1555 if (r)
1556 return r;
1557
1558 kvmgt_protect_table_del(info, gfn);
1559 return 0;
1560 }
1561
kvmgt_page_track_write(gpa_t gpa,const u8 * val,int len,struct kvm_page_track_notifier_node * node)1562 static void kvmgt_page_track_write(gpa_t gpa, const u8 *val, int len,
1563 struct kvm_page_track_notifier_node *node)
1564 {
1565 struct intel_vgpu *info =
1566 container_of(node, struct intel_vgpu, track_node);
1567
1568 mutex_lock(&info->vgpu_lock);
1569
1570 if (kvmgt_gfn_is_write_protected(info, gpa >> PAGE_SHIFT))
1571 intel_vgpu_page_track_handler(info, gpa,
1572 (void *)val, len);
1573
1574 mutex_unlock(&info->vgpu_lock);
1575 }
1576
kvmgt_page_track_remove_region(gfn_t gfn,unsigned long nr_pages,struct kvm_page_track_notifier_node * node)1577 static void kvmgt_page_track_remove_region(gfn_t gfn, unsigned long nr_pages,
1578 struct kvm_page_track_notifier_node *node)
1579 {
1580 unsigned long i;
1581 struct intel_vgpu *info =
1582 container_of(node, struct intel_vgpu, track_node);
1583
1584 mutex_lock(&info->vgpu_lock);
1585
1586 for (i = 0; i < nr_pages; i++) {
1587 if (kvmgt_gfn_is_write_protected(info, gfn + i))
1588 kvmgt_protect_table_del(info, gfn + i);
1589 }
1590
1591 mutex_unlock(&info->vgpu_lock);
1592 }
1593
intel_vgpu_detach_regions(struct intel_vgpu * vgpu)1594 void intel_vgpu_detach_regions(struct intel_vgpu *vgpu)
1595 {
1596 int i;
1597
1598 if (!vgpu->region)
1599 return;
1600
1601 for (i = 0; i < vgpu->num_regions; i++)
1602 if (vgpu->region[i].ops->release)
1603 vgpu->region[i].ops->release(vgpu,
1604 &vgpu->region[i]);
1605 vgpu->num_regions = 0;
1606 kfree(vgpu->region);
1607 vgpu->region = NULL;
1608 }
1609
intel_gvt_dma_map_guest_page(struct intel_vgpu * vgpu,unsigned long gfn,unsigned long size,dma_addr_t * dma_addr)1610 int intel_gvt_dma_map_guest_page(struct intel_vgpu *vgpu, unsigned long gfn,
1611 unsigned long size, dma_addr_t *dma_addr)
1612 {
1613 struct gvt_dma *entry;
1614 int ret;
1615
1616 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, vgpu->status))
1617 return -EINVAL;
1618
1619 mutex_lock(&vgpu->cache_lock);
1620
1621 entry = __gvt_cache_find_gfn(vgpu, gfn);
1622 if (!entry) {
1623 ret = gvt_dma_map_page(vgpu, gfn, dma_addr, size);
1624 if (ret)
1625 goto err_unlock;
1626
1627 ret = __gvt_cache_add(vgpu, gfn, *dma_addr, size);
1628 if (ret)
1629 goto err_unmap;
1630 } else if (entry->size != size) {
1631 /* the same gfn with different size: unmap and re-map */
1632 gvt_dma_unmap_page(vgpu, gfn, entry->dma_addr, entry->size);
1633 __gvt_cache_remove_entry(vgpu, entry);
1634
1635 ret = gvt_dma_map_page(vgpu, gfn, dma_addr, size);
1636 if (ret)
1637 goto err_unlock;
1638
1639 ret = __gvt_cache_add(vgpu, gfn, *dma_addr, size);
1640 if (ret)
1641 goto err_unmap;
1642 } else {
1643 kref_get(&entry->ref);
1644 *dma_addr = entry->dma_addr;
1645 }
1646
1647 mutex_unlock(&vgpu->cache_lock);
1648 return 0;
1649
1650 err_unmap:
1651 gvt_dma_unmap_page(vgpu, gfn, *dma_addr, size);
1652 err_unlock:
1653 mutex_unlock(&vgpu->cache_lock);
1654 return ret;
1655 }
1656
intel_gvt_dma_pin_guest_page(struct intel_vgpu * vgpu,dma_addr_t dma_addr)1657 int intel_gvt_dma_pin_guest_page(struct intel_vgpu *vgpu, dma_addr_t dma_addr)
1658 {
1659 struct gvt_dma *entry;
1660 int ret = 0;
1661
1662 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, vgpu->status))
1663 return -EINVAL;
1664
1665 mutex_lock(&vgpu->cache_lock);
1666 entry = __gvt_cache_find_dma_addr(vgpu, dma_addr);
1667 if (entry)
1668 kref_get(&entry->ref);
1669 else
1670 ret = -ENOMEM;
1671 mutex_unlock(&vgpu->cache_lock);
1672
1673 return ret;
1674 }
1675
__gvt_dma_release(struct kref * ref)1676 static void __gvt_dma_release(struct kref *ref)
1677 {
1678 struct gvt_dma *entry = container_of(ref, typeof(*entry), ref);
1679
1680 gvt_dma_unmap_page(entry->vgpu, entry->gfn, entry->dma_addr,
1681 entry->size);
1682 __gvt_cache_remove_entry(entry->vgpu, entry);
1683 }
1684
intel_gvt_dma_unmap_guest_page(struct intel_vgpu * vgpu,dma_addr_t dma_addr)1685 void intel_gvt_dma_unmap_guest_page(struct intel_vgpu *vgpu,
1686 dma_addr_t dma_addr)
1687 {
1688 struct gvt_dma *entry;
1689
1690 if (!test_bit(INTEL_VGPU_STATUS_ATTACHED, vgpu->status))
1691 return;
1692
1693 mutex_lock(&vgpu->cache_lock);
1694 entry = __gvt_cache_find_dma_addr(vgpu, dma_addr);
1695 if (entry)
1696 kref_put(&entry->ref, __gvt_dma_release);
1697 mutex_unlock(&vgpu->cache_lock);
1698 }
1699
init_device_info(struct intel_gvt * gvt)1700 static void init_device_info(struct intel_gvt *gvt)
1701 {
1702 struct intel_gvt_device_info *info = &gvt->device_info;
1703 struct pci_dev *pdev = to_pci_dev(gvt->gt->i915->drm.dev);
1704
1705 info->max_support_vgpus = 8;
1706 info->cfg_space_size = PCI_CFG_SPACE_EXP_SIZE;
1707 info->mmio_size = 2 * 1024 * 1024;
1708 info->mmio_bar = 0;
1709 info->gtt_start_offset = 8 * 1024 * 1024;
1710 info->gtt_entry_size = 8;
1711 info->gtt_entry_size_shift = 3;
1712 info->gmadr_bytes_in_cmd = 8;
1713 info->max_surface_size = 36 * 1024 * 1024;
1714 info->msi_cap_offset = pdev->msi_cap;
1715 }
1716
intel_gvt_test_and_emulate_vblank(struct intel_gvt * gvt)1717 static void intel_gvt_test_and_emulate_vblank(struct intel_gvt *gvt)
1718 {
1719 struct intel_vgpu *vgpu;
1720 int id;
1721
1722 mutex_lock(&gvt->lock);
1723 idr_for_each_entry((&(gvt)->vgpu_idr), (vgpu), (id)) {
1724 if (test_and_clear_bit(INTEL_GVT_REQUEST_EMULATE_VBLANK + id,
1725 (void *)&gvt->service_request)) {
1726 if (test_bit(INTEL_VGPU_STATUS_ACTIVE, vgpu->status))
1727 intel_vgpu_emulate_vblank(vgpu);
1728 }
1729 }
1730 mutex_unlock(&gvt->lock);
1731 }
1732
gvt_service_thread(void * data)1733 static int gvt_service_thread(void *data)
1734 {
1735 struct intel_gvt *gvt = (struct intel_gvt *)data;
1736 int ret;
1737
1738 gvt_dbg_core("service thread start\n");
1739
1740 while (!kthread_should_stop()) {
1741 ret = wait_event_interruptible(gvt->service_thread_wq,
1742 kthread_should_stop() || gvt->service_request);
1743
1744 if (kthread_should_stop())
1745 break;
1746
1747 if (WARN_ONCE(ret, "service thread is waken up by signal.\n"))
1748 continue;
1749
1750 intel_gvt_test_and_emulate_vblank(gvt);
1751
1752 if (test_bit(INTEL_GVT_REQUEST_SCHED,
1753 (void *)&gvt->service_request) ||
1754 test_bit(INTEL_GVT_REQUEST_EVENT_SCHED,
1755 (void *)&gvt->service_request)) {
1756 intel_gvt_schedule(gvt);
1757 }
1758 }
1759
1760 return 0;
1761 }
1762
clean_service_thread(struct intel_gvt * gvt)1763 static void clean_service_thread(struct intel_gvt *gvt)
1764 {
1765 kthread_stop(gvt->service_thread);
1766 }
1767
init_service_thread(struct intel_gvt * gvt)1768 static int init_service_thread(struct intel_gvt *gvt)
1769 {
1770 init_waitqueue_head(&gvt->service_thread_wq);
1771
1772 gvt->service_thread = kthread_run(gvt_service_thread,
1773 gvt, "gvt_service_thread");
1774 if (IS_ERR(gvt->service_thread)) {
1775 gvt_err("fail to start service thread.\n");
1776 return PTR_ERR(gvt->service_thread);
1777 }
1778 return 0;
1779 }
1780
1781 /**
1782 * intel_gvt_clean_device - clean a GVT device
1783 * @i915: i915 private
1784 *
1785 * This function is called at the driver unloading stage, to free the
1786 * resources owned by a GVT device.
1787 *
1788 */
intel_gvt_clean_device(struct drm_i915_private * i915)1789 static void intel_gvt_clean_device(struct drm_i915_private *i915)
1790 {
1791 struct intel_gvt *gvt = fetch_and_zero(&i915->gvt);
1792
1793 if (drm_WARN_ON(&i915->drm, !gvt))
1794 return;
1795
1796 mdev_unregister_parent(&gvt->parent);
1797 intel_gvt_destroy_idle_vgpu(gvt->idle_vgpu);
1798 intel_gvt_clean_vgpu_types(gvt);
1799
1800 intel_gvt_debugfs_clean(gvt);
1801 clean_service_thread(gvt);
1802 intel_gvt_clean_cmd_parser(gvt);
1803 intel_gvt_clean_sched_policy(gvt);
1804 intel_gvt_clean_workload_scheduler(gvt);
1805 intel_gvt_clean_gtt(gvt);
1806 intel_gvt_free_firmware(gvt);
1807 intel_gvt_clean_mmio_info(gvt);
1808 idr_destroy(&gvt->vgpu_idr);
1809
1810 kfree(i915->gvt);
1811 }
1812
1813 /**
1814 * intel_gvt_init_device - initialize a GVT device
1815 * @i915: drm i915 private data
1816 *
1817 * This function is called at the initialization stage, to initialize
1818 * necessary GVT components.
1819 *
1820 * Returns:
1821 * Zero on success, negative error code if failed.
1822 *
1823 */
intel_gvt_init_device(struct drm_i915_private * i915)1824 static int intel_gvt_init_device(struct drm_i915_private *i915)
1825 {
1826 struct intel_gvt *gvt;
1827 struct intel_vgpu *vgpu;
1828 int ret;
1829
1830 if (drm_WARN_ON(&i915->drm, i915->gvt))
1831 return -EEXIST;
1832
1833 gvt = kzalloc(sizeof(struct intel_gvt), GFP_KERNEL);
1834 if (!gvt)
1835 return -ENOMEM;
1836
1837 gvt_dbg_core("init gvt device\n");
1838
1839 idr_init_base(&gvt->vgpu_idr, 1);
1840 spin_lock_init(&gvt->scheduler.mmio_context_lock);
1841 mutex_init(&gvt->lock);
1842 mutex_init(&gvt->sched_lock);
1843 gvt->gt = to_gt(i915);
1844 i915->gvt = gvt;
1845
1846 init_device_info(gvt);
1847
1848 ret = intel_gvt_setup_mmio_info(gvt);
1849 if (ret)
1850 goto out_clean_idr;
1851
1852 intel_gvt_init_engine_mmio_context(gvt);
1853
1854 ret = intel_gvt_load_firmware(gvt);
1855 if (ret)
1856 goto out_clean_mmio_info;
1857
1858 ret = intel_gvt_init_irq(gvt);
1859 if (ret)
1860 goto out_free_firmware;
1861
1862 ret = intel_gvt_init_gtt(gvt);
1863 if (ret)
1864 goto out_free_firmware;
1865
1866 ret = intel_gvt_init_workload_scheduler(gvt);
1867 if (ret)
1868 goto out_clean_gtt;
1869
1870 ret = intel_gvt_init_sched_policy(gvt);
1871 if (ret)
1872 goto out_clean_workload_scheduler;
1873
1874 ret = intel_gvt_init_cmd_parser(gvt);
1875 if (ret)
1876 goto out_clean_sched_policy;
1877
1878 ret = init_service_thread(gvt);
1879 if (ret)
1880 goto out_clean_cmd_parser;
1881
1882 ret = intel_gvt_init_vgpu_types(gvt);
1883 if (ret)
1884 goto out_clean_thread;
1885
1886 vgpu = intel_gvt_create_idle_vgpu(gvt);
1887 if (IS_ERR(vgpu)) {
1888 ret = PTR_ERR(vgpu);
1889 gvt_err("failed to create idle vgpu\n");
1890 goto out_clean_types;
1891 }
1892 gvt->idle_vgpu = vgpu;
1893
1894 intel_gvt_debugfs_init(gvt);
1895
1896 ret = mdev_register_parent(&gvt->parent, i915->drm.dev,
1897 &intel_vgpu_mdev_driver,
1898 gvt->mdev_types, gvt->num_types);
1899 if (ret)
1900 goto out_destroy_idle_vgpu;
1901
1902 gvt_dbg_core("gvt device initialization is done\n");
1903 return 0;
1904
1905 out_destroy_idle_vgpu:
1906 intel_gvt_destroy_idle_vgpu(gvt->idle_vgpu);
1907 intel_gvt_debugfs_clean(gvt);
1908 out_clean_types:
1909 intel_gvt_clean_vgpu_types(gvt);
1910 out_clean_thread:
1911 clean_service_thread(gvt);
1912 out_clean_cmd_parser:
1913 intel_gvt_clean_cmd_parser(gvt);
1914 out_clean_sched_policy:
1915 intel_gvt_clean_sched_policy(gvt);
1916 out_clean_workload_scheduler:
1917 intel_gvt_clean_workload_scheduler(gvt);
1918 out_clean_gtt:
1919 intel_gvt_clean_gtt(gvt);
1920 out_free_firmware:
1921 intel_gvt_free_firmware(gvt);
1922 out_clean_mmio_info:
1923 intel_gvt_clean_mmio_info(gvt);
1924 out_clean_idr:
1925 idr_destroy(&gvt->vgpu_idr);
1926 kfree(gvt);
1927 i915->gvt = NULL;
1928 return ret;
1929 }
1930
intel_gvt_pm_resume(struct drm_i915_private * i915)1931 static void intel_gvt_pm_resume(struct drm_i915_private *i915)
1932 {
1933 struct intel_gvt *gvt = i915->gvt;
1934
1935 intel_gvt_restore_fence(gvt);
1936 intel_gvt_restore_mmio(gvt);
1937 intel_gvt_restore_ggtt(gvt);
1938 }
1939
1940 static const struct intel_vgpu_ops intel_gvt_vgpu_ops = {
1941 .init_device = intel_gvt_init_device,
1942 .clean_device = intel_gvt_clean_device,
1943 .pm_resume = intel_gvt_pm_resume,
1944 };
1945
kvmgt_init(void)1946 static int __init kvmgt_init(void)
1947 {
1948 int ret;
1949
1950 ret = intel_gvt_set_ops(&intel_gvt_vgpu_ops);
1951 if (ret)
1952 return ret;
1953
1954 ret = mdev_register_driver(&intel_vgpu_mdev_driver);
1955 if (ret)
1956 intel_gvt_clear_ops(&intel_gvt_vgpu_ops);
1957 return ret;
1958 }
1959
kvmgt_exit(void)1960 static void __exit kvmgt_exit(void)
1961 {
1962 mdev_unregister_driver(&intel_vgpu_mdev_driver);
1963 intel_gvt_clear_ops(&intel_gvt_vgpu_ops);
1964 }
1965
1966 module_init(kvmgt_init);
1967 module_exit(kvmgt_exit);
1968
1969 MODULE_DESCRIPTION("Intel mediated pass-through framework for KVM");
1970 MODULE_LICENSE("GPL and additional rights");
1971 MODULE_AUTHOR("Intel Corporation");
1972