drivers/gpu/drm/etnaviv/etnaviv_gem.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (C) 2015-2018 Etnaviv Project
   4  */
   5
   6 #include <drm/drm_prime.h>
   7 #include <linux/dma-mapping.h>
   8 #include <linux/shmem_fs.h>
   9 #include <linux/spinlock.h>
  10 #include <linux/vmalloc.h>
  11
  12 #include "etnaviv_drv.h"
  13 #include "etnaviv_gem.h"
  14 #include "etnaviv_gpu.h"
  15 #include "etnaviv_mmu.h"
  16
  17 static struct lock_class_key etnaviv_shm_lock_class;
  18 static struct lock_class_key etnaviv_userptr_lock_class;
  19
  20 static void etnaviv_gem_scatter_map(struct etnaviv_gem_object *etnaviv_obj)
  21 {
  22         struct drm_device *dev = etnaviv_obj->base.dev;
  23         struct sg_table *sgt = etnaviv_obj->sgt;
  24
  25         /*
  26          * For non-cached buffers, ensure the new pages are clean
  27          * because display controller, GPU, etc. are not coherent.
  28          */
  29         if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK)
  30                 dma_map_sgtable(dev->dev, sgt, DMA_BIDIRECTIONAL, 0);
  31 }
  32
  33 static void etnaviv_gem_scatterlist_unmap(struct etnaviv_gem_object *etnaviv_obj)
  34 {
  35         struct drm_device *dev = etnaviv_obj->base.dev;
  36         struct sg_table *sgt = etnaviv_obj->sgt;
  37
  38         /*
  39          * For non-cached buffers, ensure the new pages are clean
  40          * because display controller, GPU, etc. are not coherent:
  41          *
  42          * WARNING: The DMA API does not support concurrent CPU
  43          * and device access to the memory area.  With BIDIRECTIONAL,
  44          * we will clean the cache lines which overlap the region,
  45          * and invalidate all cache lines (partially) contained in
  46          * the region.
  47          *
  48          * If you have dirty data in the overlapping cache lines,
  49          * that will corrupt the GPU-written data.  If you have
  50          * written into the remainder of the region, this can
  51          * discard those writes.
  52          */
  53         if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK)
  54                 dma_unmap_sgtable(dev->dev, sgt, DMA_BIDIRECTIONAL, 0);
  55 }
  56
  57 /* called with etnaviv_obj->lock held */
  58 static int etnaviv_gem_shmem_get_pages(struct etnaviv_gem_object *etnaviv_obj)
  59 {
  60         struct drm_device *dev = etnaviv_obj->base.dev;
  61         struct page **p = drm_gem_get_pages(&etnaviv_obj->base);
  62
  63         if (IS_ERR(p)) {
  64                 dev_dbg(dev->dev, "could not get pages: %ld\n", PTR_ERR(p));
  65                 return PTR_ERR(p);
  66         }
  67
  68         etnaviv_obj->pages = p;
  69
  70         return 0;
  71 }
  72
  73 static void put_pages(struct etnaviv_gem_object *etnaviv_obj)
  74 {
  75         if (etnaviv_obj->sgt) {
  76                 etnaviv_gem_scatterlist_unmap(etnaviv_obj);
  77                 sg_free_table(etnaviv_obj->sgt);
  78                 kfree(etnaviv_obj->sgt);
  79                 etnaviv_obj->sgt = NULL;
  80         }
  81         if (etnaviv_obj->pages) {
  82                 drm_gem_put_pages(&etnaviv_obj->base, etnaviv_obj->pages,
  83                                   true, false);
  84
  85                 etnaviv_obj->pages = NULL;
  86         }
  87 }
  88
  89 struct page **etnaviv_gem_get_pages(struct etnaviv_gem_object *etnaviv_obj)
  90 {
  91         int ret;
  92
  93         lockdep_assert_held(&etnaviv_obj->lock);
  94
  95         if (!etnaviv_obj->pages) {
  96                 ret = etnaviv_obj->ops->get_pages(etnaviv_obj);
  97                 if (ret < 0)
  98                         return ERR_PTR(ret);
  99         }
 100
 101         if (!etnaviv_obj->sgt) {
 102                 struct drm_device *dev = etnaviv_obj->base.dev;
 103                 int npages = etnaviv_obj->base.size >> PAGE_SHIFT;
 104                 struct sg_table *sgt;
 105
 106                 sgt = drm_prime_pages_to_sg(etnaviv_obj->base.dev,
 107                                             etnaviv_obj->pages, npages);
 108                 if (IS_ERR(sgt)) {
 109                         dev_err(dev->dev, "failed to allocate sgt: %ld\n",
 110                                 PTR_ERR(sgt));
 111                         return ERR_CAST(sgt);
 112                 }
 113
 114                 etnaviv_obj->sgt = sgt;
 115
 116                 etnaviv_gem_scatter_map(etnaviv_obj);
 117         }
 118
 119         return etnaviv_obj->pages;
 120 }
 121
 122 void etnaviv_gem_put_pages(struct etnaviv_gem_object *etnaviv_obj)
 123 {
 124         lockdep_assert_held(&etnaviv_obj->lock);
 125         /* when we start tracking the pin count, then do something here */
 126 }
 127
 128 static int etnaviv_gem_mmap_obj(struct etnaviv_gem_object *etnaviv_obj,
 129                 struct vm_area_struct *vma)
 130 {
 131         pgprot_t vm_page_prot;
 132
 133         vm_flags_set(vma, VM_PFNMAP | VM_DONTEXPAND | VM_DONTDUMP);
 134
 135         vm_page_prot = vm_get_page_prot(vma->vm_flags);
 136
 137         if (etnaviv_obj->flags & ETNA_BO_WC) {
 138                 vma->vm_page_prot = pgprot_writecombine(vm_page_prot);
 139         } else if (etnaviv_obj->flags & ETNA_BO_UNCACHED) {
 140                 vma->vm_page_prot = pgprot_noncached(vm_page_prot);
 141         } else {
 142                 /*
 143                  * Shunt off cached objs to shmem file so they have their own
 144                  * address_space (so unmap_mapping_range does what we want,
 145                  * in particular in the case of mmap'd dmabufs)
 146                  */
 147                 vma->vm_pgoff = 0;
 148                 vma_set_file(vma, etnaviv_obj->base.filp);
 149
 150                 vma->vm_page_prot = vm_page_prot;
 151         }
 152
 153         return 0;
 154 }
 155
 156 static int etnaviv_gem_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma)
 157 {
 158         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 159
 160         return etnaviv_obj->ops->mmap(etnaviv_obj, vma);
 161 }
 162
 163 static vm_fault_t etnaviv_gem_fault(struct vm_fault *vmf)
 164 {
 165         struct vm_area_struct *vma = vmf->vma;
 166         struct drm_gem_object *obj = vma->vm_private_data;
 167         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 168         struct page **pages;
 169         unsigned long pfn;
 170         pgoff_t pgoff;
 171         int err;
 172
 173         /*
 174          * Make sure we don't parallel update on a fault, nor move or remove
 175          * something from beneath our feet.  Note that vmf_insert_page() is
 176          * specifically coded to take care of this, so we don't have to.
 177          */
 178         err = mutex_lock_interruptible(&etnaviv_obj->lock);
 179         if (err)
 180                 return VM_FAULT_NOPAGE;
 181         /* make sure we have pages attached now */
 182         pages = etnaviv_gem_get_pages(etnaviv_obj);
 183         mutex_unlock(&etnaviv_obj->lock);
 184
 185         if (IS_ERR(pages)) {
 186                 err = PTR_ERR(pages);
 187                 return vmf_error(err);
 188         }
 189
 190         /* We don't use vmf->pgoff since that has the fake offset: */
 191         pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
 192
 193         pfn = page_to_pfn(pages[pgoff]);
 194
 195         VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
 196              pfn, pfn << PAGE_SHIFT);
 197
 198         return vmf_insert_pfn(vma, vmf->address, pfn);
 199 }
 200
 201 int etnaviv_gem_mmap_offset(struct drm_gem_object *obj, u64 *offset)
 202 {
 203         int ret;
 204
 205         /* Make it mmapable */
 206         ret = drm_gem_create_mmap_offset(obj);
 207         if (ret)
 208                 dev_err(obj->dev->dev, "could not allocate mmap offset\n");
 209         else
 210                 *offset = drm_vma_node_offset_addr(&obj->vma_node);
 211
 212         return ret;
 213 }
 214
 215 static struct etnaviv_vram_mapping *
 216 etnaviv_gem_get_vram_mapping(struct etnaviv_gem_object *obj,
 217                              struct etnaviv_iommu_context *context)
 218 {
 219         struct etnaviv_vram_mapping *mapping;
 220
 221         list_for_each_entry(mapping, &obj->vram_list, obj_node) {
 222                 if (mapping->context == context)
 223                         return mapping;
 224         }
 225
 226         return NULL;
 227 }
 228
 229 void etnaviv_gem_mapping_unreference(struct etnaviv_vram_mapping *mapping)
 230 {
 231         struct etnaviv_gem_object *etnaviv_obj = mapping->object;
 232
 233         mutex_lock(&etnaviv_obj->lock);
 234         WARN_ON(mapping->use == 0);
 235         mapping->use -= 1;
 236         mutex_unlock(&etnaviv_obj->lock);
 237
 238         drm_gem_object_put(&etnaviv_obj->base);
 239 }
 240
 241 struct etnaviv_vram_mapping *etnaviv_gem_mapping_get(
 242         struct drm_gem_object *obj, struct etnaviv_iommu_context *mmu_context,
 243         u64 va)
 244 {
 245         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 246         struct etnaviv_vram_mapping *mapping;
 247         struct page **pages;
 248         int ret = 0;
 249
 250         mutex_lock(&etnaviv_obj->lock);
 251         mapping = etnaviv_gem_get_vram_mapping(etnaviv_obj, mmu_context);
 252         if (mapping) {
 253                 /*
 254                  * Holding the object lock prevents the use count changing
 255                  * beneath us.  If the use count is zero, the MMU might be
 256                  * reaping this object, so take the lock and re-check that
 257                  * the MMU owns this mapping to close this race.
 258                  */
 259                 if (mapping->use == 0) {
 260                         mutex_lock(&mmu_context->lock);
 261                         if (mapping->context == mmu_context)
 262                                 if (va && mapping->iova != va) {
 263                                         etnaviv_iommu_reap_mapping(mapping);
 264                                         mapping = NULL;
 265                                 } else {
 266                                         mapping->use += 1;
 267                                 }
 268                         else
 269                                 mapping = NULL;
 270                         mutex_unlock(&mmu_context->lock);
 271                         if (mapping)
 272                                 goto out;
 273                 } else {
 274                         mapping->use += 1;
 275                         goto out;
 276                 }
 277         }
 278
 279         pages = etnaviv_gem_get_pages(etnaviv_obj);
 280         if (IS_ERR(pages)) {
 281                 ret = PTR_ERR(pages);
 282                 goto out;
 283         }
 284
 285         /*
 286          * See if we have a reaped vram mapping we can re-use before
 287          * allocating a fresh mapping.
 288          */
 289         mapping = etnaviv_gem_get_vram_mapping(etnaviv_obj, NULL);
 290         if (!mapping) {
 291                 mapping = kzalloc(sizeof(*mapping), GFP_KERNEL);
 292                 if (!mapping) {
 293                         ret = -ENOMEM;
 294                         goto out;
 295                 }
 296
 297                 INIT_LIST_HEAD(&mapping->scan_node);
 298                 mapping->object = etnaviv_obj;
 299         } else {
 300                 list_del(&mapping->obj_node);
 301         }
 302
 303         mapping->use = 1;
 304
 305         ret = etnaviv_iommu_map_gem(mmu_context, etnaviv_obj,
 306                                     mmu_context->global->memory_base,
 307                                     mapping, va);
 308         if (ret < 0)
 309                 kfree(mapping);
 310         else
 311                 list_add_tail(&mapping->obj_node, &etnaviv_obj->vram_list);
 312
 313 out:
 314         mutex_unlock(&etnaviv_obj->lock);
 315
 316         if (ret)
 317                 return ERR_PTR(ret);
 318
 319         /* Take a reference on the object */
 320         drm_gem_object_get(obj);
 321         return mapping;
 322 }
 323
 324 void *etnaviv_gem_vmap(struct drm_gem_object *obj)
 325 {
 326         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 327
 328         if (etnaviv_obj->vaddr)
 329                 return etnaviv_obj->vaddr;
 330
 331         mutex_lock(&etnaviv_obj->lock);
 332         /*
 333          * Need to check again, as we might have raced with another thread
 334          * while waiting for the mutex.
 335          */
 336         if (!etnaviv_obj->vaddr)
 337                 etnaviv_obj->vaddr = etnaviv_obj->ops->vmap(etnaviv_obj);
 338         mutex_unlock(&etnaviv_obj->lock);
 339
 340         return etnaviv_obj->vaddr;
 341 }
 342
 343 static void *etnaviv_gem_vmap_impl(struct etnaviv_gem_object *obj)
 344 {
 345         struct page **pages;
 346
 347         lockdep_assert_held(&obj->lock);
 348
 349         pages = etnaviv_gem_get_pages(obj);
 350         if (IS_ERR(pages))
 351                 return NULL;
 352
 353         return vmap(pages, obj->base.size >> PAGE_SHIFT,
 354                         VM_MAP, pgprot_writecombine(PAGE_KERNEL));
 355 }
 356
 357 static inline enum dma_data_direction etnaviv_op_to_dma_dir(u32 op)
 358 {
 359         if (op & ETNA_PREP_READ)
 360                 return DMA_FROM_DEVICE;
 361         else if (op & ETNA_PREP_WRITE)
 362                 return DMA_TO_DEVICE;
 363         else
 364                 return DMA_BIDIRECTIONAL;
 365 }
 366
 367 int etnaviv_gem_cpu_prep(struct drm_gem_object *obj, u32 op,
 368                 struct drm_etnaviv_timespec *timeout)
 369 {
 370         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 371         struct drm_device *dev = obj->dev;
 372         bool write = !!(op & ETNA_PREP_WRITE);
 373         int ret;
 374
 375         if (!etnaviv_obj->sgt) {
 376                 void *ret;
 377
 378                 mutex_lock(&etnaviv_obj->lock);
 379                 ret = etnaviv_gem_get_pages(etnaviv_obj);
 380                 mutex_unlock(&etnaviv_obj->lock);
 381                 if (IS_ERR(ret))
 382                         return PTR_ERR(ret);
 383         }
 384
 385         if (op & ETNA_PREP_NOSYNC) {
 386                 if (!dma_resv_test_signaled(obj->resv,
 387                                             dma_resv_usage_rw(write)))
 388                         return -EBUSY;
 389         } else {
 390                 unsigned long remain = etnaviv_timeout_to_jiffies(timeout);
 391
 392                 ret = dma_resv_wait_timeout(obj->resv, dma_resv_usage_rw(write),
 393                                             true, remain);
 394                 if (ret <= 0)
 395                         return ret == 0 ? -ETIMEDOUT : ret;
 396         }
 397
 398         if (etnaviv_obj->flags & ETNA_BO_CACHED) {
 399                 dma_sync_sgtable_for_cpu(dev->dev, etnaviv_obj->sgt,
 400                                          etnaviv_op_to_dma_dir(op));
 401                 etnaviv_obj->last_cpu_prep_op = op;
 402         }
 403
 404         return 0;
 405 }
 406
 407 int etnaviv_gem_cpu_fini(struct drm_gem_object *obj)
 408 {
 409         struct drm_device *dev = obj->dev;
 410         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 411
 412         if (etnaviv_obj->flags & ETNA_BO_CACHED) {
 413                 /* fini without a prep is almost certainly a userspace error */
 414                 WARN_ON(etnaviv_obj->last_cpu_prep_op == 0);
 415                 dma_sync_sgtable_for_device(dev->dev, etnaviv_obj->sgt,
 416                         etnaviv_op_to_dma_dir(etnaviv_obj->last_cpu_prep_op));
 417                 etnaviv_obj->last_cpu_prep_op = 0;
 418         }
 419
 420         return 0;
 421 }
 422
 423 int etnaviv_gem_wait_bo(struct etnaviv_gpu *gpu, struct drm_gem_object *obj,
 424         struct drm_etnaviv_timespec *timeout)
 425 {
 426         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 427
 428         return etnaviv_gpu_wait_obj_inactive(gpu, etnaviv_obj, timeout);
 429 }
 430
 431 #ifdef CONFIG_DEBUG_FS
 432 static void etnaviv_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
 433 {
 434         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 435         struct dma_resv *robj = obj->resv;
 436         unsigned long off = drm_vma_node_start(&obj->vma_node);
 437         int r;
 438
 439         seq_printf(m, "%08x: %c %2d (%2d) %08lx %p %zd\n",
 440                         etnaviv_obj->flags, is_active(etnaviv_obj) ? 'A' : 'I',
 441                         obj->name, kref_read(&obj->refcount),
 442                         off, etnaviv_obj->vaddr, obj->size);
 443
 444         r = dma_resv_lock(robj, NULL);
 445         if (r)
 446                 return;
 447
 448         dma_resv_describe(robj, m);
 449         dma_resv_unlock(robj);
 450 }
 451
 452 void etnaviv_gem_describe_objects(struct etnaviv_drm_private *priv,
 453         struct seq_file *m)
 454 {
 455         struct etnaviv_gem_object *etnaviv_obj;
 456         int count = 0;
 457         size_t size = 0;
 458
 459         mutex_lock(&priv->gem_lock);
 460         list_for_each_entry(etnaviv_obj, &priv->gem_list, gem_node) {
 461                 struct drm_gem_object *obj = &etnaviv_obj->base;
 462
 463                 seq_puts(m, "   ");
 464                 etnaviv_gem_describe(obj, m);
 465                 count++;
 466                 size += obj->size;
 467         }
 468         mutex_unlock(&priv->gem_lock);
 469
 470         seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
 471 }
 472 #endif
 473
 474 static void etnaviv_gem_shmem_release(struct etnaviv_gem_object *etnaviv_obj)
 475 {
 476         vunmap(etnaviv_obj->vaddr);
 477         put_pages(etnaviv_obj);
 478 }
 479
 480 static const struct etnaviv_gem_ops etnaviv_gem_shmem_ops = {
 481         .get_pages = etnaviv_gem_shmem_get_pages,
 482         .release = etnaviv_gem_shmem_release,
 483         .vmap = etnaviv_gem_vmap_impl,
 484         .mmap = etnaviv_gem_mmap_obj,
 485 };
 486
 487 void etnaviv_gem_free_object(struct drm_gem_object *obj)
 488 {
 489         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 490         struct etnaviv_drm_private *priv = obj->dev->dev_private;
 491         struct etnaviv_vram_mapping *mapping, *tmp;
 492
 493         /* object should not be active */
 494         WARN_ON(is_active(etnaviv_obj));
 495
 496         mutex_lock(&priv->gem_lock);
 497         list_del(&etnaviv_obj->gem_node);
 498         mutex_unlock(&priv->gem_lock);
 499
 500         list_for_each_entry_safe(mapping, tmp, &etnaviv_obj->vram_list,
 501                                  obj_node) {
 502                 struct etnaviv_iommu_context *context = mapping->context;
 503
 504                 WARN_ON(mapping->use);
 505
 506                 if (context)
 507                         etnaviv_iommu_unmap_gem(context, mapping);
 508
 509                 list_del(&mapping->obj_node);
 510                 kfree(mapping);
 511         }
 512
 513         etnaviv_obj->ops->release(etnaviv_obj);
 514         drm_gem_object_release(obj);
 515
 516         kfree(etnaviv_obj);
 517 }
 518
 519 void etnaviv_gem_obj_add(struct drm_device *dev, struct drm_gem_object *obj)
 520 {
 521         struct etnaviv_drm_private *priv = dev->dev_private;
 522         struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
 523
 524         mutex_lock(&priv->gem_lock);
 525         list_add_tail(&etnaviv_obj->gem_node, &priv->gem_list);
 526         mutex_unlock(&priv->gem_lock);
 527 }
 528
 529 static const struct vm_operations_struct vm_ops = {
 530         .fault = etnaviv_gem_fault,
 531         .open = drm_gem_vm_open,
 532         .close = drm_gem_vm_close,
 533 };
 534
 535 static const struct drm_gem_object_funcs etnaviv_gem_object_funcs = {
 536         .free = etnaviv_gem_free_object,
 537         .pin = etnaviv_gem_prime_pin,
 538         .unpin = etnaviv_gem_prime_unpin,
 539         .get_sg_table = etnaviv_gem_prime_get_sg_table,
 540         .vmap = etnaviv_gem_prime_vmap,
 541         .mmap = etnaviv_gem_mmap,
 542         .vm_ops = &vm_ops,
 543 };
 544
 545 static int etnaviv_gem_new_impl(struct drm_device *dev, u32 size, u32 flags,
 546         const struct etnaviv_gem_ops *ops, struct drm_gem_object **obj)
 547 {
 548         struct etnaviv_gem_object *etnaviv_obj;
 549         unsigned sz = sizeof(*etnaviv_obj);
 550         bool valid = true;
 551
 552         /* validate flags */
 553         switch (flags & ETNA_BO_CACHE_MASK) {
 554         case ETNA_BO_UNCACHED:
 555         case ETNA_BO_CACHED:
 556         case ETNA_BO_WC:
 557                 break;
 558         default:
 559                 valid = false;
 560         }
 561
 562         if (!valid) {
 563                 dev_err(dev->dev, "invalid cache flag: %x\n",
 564                         (flags & ETNA_BO_CACHE_MASK));
 565                 return -EINVAL;
 566         }
 567
 568         etnaviv_obj = kzalloc(sz, GFP_KERNEL);
 569         if (!etnaviv_obj)
 570                 return -ENOMEM;
 571
 572         etnaviv_obj->flags = flags;
 573         etnaviv_obj->ops = ops;
 574
 575         mutex_init(&etnaviv_obj->lock);
 576         INIT_LIST_HEAD(&etnaviv_obj->vram_list);
 577
 578         *obj = &etnaviv_obj->base;
 579         (*obj)->funcs = &etnaviv_gem_object_funcs;
 580
 581         return 0;
 582 }
 583
 584 /* convenience method to construct a GEM buffer object, and userspace handle */
 585 int etnaviv_gem_new_handle(struct drm_device *dev, struct drm_file *file,
 586         u32 size, u32 flags, u32 *handle)
 587 {
 588         struct etnaviv_drm_private *priv = dev->dev_private;
 589         struct drm_gem_object *obj = NULL;
 590         int ret;
 591
 592         size = PAGE_ALIGN(size);
 593
 594         ret = etnaviv_gem_new_impl(dev, size, flags,
 595                                    &etnaviv_gem_shmem_ops, &obj);
 596         if (ret)
 597                 goto fail;
 598
 599         lockdep_set_class(&to_etnaviv_bo(obj)->lock, &etnaviv_shm_lock_class);
 600
 601         ret = drm_gem_object_init(dev, obj, size);
 602         if (ret)
 603                 goto fail;
 604
 605         /*
 606          * Our buffers are kept pinned, so allocating them from the MOVABLE
 607          * zone is a really bad idea, and conflicts with CMA. See comments
 608          * above new_inode() why this is required _and_ expected if you're
 609          * going to pin these pages.
 610          */
 611         mapping_set_gfp_mask(obj->filp->f_mapping, priv->shm_gfp_mask);
 612
 613         etnaviv_gem_obj_add(dev, obj);
 614
 615         ret = drm_gem_handle_create(file, obj, handle);
 616
 617         /* drop reference from allocate - handle holds it now */
 618 fail:
 619         drm_gem_object_put(obj);
 620
 621         return ret;
 622 }
 623
 624 int etnaviv_gem_new_private(struct drm_device *dev, size_t size, u32 flags,
 625         const struct etnaviv_gem_ops *ops, struct etnaviv_gem_object **res)
 626 {
 627         struct drm_gem_object *obj;
 628         int ret;
 629
 630         ret = etnaviv_gem_new_impl(dev, size, flags, ops, &obj);
 631         if (ret)
 632                 return ret;
 633
 634         drm_gem_private_object_init(dev, obj, size);
 635
 636         *res = to_etnaviv_bo(obj);
 637
 638         return 0;
 639 }
 640
 641 static int etnaviv_gem_userptr_get_pages(struct etnaviv_gem_object *etnaviv_obj)
 642 {
 643         struct page **pvec = NULL;
 644         struct etnaviv_gem_userptr *userptr = &etnaviv_obj->userptr;
 645         int ret, pinned = 0, npages = etnaviv_obj->base.size >> PAGE_SHIFT;
 646         unsigned int gup_flags = FOLL_LONGTERM;
 647
 648         might_lock_read(&current->mm->mmap_lock);
 649
 650         if (userptr->mm != current->mm)
 651                 return -EPERM;
 652
 653         pvec = kvmalloc_array(npages, sizeof(struct page *), GFP_KERNEL);
 654         if (!pvec)
 655                 return -ENOMEM;
 656
 657         if (!userptr->ro)
 658                 gup_flags |= FOLL_WRITE;
 659
 660         do {
 661                 unsigned num_pages = npages - pinned;
 662                 uint64_t ptr = userptr->ptr + pinned * PAGE_SIZE;
 663                 struct page **pages = pvec + pinned;
 664
 665                 ret = pin_user_pages_fast(ptr, num_pages, gup_flags, pages);
 666                 if (ret < 0) {
 667                         unpin_user_pages(pvec, pinned);
 668                         kvfree(pvec);
 669                         return ret;
 670                 }
 671
 672                 pinned += ret;
 673
 674         } while (pinned < npages);
 675
 676         etnaviv_obj->pages = pvec;
 677
 678         return 0;
 679 }
 680
 681 static void etnaviv_gem_userptr_release(struct etnaviv_gem_object *etnaviv_obj)
 682 {
 683         if (etnaviv_obj->sgt) {
 684                 etnaviv_gem_scatterlist_unmap(etnaviv_obj);
 685                 sg_free_table(etnaviv_obj->sgt);
 686                 kfree(etnaviv_obj->sgt);
 687         }
 688         if (etnaviv_obj->pages) {
 689                 int npages = etnaviv_obj->base.size >> PAGE_SHIFT;
 690
 691                 unpin_user_pages(etnaviv_obj->pages, npages);
 692                 kvfree(etnaviv_obj->pages);
 693         }
 694 }
 695
 696 static int etnaviv_gem_userptr_mmap_obj(struct etnaviv_gem_object *etnaviv_obj,
 697                 struct vm_area_struct *vma)
 698 {
 699         return -EINVAL;
 700 }
 701
 702 static const struct etnaviv_gem_ops etnaviv_gem_userptr_ops = {
 703         .get_pages = etnaviv_gem_userptr_get_pages,
 704         .release = etnaviv_gem_userptr_release,
 705         .vmap = etnaviv_gem_vmap_impl,
 706         .mmap = etnaviv_gem_userptr_mmap_obj,
 707 };
 708
 709 int etnaviv_gem_new_userptr(struct drm_device *dev, struct drm_file *file,
 710         uintptr_t ptr, u32 size, u32 flags, u32 *handle)
 711 {
 712         struct etnaviv_gem_object *etnaviv_obj;
 713         int ret;
 714
 715         ret = etnaviv_gem_new_private(dev, size, ETNA_BO_CACHED,
 716                                       &etnaviv_gem_userptr_ops, &etnaviv_obj);
 717         if (ret)
 718                 return ret;
 719
 720         lockdep_set_class(&etnaviv_obj->lock, &etnaviv_userptr_lock_class);
 721
 722         etnaviv_obj->userptr.ptr = ptr;
 723         etnaviv_obj->userptr.mm = current->mm;
 724         etnaviv_obj->userptr.ro = !(flags & ETNA_USERPTR_WRITE);
 725
 726         etnaviv_gem_obj_add(dev, &etnaviv_obj->base);
 727
 728         ret = drm_gem_handle_create(file, &etnaviv_obj->base, handle);
 729
 730         /* drop reference from allocate - handle holds it now */
 731         drm_gem_object_put(&etnaviv_obj->base);
 732         return ret;
 733 }