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