drivers/gpu/drm/i915/gvt/dmabuf.c

   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 "gvt.h"
  36
  37 #define GEN8_DECODE_PTE(pte) (pte & GENMASK_ULL(63, 12))
  38
  39 static int vgpu_gem_get_pages(
  40                 struct drm_i915_gem_object *obj)
  41 {
  42         struct drm_i915_private *dev_priv = to_i915(obj->base.dev);
  43         struct sg_table *st;
  44         struct scatterlist *sg;
  45         int i, ret;
  46         gen8_pte_t __iomem *gtt_entries;
  47         struct intel_vgpu_fb_info *fb_info;
  48
  49         fb_info = (struct intel_vgpu_fb_info *)obj->gvt_info;
  50         if (WARN_ON(!fb_info))
  51                 return -ENODEV;
  52
  53         st = kmalloc(sizeof(*st), GFP_KERNEL);
  54         if (unlikely(!st))
  55                 return -ENOMEM;
  56
  57         ret = sg_alloc_table(st, fb_info->size, GFP_KERNEL);
  58         if (ret) {
  59                 kfree(st);
  60                 return ret;
  61         }
  62         gtt_entries = (gen8_pte_t __iomem *)dev_priv->ggtt.gsm +
  63                 (fb_info->start >> PAGE_SHIFT);
  64         for_each_sg(st->sgl, sg, fb_info->size, i) {
  65                 sg->offset = 0;
  66                 sg->length = PAGE_SIZE;
  67                 sg_dma_address(sg) =
  68                         GEN8_DECODE_PTE(readq(&gtt_entries[i]));
  69                 sg_dma_len(sg) = PAGE_SIZE;
  70         }
  71
  72         __i915_gem_object_set_pages(obj, st, PAGE_SIZE);
  73
  74         return 0;
  75 }
  76
  77 static void vgpu_gem_put_pages(struct drm_i915_gem_object *obj,
  78                 struct sg_table *pages)
  79 {
  80         sg_free_table(pages);
  81         kfree(pages);
  82 }
  83
  84 static void dmabuf_gem_object_free(struct kref *kref)
  85 {
  86         struct intel_vgpu_dmabuf_obj *obj =
  87                 container_of(kref, struct intel_vgpu_dmabuf_obj, kref);
  88         struct intel_vgpu *vgpu = obj->vgpu;
  89         struct list_head *pos;
  90         struct intel_vgpu_dmabuf_obj *dmabuf_obj;
  91
  92         if (vgpu && vgpu->active && !list_empty(&vgpu->dmabuf_obj_list_head)) {
  93                 list_for_each(pos, &vgpu->dmabuf_obj_list_head) {
  94                         dmabuf_obj = container_of(pos,
  95                                         struct intel_vgpu_dmabuf_obj, list);
  96                         if (dmabuf_obj == obj) {
  97                                 intel_gvt_hypervisor_put_vfio_device(vgpu);
  98                                 idr_remove(&vgpu->object_idr,
  99                                            dmabuf_obj->dmabuf_id);
 100                                 kfree(dmabuf_obj->info);
 101                                 kfree(dmabuf_obj);
 102                                 list_del(pos);
 103                                 break;
 104                         }
 105                 }
 106         } else {
 107                 /* Free the orphan dmabuf_objs here */
 108                 kfree(obj->info);
 109                 kfree(obj);
 110         }
 111 }
 112
 113
 114 static inline void dmabuf_obj_get(struct intel_vgpu_dmabuf_obj *obj)
 115 {
 116         kref_get(&obj->kref);
 117 }
 118
 119 static inline void dmabuf_obj_put(struct intel_vgpu_dmabuf_obj *obj)
 120 {
 121         kref_put(&obj->kref, dmabuf_gem_object_free);
 122 }
 123
 124 static void vgpu_gem_release(struct drm_i915_gem_object *gem_obj)
 125 {
 126
 127         struct intel_vgpu_fb_info *fb_info = gem_obj->gvt_info;
 128         struct intel_vgpu_dmabuf_obj *obj = fb_info->obj;
 129         struct intel_vgpu *vgpu = obj->vgpu;
 130
 131         if (vgpu) {
 132                 mutex_lock(&vgpu->dmabuf_lock);
 133                 gem_obj->base.dma_buf = NULL;
 134                 dmabuf_obj_put(obj);
 135                 mutex_unlock(&vgpu->dmabuf_lock);
 136         } else {
 137                 /* vgpu is NULL, as it has been removed already */
 138                 gem_obj->base.dma_buf = NULL;
 139                 dmabuf_obj_put(obj);
 140         }
 141 }
 142
 143 static const struct drm_i915_gem_object_ops intel_vgpu_gem_ops = {
 144         .flags = I915_GEM_OBJECT_IS_PROXY,
 145         .get_pages = vgpu_gem_get_pages,
 146         .put_pages = vgpu_gem_put_pages,
 147         .release = vgpu_gem_release,
 148 };
 149
 150 static struct drm_i915_gem_object *vgpu_create_gem(struct drm_device *dev,
 151                 struct intel_vgpu_fb_info *info)
 152 {
 153         struct drm_i915_private *dev_priv = to_i915(dev);
 154         struct drm_i915_gem_object *obj;
 155
 156         obj = i915_gem_object_alloc();
 157         if (obj == NULL)
 158                 return NULL;
 159
 160         drm_gem_private_object_init(dev, &obj->base,
 161                 info->size << PAGE_SHIFT);
 162         i915_gem_object_init(obj, &intel_vgpu_gem_ops);
 163
 164         obj->read_domains = I915_GEM_DOMAIN_GTT;
 165         obj->write_domain = 0;
 166         if (INTEL_GEN(dev_priv) >= 9) {
 167                 unsigned int tiling_mode = 0;
 168                 unsigned int stride = 0;
 169
 170                 switch (info->drm_format_mod) {
 171                 case DRM_FORMAT_MOD_LINEAR:
 172                         tiling_mode = I915_TILING_NONE;
 173                         break;
 174                 case I915_FORMAT_MOD_X_TILED:
 175                         tiling_mode = I915_TILING_X;
 176                         stride = info->stride;
 177                         break;
 178                 case I915_FORMAT_MOD_Y_TILED:
 179                 case I915_FORMAT_MOD_Yf_TILED:
 180                         tiling_mode = I915_TILING_Y;
 181                         stride = info->stride;
 182                         break;
 183                 default:
 184                         gvt_dbg_core("invalid drm_format_mod %llx for tiling\n",
 185                                      info->drm_format_mod);
 186                 }
 187                 obj->tiling_and_stride = tiling_mode | stride;
 188         } else {
 189                 obj->tiling_and_stride = info->drm_format_mod ?
 190                                         I915_TILING_X : 0;
 191         }
 192
 193         return obj;
 194 }
 195
 196 static bool validate_hotspot(struct intel_vgpu_cursor_plane_format *c)
 197 {
 198         if (c && c->x_hot <= c->width && c->y_hot <= c->height)
 199                 return true;
 200         else
 201                 return false;
 202 }
 203
 204 static int vgpu_get_plane_info(struct drm_device *dev,
 205                 struct intel_vgpu *vgpu,
 206                 struct intel_vgpu_fb_info *info,
 207                 int plane_id)
 208 {
 209         struct drm_i915_private *dev_priv = to_i915(dev);
 210         struct intel_vgpu_primary_plane_format p;
 211         struct intel_vgpu_cursor_plane_format c;
 212         int ret, tile_height = 1;
 213
 214         if (plane_id == DRM_PLANE_TYPE_PRIMARY) {
 215                 ret = intel_vgpu_decode_primary_plane(vgpu, &p);
 216                 if (ret)
 217                         return ret;
 218                 info->start = p.base;
 219                 info->start_gpa = p.base_gpa;
 220                 info->width = p.width;
 221                 info->height = p.height;
 222                 info->stride = p.stride;
 223                 info->drm_format = p.drm_format;
 224
 225                 switch (p.tiled) {
 226                 case PLANE_CTL_TILED_LINEAR:
 227                         info->drm_format_mod = DRM_FORMAT_MOD_LINEAR;
 228                         break;
 229                 case PLANE_CTL_TILED_X:
 230                         info->drm_format_mod = I915_FORMAT_MOD_X_TILED;
 231                         tile_height = 8;
 232                         break;
 233                 case PLANE_CTL_TILED_Y:
 234                         info->drm_format_mod = I915_FORMAT_MOD_Y_TILED;
 235                         tile_height = 32;
 236                         break;
 237                 case PLANE_CTL_TILED_YF:
 238                         info->drm_format_mod = I915_FORMAT_MOD_Yf_TILED;
 239                         tile_height = 32;
 240                         break;
 241                 default:
 242                         gvt_vgpu_err("invalid tiling mode: %x\n", p.tiled);
 243                 }
 244         } else if (plane_id == DRM_PLANE_TYPE_CURSOR) {
 245                 ret = intel_vgpu_decode_cursor_plane(vgpu, &c);
 246                 if (ret)
 247                         return ret;
 248                 info->start = c.base;
 249                 info->start_gpa = c.base_gpa;
 250                 info->width = c.width;
 251                 info->height = c.height;
 252                 info->stride = c.width * (c.bpp / 8);
 253                 info->drm_format = c.drm_format;
 254                 info->drm_format_mod = 0;
 255                 info->x_pos = c.x_pos;
 256                 info->y_pos = c.y_pos;
 257
 258                 if (validate_hotspot(&c)) {
 259                         info->x_hot = c.x_hot;
 260                         info->y_hot = c.y_hot;
 261                 } else {
 262                         info->x_hot = UINT_MAX;
 263                         info->y_hot = UINT_MAX;
 264                 }
 265         } else {
 266                 gvt_vgpu_err("invalid plane id:%d\n", plane_id);
 267                 return -EINVAL;
 268         }
 269
 270         info->size = (info->stride * roundup(info->height, tile_height)
 271                       + PAGE_SIZE - 1) >> PAGE_SHIFT;
 272         if (info->size == 0) {
 273                 gvt_vgpu_err("fb size is zero\n");
 274                 return -EINVAL;
 275         }
 276
 277         if (info->start & (PAGE_SIZE - 1)) {
 278                 gvt_vgpu_err("Not aligned fb address:0x%llx\n", info->start);
 279                 return -EFAULT;
 280         }
 281         if (((info->start >> PAGE_SHIFT) + info->size) >
 282                 ggtt_total_entries(&dev_priv->ggtt)) {
 283                 gvt_vgpu_err("Invalid GTT offset or size\n");
 284                 return -EFAULT;
 285         }
 286
 287         if (!intel_gvt_ggtt_validate_range(vgpu, info->start, info->size)) {
 288                 gvt_vgpu_err("invalid gma addr\n");
 289                 return -EFAULT;
 290         }
 291
 292         return 0;
 293 }
 294
 295 static struct intel_vgpu_dmabuf_obj *
 296 pick_dmabuf_by_info(struct intel_vgpu *vgpu,
 297                     struct intel_vgpu_fb_info *latest_info)
 298 {
 299         struct list_head *pos;
 300         struct intel_vgpu_fb_info *fb_info;
 301         struct intel_vgpu_dmabuf_obj *dmabuf_obj = NULL;
 302         struct intel_vgpu_dmabuf_obj *ret = NULL;
 303
 304         list_for_each(pos, &vgpu->dmabuf_obj_list_head) {
 305                 dmabuf_obj = container_of(pos, struct intel_vgpu_dmabuf_obj,
 306                                                 list);
 307                 if ((dmabuf_obj == NULL) ||
 308                     (dmabuf_obj->info == NULL))
 309                         continue;
 310
 311                 fb_info = (struct intel_vgpu_fb_info *)dmabuf_obj->info;
 312                 if ((fb_info->start == latest_info->start) &&
 313                     (fb_info->start_gpa == latest_info->start_gpa) &&
 314                     (fb_info->size == latest_info->size) &&
 315                     (fb_info->drm_format_mod == latest_info->drm_format_mod) &&
 316                     (fb_info->drm_format == latest_info->drm_format) &&
 317                     (fb_info->width == latest_info->width) &&
 318                     (fb_info->height == latest_info->height)) {
 319                         ret = dmabuf_obj;
 320                         break;
 321                 }
 322         }
 323
 324         return ret;
 325 }
 326
 327 static struct intel_vgpu_dmabuf_obj *
 328 pick_dmabuf_by_num(struct intel_vgpu *vgpu, u32 id)
 329 {
 330         struct list_head *pos;
 331         struct intel_vgpu_dmabuf_obj *dmabuf_obj = NULL;
 332         struct intel_vgpu_dmabuf_obj *ret = NULL;
 333
 334         list_for_each(pos, &vgpu->dmabuf_obj_list_head) {
 335                 dmabuf_obj = container_of(pos, struct intel_vgpu_dmabuf_obj,
 336                                                 list);
 337                 if (!dmabuf_obj)
 338                         continue;
 339
 340                 if (dmabuf_obj->dmabuf_id == id) {
 341                         ret = dmabuf_obj;
 342                         break;
 343                 }
 344         }
 345
 346         return ret;
 347 }
 348
 349 static void update_fb_info(struct vfio_device_gfx_plane_info *gvt_dmabuf,
 350                       struct intel_vgpu_fb_info *fb_info)
 351 {
 352         gvt_dmabuf->drm_format = fb_info->drm_format;
 353         gvt_dmabuf->drm_format_mod = fb_info->drm_format_mod;
 354         gvt_dmabuf->width = fb_info->width;
 355         gvt_dmabuf->height = fb_info->height;
 356         gvt_dmabuf->stride = fb_info->stride;
 357         gvt_dmabuf->size = fb_info->size;
 358         gvt_dmabuf->x_pos = fb_info->x_pos;
 359         gvt_dmabuf->y_pos = fb_info->y_pos;
 360         gvt_dmabuf->x_hot = fb_info->x_hot;
 361         gvt_dmabuf->y_hot = fb_info->y_hot;
 362 }
 363
 364 int intel_vgpu_query_plane(struct intel_vgpu *vgpu, void *args)
 365 {
 366         struct drm_device *dev = &vgpu->gvt->dev_priv->drm;
 367         struct vfio_device_gfx_plane_info *gfx_plane_info = args;
 368         struct intel_vgpu_dmabuf_obj *dmabuf_obj;
 369         struct intel_vgpu_fb_info fb_info;
 370         int ret = 0;
 371
 372         if (gfx_plane_info->flags == (VFIO_GFX_PLANE_TYPE_DMABUF |
 373                                        VFIO_GFX_PLANE_TYPE_PROBE))
 374                 return ret;
 375         else if ((gfx_plane_info->flags & ~VFIO_GFX_PLANE_TYPE_DMABUF) ||
 376                         (!gfx_plane_info->flags))
 377                 return -EINVAL;
 378
 379         ret = vgpu_get_plane_info(dev, vgpu, &fb_info,
 380                                         gfx_plane_info->drm_plane_type);
 381         if (ret != 0)
 382                 goto out;
 383
 384         mutex_lock(&vgpu->dmabuf_lock);
 385         /* If exists, pick up the exposed dmabuf_obj */
 386         dmabuf_obj = pick_dmabuf_by_info(vgpu, &fb_info);
 387         if (dmabuf_obj) {
 388                 update_fb_info(gfx_plane_info, &fb_info);
 389                 gfx_plane_info->dmabuf_id = dmabuf_obj->dmabuf_id;
 390
 391                 /* This buffer may be released between query_plane ioctl and
 392                  * get_dmabuf ioctl. Add the refcount to make sure it won't
 393                  * be released between the two ioctls.
 394                  */
 395                 if (!dmabuf_obj->initref) {
 396                         dmabuf_obj->initref = true;
 397                         dmabuf_obj_get(dmabuf_obj);
 398                 }
 399                 ret = 0;
 400                 gvt_dbg_dpy("vgpu%d: re-use dmabuf_obj ref %d, id %d\n",
 401                             vgpu->id, kref_read(&dmabuf_obj->kref),
 402                             gfx_plane_info->dmabuf_id);
 403                 mutex_unlock(&vgpu->dmabuf_lock);
 404                 goto out;
 405         }
 406
 407         mutex_unlock(&vgpu->dmabuf_lock);
 408
 409         /* Need to allocate a new one*/
 410         dmabuf_obj = kmalloc(sizeof(struct intel_vgpu_dmabuf_obj), GFP_KERNEL);
 411         if (unlikely(!dmabuf_obj)) {
 412                 gvt_vgpu_err("alloc dmabuf_obj failed\n");
 413                 ret = -ENOMEM;
 414                 goto out;
 415         }
 416
 417         dmabuf_obj->info = kmalloc(sizeof(struct intel_vgpu_fb_info),
 418                                    GFP_KERNEL);
 419         if (unlikely(!dmabuf_obj->info)) {
 420                 gvt_vgpu_err("allocate intel vgpu fb info failed\n");
 421                 ret = -ENOMEM;
 422                 goto out_free_dmabuf;
 423         }
 424         memcpy(dmabuf_obj->info, &fb_info, sizeof(struct intel_vgpu_fb_info));
 425
 426         ((struct intel_vgpu_fb_info *)dmabuf_obj->info)->obj = dmabuf_obj;
 427
 428         dmabuf_obj->vgpu = vgpu;
 429
 430         ret = idr_alloc(&vgpu->object_idr, dmabuf_obj, 1, 0, GFP_NOWAIT);
 431         if (ret < 0)
 432                 goto out_free_info;
 433         gfx_plane_info->dmabuf_id = ret;
 434         dmabuf_obj->dmabuf_id = ret;
 435
 436         dmabuf_obj->initref = true;
 437
 438         kref_init(&dmabuf_obj->kref);
 439
 440         mutex_lock(&vgpu->dmabuf_lock);
 441         if (intel_gvt_hypervisor_get_vfio_device(vgpu)) {
 442                 gvt_vgpu_err("get vfio device failed\n");
 443                 mutex_unlock(&vgpu->dmabuf_lock);
 444                 goto out_free_info;
 445         }
 446         mutex_unlock(&vgpu->dmabuf_lock);
 447
 448         update_fb_info(gfx_plane_info, &fb_info);
 449
 450         INIT_LIST_HEAD(&dmabuf_obj->list);
 451         mutex_lock(&vgpu->dmabuf_lock);
 452         list_add_tail(&dmabuf_obj->list, &vgpu->dmabuf_obj_list_head);
 453         mutex_unlock(&vgpu->dmabuf_lock);
 454
 455         gvt_dbg_dpy("vgpu%d: %s new dmabuf_obj ref %d, id %d\n", vgpu->id,
 456                     __func__, kref_read(&dmabuf_obj->kref), ret);
 457
 458         return 0;
 459
 460 out_free_info:
 461         kfree(dmabuf_obj->info);
 462 out_free_dmabuf:
 463         kfree(dmabuf_obj);
 464 out:
 465         /* ENODEV means plane isn't ready, which might be a normal case. */
 466         return (ret == -ENODEV) ? 0 : ret;
 467 }
 468
 469 /* To associate an exposed dmabuf with the dmabuf_obj */
 470 int intel_vgpu_get_dmabuf(struct intel_vgpu *vgpu, unsigned int dmabuf_id)
 471 {
 472         struct drm_device *dev = &vgpu->gvt->dev_priv->drm;
 473         struct intel_vgpu_dmabuf_obj *dmabuf_obj;
 474         struct drm_i915_gem_object *obj;
 475         struct dma_buf *dmabuf;
 476         int dmabuf_fd;
 477         int ret = 0;
 478
 479         mutex_lock(&vgpu->dmabuf_lock);
 480
 481         dmabuf_obj = pick_dmabuf_by_num(vgpu, dmabuf_id);
 482         if (dmabuf_obj == NULL) {
 483                 gvt_vgpu_err("invalid dmabuf id:%d\n", dmabuf_id);
 484                 ret = -EINVAL;
 485                 goto out;
 486         }
 487
 488         obj = vgpu_create_gem(dev, dmabuf_obj->info);
 489         if (obj == NULL) {
 490                 gvt_vgpu_err("create gvt gem obj failed\n");
 491                 ret = -ENOMEM;
 492                 goto out;
 493         }
 494
 495         obj->gvt_info = dmabuf_obj->info;
 496
 497         dmabuf = i915_gem_prime_export(dev, &obj->base, DRM_CLOEXEC | DRM_RDWR);
 498         if (IS_ERR(dmabuf)) {
 499                 gvt_vgpu_err("export dma-buf failed\n");
 500                 ret = PTR_ERR(dmabuf);
 501                 goto out_free_gem;
 502         }
 503
 504         i915_gem_object_put(obj);
 505
 506         ret = dma_buf_fd(dmabuf, DRM_CLOEXEC | DRM_RDWR);
 507         if (ret < 0) {
 508                 gvt_vgpu_err("create dma-buf fd failed ret:%d\n", ret);
 509                 goto out_free_dmabuf;
 510         }
 511         dmabuf_fd = ret;
 512
 513         dmabuf_obj_get(dmabuf_obj);
 514
 515         if (dmabuf_obj->initref) {
 516                 dmabuf_obj->initref = false;
 517                 dmabuf_obj_put(dmabuf_obj);
 518         }
 519
 520         mutex_unlock(&vgpu->dmabuf_lock);
 521
 522         gvt_dbg_dpy("vgpu%d: dmabuf:%d, dmabuf ref %d, fd:%d\n"
 523                     "        file count: %ld, GEM ref: %d\n",
 524                     vgpu->id, dmabuf_obj->dmabuf_id,
 525                     kref_read(&dmabuf_obj->kref),
 526                     dmabuf_fd,
 527                     file_count(dmabuf->file),
 528                     kref_read(&obj->base.refcount));
 529
 530         return dmabuf_fd;
 531
 532 out_free_dmabuf:
 533         dma_buf_put(dmabuf);
 534 out_free_gem:
 535         i915_gem_object_put(obj);
 536 out:
 537         mutex_unlock(&vgpu->dmabuf_lock);
 538         return ret;
 539 }
 540
 541 void intel_vgpu_dmabuf_cleanup(struct intel_vgpu *vgpu)
 542 {
 543         struct list_head *pos, *n;
 544         struct intel_vgpu_dmabuf_obj *dmabuf_obj;
 545
 546         mutex_lock(&vgpu->dmabuf_lock);
 547         list_for_each_safe(pos, n, &vgpu->dmabuf_obj_list_head) {
 548                 dmabuf_obj = container_of(pos, struct intel_vgpu_dmabuf_obj,
 549                                                 list);
 550                 dmabuf_obj->vgpu = NULL;
 551
 552                 idr_remove(&vgpu->object_idr, dmabuf_obj->dmabuf_id);
 553                 intel_gvt_hypervisor_put_vfio_device(vgpu);
 554                 list_del(pos);
 555
 556                 /* dmabuf_obj might be freed in dmabuf_obj_put */
 557                 if (dmabuf_obj->initref) {
 558                         dmabuf_obj->initref = false;
 559                         dmabuf_obj_put(dmabuf_obj);
 560                 }
 561
 562         }
 563         mutex_unlock(&vgpu->dmabuf_lock);
 564 }