1 /* 2 * Copyright 2017 Intel Corporation. All rights reserved. 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining a 5 * copy of this software and associated documentation files (the "Software"), 6 * to deal in the Software without restriction, including without limitation 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8 * and/or sell copies of the Software, and to permit persons to whom the 9 * Software is furnished to do so, subject to the following conditions: 10 * 11 * The above copyright notice and this permission notice (including the next 12 * paragraph) shall be included in all copies or substantial portions of the 13 * Software. 14 * 15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING 20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER 21 * DEALINGS IN THE SOFTWARE. 22 * 23 * Authors: 24 * Zhiyuan Lv <zhiyuan.lv@intel.com> 25 * 26 * Contributors: 27 * Xiaoguang Chen 28 * Tina Zhang <tina.zhang@intel.com> 29 */ 30 31 #include <linux/dma-buf.h> 32 #include <linux/vfio.h> 33 34 #include "i915_drv.h" 35 #include "i915_reg.h" 36 #include "gvt.h" 37 38 #define GEN8_DECODE_PTE(pte) (pte & GENMASK_ULL(63, 12)) 39 40 static int vgpu_pin_dma_address(struct intel_vgpu *vgpu, 41 unsigned long size, 42 dma_addr_t dma_addr) 43 { 44 int ret = 0; 45 46 if (intel_gvt_hypervisor_dma_pin_guest_page(vgpu, dma_addr)) 47 ret = -EINVAL; 48 49 return ret; 50 } 51 52 static void vgpu_unpin_dma_address(struct intel_vgpu *vgpu, 53 dma_addr_t dma_addr) 54 { 55 intel_gvt_hypervisor_dma_unmap_guest_page(vgpu, dma_addr); 56 } 57 58 static int vgpu_gem_get_pages( 59 struct drm_i915_gem_object *obj) 60 { 61 struct drm_i915_private *dev_priv = to_i915(obj->base.dev); 62 struct intel_vgpu *vgpu; 63 struct sg_table *st; 64 struct scatterlist *sg; 65 int i, j, ret; 66 gen8_pte_t __iomem *gtt_entries; 67 struct intel_vgpu_fb_info *fb_info; 68 u32 page_num; 69 70 fb_info = (struct intel_vgpu_fb_info *)obj->gvt_info; 71 if (drm_WARN_ON(&dev_priv->drm, !fb_info)) 72 return -ENODEV; 73 74 vgpu = fb_info->obj->vgpu; 75 if (drm_WARN_ON(&dev_priv->drm, !vgpu)) 76 return -ENODEV; 77 78 st = kmalloc(sizeof(*st), GFP_KERNEL); 79 if (unlikely(!st)) 80 return -ENOMEM; 81 82 page_num = obj->base.size >> PAGE_SHIFT; 83 ret = sg_alloc_table(st, page_num, GFP_KERNEL); 84 if (ret) { 85 kfree(st); 86 return ret; 87 } 88 gtt_entries = (gen8_pte_t __iomem *)dev_priv->ggtt.gsm + 89 (fb_info->start >> PAGE_SHIFT); 90 for_each_sg(st->sgl, sg, page_num, i) { 91 dma_addr_t dma_addr = 92 GEN8_DECODE_PTE(readq(>t_entries[i])); 93 if (vgpu_pin_dma_address(vgpu, PAGE_SIZE, dma_addr)) { 94 ret = -EINVAL; 95 goto out; 96 } 97 98 sg->offset = 0; 99 sg->length = PAGE_SIZE; 100 sg_dma_len(sg) = PAGE_SIZE; 101 sg_dma_address(sg) = dma_addr; 102 } 103 104 __i915_gem_object_set_pages(obj, st, PAGE_SIZE); 105 out: 106 if (ret) { 107 dma_addr_t dma_addr; 108 109 for_each_sg(st->sgl, sg, i, j) { 110 dma_addr = sg_dma_address(sg); 111 if (dma_addr) 112 vgpu_unpin_dma_address(vgpu, dma_addr); 113 } 114 sg_free_table(st); 115 kfree(st); 116 } 117 118 return ret; 119 120 } 121 122 static void vgpu_gem_put_pages(struct drm_i915_gem_object *obj, 123 struct sg_table *pages) 124 { 125 struct scatterlist *sg; 126 127 if (obj->base.dma_buf) { 128 struct intel_vgpu_fb_info *fb_info = obj->gvt_info; 129 struct intel_vgpu_dmabuf_obj *obj = fb_info->obj; 130 struct intel_vgpu *vgpu = obj->vgpu; 131 int i; 132 133 for_each_sg(pages->sgl, sg, fb_info->size, i) 134 vgpu_unpin_dma_address(vgpu, 135 sg_dma_address(sg)); 136 } 137 138 sg_free_table(pages); 139 kfree(pages); 140 } 141 142 static void dmabuf_gem_object_free(struct kref *kref) 143 { 144 struct intel_vgpu_dmabuf_obj *obj = 145 container_of(kref, struct intel_vgpu_dmabuf_obj, kref); 146 struct intel_vgpu *vgpu = obj->vgpu; 147 struct list_head *pos; 148 struct intel_vgpu_dmabuf_obj *dmabuf_obj; 149 150 if (vgpu && vgpu->active && !list_empty(&vgpu->dmabuf_obj_list_head)) { 151 list_for_each(pos, &vgpu->dmabuf_obj_list_head) { 152 dmabuf_obj = list_entry(pos, struct intel_vgpu_dmabuf_obj, list); 153 if (dmabuf_obj == obj) { 154 list_del(pos); 155 intel_gvt_hypervisor_put_vfio_device(vgpu); 156 idr_remove(&vgpu->object_idr, 157 dmabuf_obj->dmabuf_id); 158 kfree(dmabuf_obj->info); 159 kfree(dmabuf_obj); 160 break; 161 } 162 } 163 } else { 164 /* Free the orphan dmabuf_objs here */ 165 kfree(obj->info); 166 kfree(obj); 167 } 168 } 169 170 171 static inline void dmabuf_obj_get(struct intel_vgpu_dmabuf_obj *obj) 172 { 173 kref_get(&obj->kref); 174 } 175 176 static inline void dmabuf_obj_put(struct intel_vgpu_dmabuf_obj *obj) 177 { 178 kref_put(&obj->kref, dmabuf_gem_object_free); 179 } 180 181 static void vgpu_gem_release(struct drm_i915_gem_object *gem_obj) 182 { 183 184 struct intel_vgpu_fb_info *fb_info = gem_obj->gvt_info; 185 struct intel_vgpu_dmabuf_obj *obj = fb_info->obj; 186 struct intel_vgpu *vgpu = obj->vgpu; 187 188 if (vgpu) { 189 mutex_lock(&vgpu->dmabuf_lock); 190 gem_obj->base.dma_buf = NULL; 191 dmabuf_obj_put(obj); 192 mutex_unlock(&vgpu->dmabuf_lock); 193 } else { 194 /* vgpu is NULL, as it has been removed already */ 195 gem_obj->base.dma_buf = NULL; 196 dmabuf_obj_put(obj); 197 } 198 } 199 200 static const struct drm_i915_gem_object_ops intel_vgpu_gem_ops = { 201 .name = "i915_gem_object_vgpu", 202 .flags = I915_GEM_OBJECT_IS_PROXY, 203 .get_pages = vgpu_gem_get_pages, 204 .put_pages = vgpu_gem_put_pages, 205 .release = vgpu_gem_release, 206 }; 207 208 static struct drm_i915_gem_object *vgpu_create_gem(struct drm_device *dev, 209 struct intel_vgpu_fb_info *info) 210 { 211 static struct lock_class_key lock_class; 212 struct drm_i915_private *dev_priv = to_i915(dev); 213 struct drm_i915_gem_object *obj; 214 215 obj = i915_gem_object_alloc(); 216 if (obj == NULL) 217 return NULL; 218 219 drm_gem_private_object_init(dev, &obj->base, 220 roundup(info->size, PAGE_SIZE)); 221 i915_gem_object_init(obj, &intel_vgpu_gem_ops, &lock_class, 0); 222 i915_gem_object_set_readonly(obj); 223 224 obj->read_domains = I915_GEM_DOMAIN_GTT; 225 obj->write_domain = 0; 226 if (GRAPHICS_VER(dev_priv) >= 9) { 227 unsigned int tiling_mode = 0; 228 unsigned int stride = 0; 229 230 switch (info->drm_format_mod) { 231 case DRM_FORMAT_MOD_LINEAR: 232 tiling_mode = I915_TILING_NONE; 233 break; 234 case I915_FORMAT_MOD_X_TILED: 235 tiling_mode = I915_TILING_X; 236 stride = info->stride; 237 break; 238 case I915_FORMAT_MOD_Y_TILED: 239 case I915_FORMAT_MOD_Yf_TILED: 240 tiling_mode = I915_TILING_Y; 241 stride = info->stride; 242 break; 243 default: 244 gvt_dbg_core("invalid drm_format_mod %llx for tiling\n", 245 info->drm_format_mod); 246 } 247 obj->tiling_and_stride = tiling_mode | stride; 248 } else { 249 obj->tiling_and_stride = info->drm_format_mod ? 250 I915_TILING_X : 0; 251 } 252 253 return obj; 254 } 255 256 static bool validate_hotspot(struct intel_vgpu_cursor_plane_format *c) 257 { 258 if (c && c->x_hot <= c->width && c->y_hot <= c->height) 259 return true; 260 else 261 return false; 262 } 263 264 static int vgpu_get_plane_info(struct drm_device *dev, 265 struct intel_vgpu *vgpu, 266 struct intel_vgpu_fb_info *info, 267 int plane_id) 268 { 269 struct intel_vgpu_primary_plane_format p; 270 struct intel_vgpu_cursor_plane_format c; 271 int ret, tile_height = 1; 272 273 memset(info, 0, sizeof(*info)); 274 275 if (plane_id == DRM_PLANE_TYPE_PRIMARY) { 276 ret = intel_vgpu_decode_primary_plane(vgpu, &p); 277 if (ret) 278 return ret; 279 info->start = p.base; 280 info->start_gpa = p.base_gpa; 281 info->width = p.width; 282 info->height = p.height; 283 info->stride = p.stride; 284 info->drm_format = p.drm_format; 285 286 switch (p.tiled) { 287 case PLANE_CTL_TILED_LINEAR: 288 info->drm_format_mod = DRM_FORMAT_MOD_LINEAR; 289 break; 290 case PLANE_CTL_TILED_X: 291 info->drm_format_mod = I915_FORMAT_MOD_X_TILED; 292 tile_height = 8; 293 break; 294 case PLANE_CTL_TILED_Y: 295 info->drm_format_mod = I915_FORMAT_MOD_Y_TILED; 296 tile_height = 32; 297 break; 298 case PLANE_CTL_TILED_YF: 299 info->drm_format_mod = I915_FORMAT_MOD_Yf_TILED; 300 tile_height = 32; 301 break; 302 default: 303 gvt_vgpu_err("invalid tiling mode: %x\n", p.tiled); 304 } 305 } else if (plane_id == DRM_PLANE_TYPE_CURSOR) { 306 ret = intel_vgpu_decode_cursor_plane(vgpu, &c); 307 if (ret) 308 return ret; 309 info->start = c.base; 310 info->start_gpa = c.base_gpa; 311 info->width = c.width; 312 info->height = c.height; 313 info->stride = c.width * (c.bpp / 8); 314 info->drm_format = c.drm_format; 315 info->drm_format_mod = 0; 316 info->x_pos = c.x_pos; 317 info->y_pos = c.y_pos; 318 319 if (validate_hotspot(&c)) { 320 info->x_hot = c.x_hot; 321 info->y_hot = c.y_hot; 322 } else { 323 info->x_hot = UINT_MAX; 324 info->y_hot = UINT_MAX; 325 } 326 } else { 327 gvt_vgpu_err("invalid plane id:%d\n", plane_id); 328 return -EINVAL; 329 } 330 331 info->size = info->stride * roundup(info->height, tile_height); 332 if (info->size == 0) { 333 gvt_vgpu_err("fb size is zero\n"); 334 return -EINVAL; 335 } 336 337 if (info->start & (PAGE_SIZE - 1)) { 338 gvt_vgpu_err("Not aligned fb address:0x%llx\n", info->start); 339 return -EFAULT; 340 } 341 342 if (!intel_gvt_ggtt_validate_range(vgpu, info->start, info->size)) { 343 gvt_vgpu_err("invalid gma addr\n"); 344 return -EFAULT; 345 } 346 347 return 0; 348 } 349 350 static struct intel_vgpu_dmabuf_obj * 351 pick_dmabuf_by_info(struct intel_vgpu *vgpu, 352 struct intel_vgpu_fb_info *latest_info) 353 { 354 struct list_head *pos; 355 struct intel_vgpu_fb_info *fb_info; 356 struct intel_vgpu_dmabuf_obj *dmabuf_obj = NULL; 357 struct intel_vgpu_dmabuf_obj *ret = NULL; 358 359 list_for_each(pos, &vgpu->dmabuf_obj_list_head) { 360 dmabuf_obj = list_entry(pos, struct intel_vgpu_dmabuf_obj, list); 361 if (!dmabuf_obj->info) 362 continue; 363 364 fb_info = (struct intel_vgpu_fb_info *)dmabuf_obj->info; 365 if ((fb_info->start == latest_info->start) && 366 (fb_info->start_gpa == latest_info->start_gpa) && 367 (fb_info->size == latest_info->size) && 368 (fb_info->drm_format_mod == latest_info->drm_format_mod) && 369 (fb_info->drm_format == latest_info->drm_format) && 370 (fb_info->width == latest_info->width) && 371 (fb_info->height == latest_info->height)) { 372 ret = dmabuf_obj; 373 break; 374 } 375 } 376 377 return ret; 378 } 379 380 static struct intel_vgpu_dmabuf_obj * 381 pick_dmabuf_by_num(struct intel_vgpu *vgpu, u32 id) 382 { 383 struct list_head *pos; 384 struct intel_vgpu_dmabuf_obj *dmabuf_obj = NULL; 385 struct intel_vgpu_dmabuf_obj *ret = NULL; 386 387 list_for_each(pos, &vgpu->dmabuf_obj_list_head) { 388 dmabuf_obj = list_entry(pos, struct intel_vgpu_dmabuf_obj, list); 389 if (dmabuf_obj->dmabuf_id == id) { 390 ret = dmabuf_obj; 391 break; 392 } 393 } 394 395 return ret; 396 } 397 398 static void update_fb_info(struct vfio_device_gfx_plane_info *gvt_dmabuf, 399 struct intel_vgpu_fb_info *fb_info) 400 { 401 gvt_dmabuf->drm_format = fb_info->drm_format; 402 gvt_dmabuf->drm_format_mod = fb_info->drm_format_mod; 403 gvt_dmabuf->width = fb_info->width; 404 gvt_dmabuf->height = fb_info->height; 405 gvt_dmabuf->stride = fb_info->stride; 406 gvt_dmabuf->size = fb_info->size; 407 gvt_dmabuf->x_pos = fb_info->x_pos; 408 gvt_dmabuf->y_pos = fb_info->y_pos; 409 gvt_dmabuf->x_hot = fb_info->x_hot; 410 gvt_dmabuf->y_hot = fb_info->y_hot; 411 } 412 413 int intel_vgpu_query_plane(struct intel_vgpu *vgpu, void *args) 414 { 415 struct drm_device *dev = &vgpu->gvt->gt->i915->drm; 416 struct vfio_device_gfx_plane_info *gfx_plane_info = args; 417 struct intel_vgpu_dmabuf_obj *dmabuf_obj; 418 struct intel_vgpu_fb_info fb_info; 419 int ret = 0; 420 421 if (gfx_plane_info->flags == (VFIO_GFX_PLANE_TYPE_DMABUF | 422 VFIO_GFX_PLANE_TYPE_PROBE)) 423 return ret; 424 else if ((gfx_plane_info->flags & ~VFIO_GFX_PLANE_TYPE_DMABUF) || 425 (!gfx_plane_info->flags)) 426 return -EINVAL; 427 428 ret = vgpu_get_plane_info(dev, vgpu, &fb_info, 429 gfx_plane_info->drm_plane_type); 430 if (ret != 0) 431 goto out; 432 433 mutex_lock(&vgpu->dmabuf_lock); 434 /* If exists, pick up the exposed dmabuf_obj */ 435 dmabuf_obj = pick_dmabuf_by_info(vgpu, &fb_info); 436 if (dmabuf_obj) { 437 update_fb_info(gfx_plane_info, &fb_info); 438 gfx_plane_info->dmabuf_id = dmabuf_obj->dmabuf_id; 439 440 /* This buffer may be released between query_plane ioctl and 441 * get_dmabuf ioctl. Add the refcount to make sure it won't 442 * be released between the two ioctls. 443 */ 444 if (!dmabuf_obj->initref) { 445 dmabuf_obj->initref = true; 446 dmabuf_obj_get(dmabuf_obj); 447 } 448 ret = 0; 449 gvt_dbg_dpy("vgpu%d: re-use dmabuf_obj ref %d, id %d\n", 450 vgpu->id, kref_read(&dmabuf_obj->kref), 451 gfx_plane_info->dmabuf_id); 452 mutex_unlock(&vgpu->dmabuf_lock); 453 goto out; 454 } 455 456 mutex_unlock(&vgpu->dmabuf_lock); 457 458 /* Need to allocate a new one*/ 459 dmabuf_obj = kmalloc(sizeof(struct intel_vgpu_dmabuf_obj), GFP_KERNEL); 460 if (unlikely(!dmabuf_obj)) { 461 gvt_vgpu_err("alloc dmabuf_obj failed\n"); 462 ret = -ENOMEM; 463 goto out; 464 } 465 466 dmabuf_obj->info = kmalloc(sizeof(struct intel_vgpu_fb_info), 467 GFP_KERNEL); 468 if (unlikely(!dmabuf_obj->info)) { 469 gvt_vgpu_err("allocate intel vgpu fb info failed\n"); 470 ret = -ENOMEM; 471 goto out_free_dmabuf; 472 } 473 memcpy(dmabuf_obj->info, &fb_info, sizeof(struct intel_vgpu_fb_info)); 474 475 ((struct intel_vgpu_fb_info *)dmabuf_obj->info)->obj = dmabuf_obj; 476 477 dmabuf_obj->vgpu = vgpu; 478 479 ret = idr_alloc(&vgpu->object_idr, dmabuf_obj, 1, 0, GFP_NOWAIT); 480 if (ret < 0) 481 goto out_free_info; 482 gfx_plane_info->dmabuf_id = ret; 483 dmabuf_obj->dmabuf_id = ret; 484 485 dmabuf_obj->initref = true; 486 487 kref_init(&dmabuf_obj->kref); 488 489 mutex_lock(&vgpu->dmabuf_lock); 490 if (intel_gvt_hypervisor_get_vfio_device(vgpu)) { 491 gvt_vgpu_err("get vfio device failed\n"); 492 mutex_unlock(&vgpu->dmabuf_lock); 493 goto out_free_info; 494 } 495 mutex_unlock(&vgpu->dmabuf_lock); 496 497 update_fb_info(gfx_plane_info, &fb_info); 498 499 INIT_LIST_HEAD(&dmabuf_obj->list); 500 mutex_lock(&vgpu->dmabuf_lock); 501 list_add_tail(&dmabuf_obj->list, &vgpu->dmabuf_obj_list_head); 502 mutex_unlock(&vgpu->dmabuf_lock); 503 504 gvt_dbg_dpy("vgpu%d: %s new dmabuf_obj ref %d, id %d\n", vgpu->id, 505 __func__, kref_read(&dmabuf_obj->kref), ret); 506 507 return 0; 508 509 out_free_info: 510 kfree(dmabuf_obj->info); 511 out_free_dmabuf: 512 kfree(dmabuf_obj); 513 out: 514 /* ENODEV means plane isn't ready, which might be a normal case. */ 515 return (ret == -ENODEV) ? 0 : ret; 516 } 517 518 /* To associate an exposed dmabuf with the dmabuf_obj */ 519 int intel_vgpu_get_dmabuf(struct intel_vgpu *vgpu, unsigned int dmabuf_id) 520 { 521 struct drm_device *dev = &vgpu->gvt->gt->i915->drm; 522 struct intel_vgpu_dmabuf_obj *dmabuf_obj; 523 struct drm_i915_gem_object *obj; 524 struct dma_buf *dmabuf; 525 int dmabuf_fd; 526 int ret = 0; 527 528 mutex_lock(&vgpu->dmabuf_lock); 529 530 dmabuf_obj = pick_dmabuf_by_num(vgpu, dmabuf_id); 531 if (dmabuf_obj == NULL) { 532 gvt_vgpu_err("invalid dmabuf id:%d\n", dmabuf_id); 533 ret = -EINVAL; 534 goto out; 535 } 536 537 obj = vgpu_create_gem(dev, dmabuf_obj->info); 538 if (obj == NULL) { 539 gvt_vgpu_err("create gvt gem obj failed\n"); 540 ret = -ENOMEM; 541 goto out; 542 } 543 544 obj->gvt_info = dmabuf_obj->info; 545 546 dmabuf = i915_gem_prime_export(&obj->base, DRM_CLOEXEC | DRM_RDWR); 547 if (IS_ERR(dmabuf)) { 548 gvt_vgpu_err("export dma-buf failed\n"); 549 ret = PTR_ERR(dmabuf); 550 goto out_free_gem; 551 } 552 553 ret = dma_buf_fd(dmabuf, DRM_CLOEXEC | DRM_RDWR); 554 if (ret < 0) { 555 gvt_vgpu_err("create dma-buf fd failed ret:%d\n", ret); 556 goto out_free_dmabuf; 557 } 558 dmabuf_fd = ret; 559 560 dmabuf_obj_get(dmabuf_obj); 561 562 if (dmabuf_obj->initref) { 563 dmabuf_obj->initref = false; 564 dmabuf_obj_put(dmabuf_obj); 565 } 566 567 mutex_unlock(&vgpu->dmabuf_lock); 568 569 gvt_dbg_dpy("vgpu%d: dmabuf:%d, dmabuf ref %d, fd:%d\n" 570 " file count: %ld, GEM ref: %d\n", 571 vgpu->id, dmabuf_obj->dmabuf_id, 572 kref_read(&dmabuf_obj->kref), 573 dmabuf_fd, 574 file_count(dmabuf->file), 575 kref_read(&obj->base.refcount)); 576 577 i915_gem_object_put(obj); 578 579 return dmabuf_fd; 580 581 out_free_dmabuf: 582 dma_buf_put(dmabuf); 583 out_free_gem: 584 i915_gem_object_put(obj); 585 out: 586 mutex_unlock(&vgpu->dmabuf_lock); 587 return ret; 588 } 589 590 void intel_vgpu_dmabuf_cleanup(struct intel_vgpu *vgpu) 591 { 592 struct list_head *pos, *n; 593 struct intel_vgpu_dmabuf_obj *dmabuf_obj; 594 595 mutex_lock(&vgpu->dmabuf_lock); 596 list_for_each_safe(pos, n, &vgpu->dmabuf_obj_list_head) { 597 dmabuf_obj = list_entry(pos, struct intel_vgpu_dmabuf_obj, list); 598 dmabuf_obj->vgpu = NULL; 599 600 idr_remove(&vgpu->object_idr, dmabuf_obj->dmabuf_id); 601 intel_gvt_hypervisor_put_vfio_device(vgpu); 602 list_del(pos); 603 604 /* dmabuf_obj might be freed in dmabuf_obj_put */ 605 if (dmabuf_obj->initref) { 606 dmabuf_obj->initref = false; 607 dmabuf_obj_put(dmabuf_obj); 608 } 609 610 } 611 mutex_unlock(&vgpu->dmabuf_lock); 612 } 613