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 <drm/drm_print.h>
  8#include <linux/dma-mapping.h>
  9#include <linux/shmem_fs.h>
 10#include <linux/spinlock.h>
 11#include <linux/vmalloc.h>
 12
 13#include "etnaviv_drv.h"
 14#include "etnaviv_gem.h"
 15#include "etnaviv_gpu.h"
 16#include "etnaviv_mmu.h"
 17
 18static struct lock_class_key etnaviv_shm_lock_class;
 19static struct lock_class_key etnaviv_userptr_lock_class;
 20
 21static void etnaviv_gem_scatter_map(struct etnaviv_gem_object *etnaviv_obj)
 22{
 23	struct drm_device *dev = etnaviv_obj->base.dev;
 24	struct sg_table *sgt = etnaviv_obj->sgt;
 25
 26	/*
 27	 * For non-cached buffers, ensure the new pages are clean
 28	 * because display controller, GPU, etc. are not coherent.
 29	 */
 30	if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK)
 31		dma_map_sgtable(dev->dev, sgt, DMA_BIDIRECTIONAL, 0);
 32}
 33
 34static void etnaviv_gem_scatterlist_unmap(struct etnaviv_gem_object *etnaviv_obj)
 35{
 36	struct drm_device *dev = etnaviv_obj->base.dev;
 37	struct sg_table *sgt = etnaviv_obj->sgt;
 38
 39	/*
 40	 * For non-cached buffers, ensure the new pages are clean
 41	 * because display controller, GPU, etc. are not coherent:
 42	 *
 43	 * WARNING: The DMA API does not support concurrent CPU
 44	 * and device access to the memory area.  With BIDIRECTIONAL,
 45	 * we will clean the cache lines which overlap the region,
 46	 * and invalidate all cache lines (partially) contained in
 47	 * the region.
 48	 *
 49	 * If you have dirty data in the overlapping cache lines,
 50	 * that will corrupt the GPU-written data.  If you have
 51	 * written into the remainder of the region, this can
 52	 * discard those writes.
 53	 */
 54	if (etnaviv_obj->flags & ETNA_BO_CACHE_MASK)
 55		dma_unmap_sgtable(dev->dev, sgt, DMA_BIDIRECTIONAL, 0);
 56}
 57
 58/* called with etnaviv_obj->lock held */
 59static int etnaviv_gem_shmem_get_pages(struct etnaviv_gem_object *etnaviv_obj)
 60{
 61	struct drm_device *dev = etnaviv_obj->base.dev;
 62	struct page **p = drm_gem_get_pages(&etnaviv_obj->base);
 63
 64	if (IS_ERR(p)) {
 65		dev_dbg(dev->dev, "could not get pages: %ld\n", PTR_ERR(p));
 66		return PTR_ERR(p);
 67	}
 68
 69	etnaviv_obj->pages = p;
 70
 71	return 0;
 72}
 73
 74static void put_pages(struct etnaviv_gem_object *etnaviv_obj)
 75{
 76	if (etnaviv_obj->sgt) {
 77		etnaviv_gem_scatterlist_unmap(etnaviv_obj);
 78		sg_free_table(etnaviv_obj->sgt);
 79		kfree(etnaviv_obj->sgt);
 80		etnaviv_obj->sgt = NULL;
 81	}
 82	if (etnaviv_obj->pages) {
 83		drm_gem_put_pages(&etnaviv_obj->base, etnaviv_obj->pages,
 84				  true, false);
 85
 86		etnaviv_obj->pages = NULL;
 87	}
 88}
 89
 90struct page **etnaviv_gem_get_pages(struct etnaviv_gem_object *etnaviv_obj)
 91{
 92	int ret;
 93
 94	lockdep_assert_held(&etnaviv_obj->lock);
 95
 96	if (!etnaviv_obj->pages) {
 97		ret = etnaviv_obj->ops->get_pages(etnaviv_obj);
 98		if (ret < 0)
 99			return ERR_PTR(ret);
100	}
101
102	if (!etnaviv_obj->sgt) {
103		struct drm_device *dev = etnaviv_obj->base.dev;
104		unsigned int npages = etnaviv_obj->base.size >> PAGE_SHIFT;
105		struct sg_table *sgt;
106
107		sgt = drm_prime_pages_to_sg(dev, 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
122void 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
128static 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
156static 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
163static 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
201int 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
215static struct etnaviv_vram_mapping *
216etnaviv_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
229void 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
241struct 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
313out:
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
324void *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
343static void *etnaviv_gem_vmap_impl(struct etnaviv_gem_object *obj)
344{
345	struct page **pages;
346	pgprot_t prot;
347
348	lockdep_assert_held(&obj->lock);
349
350	pages = etnaviv_gem_get_pages(obj);
351	if (IS_ERR(pages))
352		return NULL;
353
354	switch (obj->flags & ETNA_BO_CACHE_MASK) {
355	case ETNA_BO_CACHED:
356		prot = PAGE_KERNEL;
357		break;
358	case ETNA_BO_UNCACHED:
359		prot = pgprot_noncached(PAGE_KERNEL);
360		break;
361	case ETNA_BO_WC:
362	default:
363		prot = pgprot_writecombine(PAGE_KERNEL);
364	}
365
366	return vmap(pages, obj->base.size >> PAGE_SHIFT, VM_MAP, prot);
367}
368
369static inline enum dma_data_direction etnaviv_op_to_dma_dir(u32 op)
370{
371	op &= ETNA_PREP_READ | ETNA_PREP_WRITE;
372
373	if (op == ETNA_PREP_READ)
374		return DMA_FROM_DEVICE;
375	else if (op == ETNA_PREP_WRITE)
376		return DMA_TO_DEVICE;
377	else
378		return DMA_BIDIRECTIONAL;
379}
380
381int etnaviv_gem_cpu_prep(struct drm_gem_object *obj, u32 op,
382		struct drm_etnaviv_timespec *timeout)
383{
384	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
385	struct drm_device *dev = obj->dev;
386	bool write = !!(op & ETNA_PREP_WRITE);
387	int ret;
388
389	if (!etnaviv_obj->sgt) {
390		void *ret;
391
392		mutex_lock(&etnaviv_obj->lock);
393		ret = etnaviv_gem_get_pages(etnaviv_obj);
394		mutex_unlock(&etnaviv_obj->lock);
395		if (IS_ERR(ret))
396			return PTR_ERR(ret);
397	}
398
399	if (op & ETNA_PREP_NOSYNC) {
400		if (!dma_resv_test_signaled(obj->resv,
401					    dma_resv_usage_rw(write)))
402			return -EBUSY;
403	} else {
404		unsigned long remain = etnaviv_timeout_to_jiffies(timeout);
405
406		ret = dma_resv_wait_timeout(obj->resv, dma_resv_usage_rw(write),
407					    true, remain);
408		if (ret <= 0)
409			return ret == 0 ? -ETIMEDOUT : ret;
410	}
411
412	if (etnaviv_obj->flags & ETNA_BO_CACHED) {
413		dma_sync_sgtable_for_cpu(dev->dev, etnaviv_obj->sgt,
414					 etnaviv_op_to_dma_dir(op));
415		etnaviv_obj->last_cpu_prep_op = op;
416	}
417
418	return 0;
419}
420
421int etnaviv_gem_cpu_fini(struct drm_gem_object *obj)
422{
423	struct drm_device *dev = obj->dev;
424	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
425
426	if (etnaviv_obj->flags & ETNA_BO_CACHED) {
427		/* fini without a prep is almost certainly a userspace error */
428		WARN_ON(etnaviv_obj->last_cpu_prep_op == 0);
429		dma_sync_sgtable_for_device(dev->dev, etnaviv_obj->sgt,
430			etnaviv_op_to_dma_dir(etnaviv_obj->last_cpu_prep_op));
431		etnaviv_obj->last_cpu_prep_op = 0;
432	}
433
434	return 0;
435}
436
437int etnaviv_gem_wait_bo(struct etnaviv_gpu *gpu, struct drm_gem_object *obj,
438	struct drm_etnaviv_timespec *timeout)
439{
440	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
441
442	return etnaviv_gpu_wait_obj_inactive(gpu, etnaviv_obj, timeout);
443}
444
445#ifdef CONFIG_DEBUG_FS
446static void etnaviv_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
447{
448	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
449	struct dma_resv *robj = obj->resv;
450	unsigned long off = drm_vma_node_start(&obj->vma_node);
451	int r;
452
453	seq_printf(m, "%08x: %c %2d (%2d) %08lx %p %zd\n",
454			etnaviv_obj->flags, is_active(etnaviv_obj) ? 'A' : 'I',
455			obj->name, kref_read(&obj->refcount),
456			off, etnaviv_obj->vaddr, obj->size);
457
458	r = dma_resv_lock(robj, NULL);
459	if (r)
460		return;
461
462	dma_resv_describe(robj, m);
463	dma_resv_unlock(robj);
464}
465
466void etnaviv_gem_describe_objects(struct etnaviv_drm_private *priv,
467	struct seq_file *m)
468{
469	struct etnaviv_gem_object *etnaviv_obj;
470	int count = 0;
471	size_t size = 0;
472
473	mutex_lock(&priv->gem_lock);
474	list_for_each_entry(etnaviv_obj, &priv->gem_list, gem_node) {
475		struct drm_gem_object *obj = &etnaviv_obj->base;
476
477		seq_puts(m, "   ");
478		etnaviv_gem_describe(obj, m);
479		count++;
480		size += obj->size;
481	}
482	mutex_unlock(&priv->gem_lock);
483
484	seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
485}
486#endif
487
488static void etnaviv_gem_shmem_release(struct etnaviv_gem_object *etnaviv_obj)
489{
490	vunmap(etnaviv_obj->vaddr);
491	put_pages(etnaviv_obj);
492}
493
494static const struct etnaviv_gem_ops etnaviv_gem_shmem_ops = {
495	.get_pages = etnaviv_gem_shmem_get_pages,
496	.release = etnaviv_gem_shmem_release,
497	.vmap = etnaviv_gem_vmap_impl,
498	.mmap = etnaviv_gem_mmap_obj,
499};
500
501void etnaviv_gem_free_object(struct drm_gem_object *obj)
502{
503	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
504	struct etnaviv_drm_private *priv = obj->dev->dev_private;
505	struct etnaviv_vram_mapping *mapping, *tmp;
506
507	/* object should not be active */
508	WARN_ON(is_active(etnaviv_obj));
509
510	mutex_lock(&priv->gem_lock);
511	list_del(&etnaviv_obj->gem_node);
512	mutex_unlock(&priv->gem_lock);
513
514	list_for_each_entry_safe(mapping, tmp, &etnaviv_obj->vram_list,
515				 obj_node) {
516		struct etnaviv_iommu_context *context = mapping->context;
517
518		WARN_ON(mapping->use);
519
520		if (context)
521			etnaviv_iommu_unmap_gem(context, mapping);
522
523		list_del(&mapping->obj_node);
524		kfree(mapping);
525	}
526
527	etnaviv_obj->ops->release(etnaviv_obj);
528	drm_gem_object_release(obj);
529
530	mutex_destroy(&etnaviv_obj->lock);
531	kfree(etnaviv_obj);
532}
533
534void etnaviv_gem_obj_add(struct drm_device *dev, struct drm_gem_object *obj)
535{
536	struct etnaviv_drm_private *priv = dev->dev_private;
537	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
538
539	mutex_lock(&priv->gem_lock);
540	list_add_tail(&etnaviv_obj->gem_node, &priv->gem_list);
541	mutex_unlock(&priv->gem_lock);
542}
543
544static enum drm_gem_object_status etnaviv_gem_status(struct drm_gem_object *obj)
545{
546	struct etnaviv_gem_object *etnaviv_obj = to_etnaviv_bo(obj);
547	enum drm_gem_object_status status = 0;
548
549	if (etnaviv_obj->pages)
550		status |= DRM_GEM_OBJECT_RESIDENT;
551
552	return status;
553}
554
555static const struct vm_operations_struct vm_ops = {
556	.fault = etnaviv_gem_fault,
557	.open = drm_gem_vm_open,
558	.close = drm_gem_vm_close,
559};
560
561static const struct drm_gem_object_funcs etnaviv_gem_object_funcs = {
562	.free = etnaviv_gem_free_object,
563	.pin = etnaviv_gem_prime_pin,
564	.unpin = etnaviv_gem_prime_unpin,
565	.get_sg_table = etnaviv_gem_prime_get_sg_table,
566	.vmap = etnaviv_gem_prime_vmap,
567	.mmap = etnaviv_gem_mmap,
568	.status = etnaviv_gem_status,
569	.vm_ops = &vm_ops,
570};
571
572static int etnaviv_gem_new_impl(struct drm_device *dev, u32 size, u32 flags,
573	const struct etnaviv_gem_ops *ops, struct drm_gem_object **obj)
574{
575	struct etnaviv_gem_object *etnaviv_obj;
576	unsigned sz = sizeof(*etnaviv_obj);
577	bool valid = true;
578
579	/* validate flags */
580	switch (flags & ETNA_BO_CACHE_MASK) {
581	case ETNA_BO_UNCACHED:
582	case ETNA_BO_CACHED:
583	case ETNA_BO_WC:
584		break;
585	default:
586		valid = false;
587	}
588
589	if (!valid) {
590		dev_err(dev->dev, "invalid cache flag: %x\n",
591			(flags & ETNA_BO_CACHE_MASK));
592		return -EINVAL;
593	}
594
595	etnaviv_obj = kzalloc(sz, GFP_KERNEL);
596	if (!etnaviv_obj)
597		return -ENOMEM;
598
599	etnaviv_obj->size = ALIGN(size, SZ_4K);
600	etnaviv_obj->flags = flags;
601	etnaviv_obj->ops = ops;
602
603	mutex_init(&etnaviv_obj->lock);
604	INIT_LIST_HEAD(&etnaviv_obj->vram_list);
605
606	*obj = &etnaviv_obj->base;
607	(*obj)->funcs = &etnaviv_gem_object_funcs;
608
609	return 0;
610}
611
612/* convenience method to construct a GEM buffer object, and userspace handle */
613int etnaviv_gem_new_handle(struct drm_device *dev, struct drm_file *file,
614	u32 size, u32 flags, u32 *handle)
615{
616	struct etnaviv_drm_private *priv = dev->dev_private;
617	struct drm_gem_object *obj = NULL;
618	int ret;
619
620	ret = etnaviv_gem_new_impl(dev, size, flags, &etnaviv_gem_shmem_ops, &obj);
621	if (ret)
622		goto fail;
623
624	lockdep_set_class(&to_etnaviv_bo(obj)->lock, &etnaviv_shm_lock_class);
625
626	ret = drm_gem_object_init(dev, obj, PAGE_ALIGN(size));
627	if (ret)
628		goto fail;
629
630	/*
631	 * Our buffers are kept pinned, so allocating them from the MOVABLE
632	 * zone is a really bad idea, and conflicts with CMA. See comments
633	 * above new_inode() why this is required _and_ expected if you're
634	 * going to pin these pages.
635	 */
636	mapping_set_gfp_mask(obj->filp->f_mapping, priv->shm_gfp_mask);
637
638	etnaviv_gem_obj_add(dev, obj);
639
640	ret = drm_gem_handle_create(file, obj, handle);
641
642	/* drop reference from allocate - handle holds it now */
643fail:
644	drm_gem_object_put(obj);
645
646	return ret;
647}
648
649int etnaviv_gem_new_private(struct drm_device *dev, size_t size, u32 flags,
650	const struct etnaviv_gem_ops *ops, struct etnaviv_gem_object **res)
651{
652	struct drm_gem_object *obj;
653	int ret;
654
655	ret = etnaviv_gem_new_impl(dev, size, flags, ops, &obj);
656	if (ret)
657		return ret;
658
659	drm_gem_private_object_init(dev, obj, size);
660
661	*res = to_etnaviv_bo(obj);
662
663	return 0;
664}
665
666static int etnaviv_gem_userptr_get_pages(struct etnaviv_gem_object *etnaviv_obj)
667{
668	struct page **pvec = NULL;
669	struct etnaviv_gem_userptr *userptr = &etnaviv_obj->userptr;
670	int ret, pinned = 0, npages = etnaviv_obj->base.size >> PAGE_SHIFT;
671	unsigned int gup_flags = FOLL_LONGTERM;
672
673	might_lock_read(&current->mm->mmap_lock);
674
675	if (userptr->mm != current->mm)
676		return -EPERM;
677
678	pvec = kvmalloc_array(npages, sizeof(struct page *), GFP_KERNEL);
679	if (!pvec)
680		return -ENOMEM;
681
682	if (!userptr->ro)
683		gup_flags |= FOLL_WRITE;
684
685	do {
686		unsigned num_pages = npages - pinned;
687		uint64_t ptr = userptr->ptr + pinned * PAGE_SIZE;
688		struct page **pages = pvec + pinned;
689
690		ret = pin_user_pages_fast(ptr, num_pages, gup_flags, pages);
691		if (ret < 0) {
692			unpin_user_pages(pvec, pinned);
693			kvfree(pvec);
694			return ret;
695		}
696
697		pinned += ret;
698
699	} while (pinned < npages);
700
701	etnaviv_obj->pages = pvec;
702
703	return 0;
704}
705
706static void etnaviv_gem_userptr_release(struct etnaviv_gem_object *etnaviv_obj)
707{
708	if (etnaviv_obj->sgt) {
709		etnaviv_gem_scatterlist_unmap(etnaviv_obj);
710		sg_free_table(etnaviv_obj->sgt);
711		kfree(etnaviv_obj->sgt);
712	}
713	if (etnaviv_obj->pages) {
714		unsigned int npages = etnaviv_obj->base.size >> PAGE_SHIFT;
715
716		unpin_user_pages(etnaviv_obj->pages, npages);
717		kvfree(etnaviv_obj->pages);
718	}
719}
720
721static int etnaviv_gem_userptr_mmap_obj(struct etnaviv_gem_object *etnaviv_obj,
722		struct vm_area_struct *vma)
723{
724	return -EINVAL;
725}
726
727static const struct etnaviv_gem_ops etnaviv_gem_userptr_ops = {
728	.get_pages = etnaviv_gem_userptr_get_pages,
729	.release = etnaviv_gem_userptr_release,
730	.vmap = etnaviv_gem_vmap_impl,
731	.mmap = etnaviv_gem_userptr_mmap_obj,
732};
733
734int etnaviv_gem_new_userptr(struct drm_device *dev, struct drm_file *file,
735	uintptr_t ptr, u32 size, u32 flags, u32 *handle)
736{
737	struct etnaviv_gem_object *etnaviv_obj;
738	int ret;
739
740	ret = etnaviv_gem_new_private(dev, size, ETNA_BO_CACHED,
741				      &etnaviv_gem_userptr_ops, &etnaviv_obj);
742	if (ret)
743		return ret;
744
745	lockdep_set_class(&etnaviv_obj->lock, &etnaviv_userptr_lock_class);
746
747	etnaviv_obj->userptr.ptr = ptr;
748	etnaviv_obj->userptr.mm = current->mm;
749	etnaviv_obj->userptr.ro = !(flags & ETNA_USERPTR_WRITE);
750
751	etnaviv_gem_obj_add(dev, &etnaviv_obj->base);
752
753	ret = drm_gem_handle_create(file, &etnaviv_obj->base, handle);
754
755	/* drop reference from allocate - handle holds it now */
756	drm_gem_object_put(&etnaviv_obj->base);
757	return ret;
758}