Linux Audio

Check our new training course

Loading...
v4.6
 
  1/*
  2 * Copyright (C) 2013 Red Hat
  3 * Author: Rob Clark <robdclark@gmail.com>
  4 *
  5 * This program is free software; you can redistribute it and/or modify it
  6 * under the terms of the GNU General Public License version 2 as published by
  7 * the Free Software Foundation.
  8 *
  9 * This program is distributed in the hope that it will be useful, but WITHOUT
 10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 11 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 12 * more details.
 13 *
 14 * You should have received a copy of the GNU General Public License along with
 15 * this program.  If not, see <http://www.gnu.org/licenses/>.
 16 */
 17
 18#include <linux/spinlock.h>
 19#include <linux/shmem_fs.h>
 20#include <linux/dma-buf.h>
 21#include <linux/pfn_t.h>
 22
 
 
 23#include "msm_drv.h"
 
 24#include "msm_gem.h"
 25#include "msm_gpu.h"
 26#include "msm_mmu.h"
 27
 
 
 
 28static dma_addr_t physaddr(struct drm_gem_object *obj)
 29{
 30	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 31	struct msm_drm_private *priv = obj->dev->dev_private;
 32	return (((dma_addr_t)msm_obj->vram_node->start) << PAGE_SHIFT) +
 33			priv->vram.paddr;
 34}
 35
 36static bool use_pages(struct drm_gem_object *obj)
 37{
 38	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 39	return !msm_obj->vram_node;
 40}
 41
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 42/* allocate pages from VRAM carveout, used when no IOMMU: */
 43static struct page **get_pages_vram(struct drm_gem_object *obj,
 44		int npages)
 45{
 46	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 47	struct msm_drm_private *priv = obj->dev->dev_private;
 48	dma_addr_t paddr;
 49	struct page **p;
 50	int ret, i;
 51
 52	p = drm_malloc_ab(npages, sizeof(struct page *));
 53	if (!p)
 54		return ERR_PTR(-ENOMEM);
 55
 56	ret = drm_mm_insert_node(&priv->vram.mm, msm_obj->vram_node,
 57			npages, 0, DRM_MM_SEARCH_DEFAULT);
 
 58	if (ret) {
 59		drm_free_large(p);
 60		return ERR_PTR(ret);
 61	}
 62
 63	paddr = physaddr(obj);
 64	for (i = 0; i < npages; i++) {
 65		p[i] = phys_to_page(paddr);
 66		paddr += PAGE_SIZE;
 67	}
 68
 69	return p;
 70}
 71
 72/* called with dev->struct_mutex held */
 73static struct page **get_pages(struct drm_gem_object *obj)
 74{
 75	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 76
 77	if (!msm_obj->pages) {
 78		struct drm_device *dev = obj->dev;
 79		struct page **p;
 80		int npages = obj->size >> PAGE_SHIFT;
 81
 82		if (use_pages(obj))
 83			p = drm_gem_get_pages(obj);
 84		else
 85			p = get_pages_vram(obj, npages);
 86
 87		if (IS_ERR(p)) {
 88			dev_err(dev->dev, "could not get pages: %ld\n",
 89					PTR_ERR(p));
 90			return p;
 91		}
 92
 
 
 93		msm_obj->sgt = drm_prime_pages_to_sg(p, npages);
 94		if (IS_ERR(msm_obj->sgt)) {
 95			dev_err(dev->dev, "failed to allocate sgt\n");
 96			return ERR_CAST(msm_obj->sgt);
 97		}
 98
 99		msm_obj->pages = p;
 
 
 
100
101		/* For non-cached buffers, ensure the new pages are clean
102		 * because display controller, GPU, etc. are not coherent:
103		 */
104		if (msm_obj->flags & (MSM_BO_WC|MSM_BO_UNCACHED))
105			dma_map_sg(dev->dev, msm_obj->sgt->sgl,
106					msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
107	}
108
109	return msm_obj->pages;
110}
111
 
 
 
 
 
 
 
 
 
 
 
 
112static void put_pages(struct drm_gem_object *obj)
113{
114	struct msm_gem_object *msm_obj = to_msm_bo(obj);
115
116	if (msm_obj->pages) {
117		/* For non-cached buffers, ensure the new pages are clean
118		 * because display controller, GPU, etc. are not coherent:
119		 */
120		if (msm_obj->flags & (MSM_BO_WC|MSM_BO_UNCACHED))
121			dma_unmap_sg(obj->dev->dev, msm_obj->sgt->sgl,
122					msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
123		sg_free_table(msm_obj->sgt);
124		kfree(msm_obj->sgt);
 
 
 
125
126		if (use_pages(obj))
127			drm_gem_put_pages(obj, msm_obj->pages, true, false);
128		else {
129			drm_mm_remove_node(msm_obj->vram_node);
130			drm_free_large(msm_obj->pages);
131		}
132
133		msm_obj->pages = NULL;
134	}
135}
136
137struct page **msm_gem_get_pages(struct drm_gem_object *obj)
138{
139	struct drm_device *dev = obj->dev;
140	struct page **p;
141	mutex_lock(&dev->struct_mutex);
 
 
 
 
 
 
 
142	p = get_pages(obj);
143	mutex_unlock(&dev->struct_mutex);
144	return p;
145}
146
147void msm_gem_put_pages(struct drm_gem_object *obj)
148{
149	/* when we start tracking the pin count, then do something here */
150}
151
152int msm_gem_mmap_obj(struct drm_gem_object *obj,
153		struct vm_area_struct *vma)
154{
155	struct msm_gem_object *msm_obj = to_msm_bo(obj);
156
157	vma->vm_flags &= ~VM_PFNMAP;
158	vma->vm_flags |= VM_MIXEDMAP;
159
160	if (msm_obj->flags & MSM_BO_WC) {
161		vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
162	} else if (msm_obj->flags & MSM_BO_UNCACHED) {
163		vma->vm_page_prot = pgprot_noncached(vm_get_page_prot(vma->vm_flags));
164	} else {
165		/*
166		 * Shunt off cached objs to shmem file so they have their own
167		 * address_space (so unmap_mapping_range does what we want,
168		 * in particular in the case of mmap'd dmabufs)
169		 */
170		fput(vma->vm_file);
171		get_file(obj->filp);
172		vma->vm_pgoff = 0;
173		vma->vm_file  = obj->filp;
174
175		vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
176	}
177
178	return 0;
179}
180
181int msm_gem_mmap(struct file *filp, struct vm_area_struct *vma)
182{
183	int ret;
184
185	ret = drm_gem_mmap(filp, vma);
186	if (ret) {
187		DBG("mmap failed: %d", ret);
188		return ret;
189	}
190
191	return msm_gem_mmap_obj(vma->vm_private_data, vma);
192}
193
194int msm_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
195{
 
196	struct drm_gem_object *obj = vma->vm_private_data;
197	struct drm_device *dev = obj->dev;
198	struct page **pages;
199	unsigned long pfn;
200	pgoff_t pgoff;
201	int ret;
 
202
203	/* Make sure we don't parallel update on a fault, nor move or remove
204	 * something from beneath our feet
 
205	 */
206	ret = mutex_lock_interruptible(&dev->struct_mutex);
207	if (ret)
 
208		goto out;
 
 
 
 
 
 
209
210	/* make sure we have pages attached now */
211	pages = get_pages(obj);
212	if (IS_ERR(pages)) {
213		ret = PTR_ERR(pages);
214		goto out_unlock;
215	}
216
217	/* We don't use vmf->pgoff since that has the fake offset: */
218	pgoff = ((unsigned long)vmf->virtual_address -
219			vma->vm_start) >> PAGE_SHIFT;
220
221	pfn = page_to_pfn(pages[pgoff]);
222
223	VERB("Inserting %p pfn %lx, pa %lx", vmf->virtual_address,
224			pfn, pfn << PAGE_SHIFT);
225
226	ret = vm_insert_mixed(vma, (unsigned long)vmf->virtual_address,
227			__pfn_to_pfn_t(pfn, PFN_DEV));
228
229out_unlock:
230	mutex_unlock(&dev->struct_mutex);
231out:
232	switch (ret) {
233	case -EAGAIN:
234	case 0:
235	case -ERESTARTSYS:
236	case -EINTR:
237	case -EBUSY:
238		/*
239		 * EBUSY is ok: this just means that another thread
240		 * already did the job.
241		 */
242		return VM_FAULT_NOPAGE;
243	case -ENOMEM:
244		return VM_FAULT_OOM;
245	default:
246		return VM_FAULT_SIGBUS;
247	}
248}
249
250/** get mmap offset */
251static uint64_t mmap_offset(struct drm_gem_object *obj)
252{
253	struct drm_device *dev = obj->dev;
 
254	int ret;
255
256	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
257
258	/* Make it mmapable */
259	ret = drm_gem_create_mmap_offset(obj);
260
261	if (ret) {
262		dev_err(dev->dev, "could not allocate mmap offset\n");
263		return 0;
264	}
265
266	return drm_vma_node_offset_addr(&obj->vma_node);
267}
268
269uint64_t msm_gem_mmap_offset(struct drm_gem_object *obj)
270{
271	uint64_t offset;
272	mutex_lock(&obj->dev->struct_mutex);
 
 
273	offset = mmap_offset(obj);
274	mutex_unlock(&obj->dev->struct_mutex);
275	return offset;
276}
277
278/* should be called under struct_mutex.. although it can be called
279 * from atomic context without struct_mutex to acquire an extra
280 * iova ref if you know one is already held.
281 *
282 * That means when I do eventually need to add support for unpinning
283 * the refcnt counter needs to be atomic_t.
284 */
285int msm_gem_get_iova_locked(struct drm_gem_object *obj, int id,
286		uint32_t *iova)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
287{
288	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 
289	int ret = 0;
290
291	if (!msm_obj->domain[id].iova) {
292		struct msm_drm_private *priv = obj->dev->dev_private;
293		struct page **pages = get_pages(obj);
294
295		if (IS_ERR(pages))
296			return PTR_ERR(pages);
297
298		if (iommu_present(&platform_bus_type)) {
299			struct msm_mmu *mmu = priv->mmus[id];
300			uint32_t offset;
301
302			if (WARN_ON(!mmu))
303				return -EINVAL;
304
305			offset = (uint32_t)mmap_offset(obj);
306			ret = mmu->funcs->map(mmu, offset, msm_obj->sgt,
307					obj->size, IOMMU_READ | IOMMU_WRITE);
308			msm_obj->domain[id].iova = offset;
309		} else {
310			msm_obj->domain[id].iova = physaddr(obj);
311		}
312	}
313
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
314	if (!ret)
315		*iova = msm_obj->domain[id].iova;
316
 
317	return ret;
318}
319
320/* get iova, taking a reference.  Should have a matching put */
321int msm_gem_get_iova(struct drm_gem_object *obj, int id, uint32_t *iova)
 
 
 
 
322{
323	struct msm_gem_object *msm_obj = to_msm_bo(obj);
324	int ret;
325
326	/* this is safe right now because we don't unmap until the
327	 * bo is deleted:
328	 */
329	if (msm_obj->domain[id].iova) {
330		*iova = msm_obj->domain[id].iova;
331		return 0;
332	}
333
334	mutex_lock(&obj->dev->struct_mutex);
335	ret = msm_gem_get_iova_locked(obj, id, iova);
336	mutex_unlock(&obj->dev->struct_mutex);
337	return ret;
338}
339
340/* get iova without taking a reference, used in places where you have
341 * already done a 'msm_gem_get_iova()'.
342 */
343uint32_t msm_gem_iova(struct drm_gem_object *obj, int id)
 
344{
345	struct msm_gem_object *msm_obj = to_msm_bo(obj);
346	WARN_ON(!msm_obj->domain[id].iova);
347	return msm_obj->domain[id].iova;
 
 
 
 
 
 
348}
349
350void msm_gem_put_iova(struct drm_gem_object *obj, int id)
 
 
 
 
 
 
351{
352	// XXX TODO ..
353	// NOTE: probably don't need a _locked() version.. we wouldn't
354	// normally unmap here, but instead just mark that it could be
355	// unmapped (if the iova refcnt drops to zero), but then later
356	// if another _get_iova_locked() fails we can start unmapping
357	// things that are no longer needed..
 
 
 
 
358}
359
360int msm_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
361		struct drm_mode_create_dumb *args)
362{
363	args->pitch = align_pitch(args->width, args->bpp);
364	args->size  = PAGE_ALIGN(args->pitch * args->height);
365	return msm_gem_new_handle(dev, file, args->size,
366			MSM_BO_SCANOUT | MSM_BO_WC, &args->handle);
367}
368
369int msm_gem_dumb_map_offset(struct drm_file *file, struct drm_device *dev,
370		uint32_t handle, uint64_t *offset)
371{
372	struct drm_gem_object *obj;
373	int ret = 0;
374
375	/* GEM does all our handle to object mapping */
376	obj = drm_gem_object_lookup(dev, file, handle);
377	if (obj == NULL) {
378		ret = -ENOENT;
379		goto fail;
380	}
381
382	*offset = msm_gem_mmap_offset(obj);
383
384	drm_gem_object_unreference_unlocked(obj);
385
386fail:
387	return ret;
388}
389
390void *msm_gem_vaddr_locked(struct drm_gem_object *obj)
391{
392	struct msm_gem_object *msm_obj = to_msm_bo(obj);
393	WARN_ON(!mutex_is_locked(&obj->dev->struct_mutex));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
394	if (!msm_obj->vaddr) {
395		struct page **pages = get_pages(obj);
396		if (IS_ERR(pages))
397			return ERR_CAST(pages);
 
 
398		msm_obj->vaddr = vmap(pages, obj->size >> PAGE_SHIFT,
399				VM_MAP, pgprot_writecombine(PAGE_KERNEL));
 
 
 
 
400	}
 
 
401	return msm_obj->vaddr;
 
 
 
 
 
402}
403
404void *msm_gem_vaddr(struct drm_gem_object *obj)
405{
406	void *ret;
407	mutex_lock(&obj->dev->struct_mutex);
408	ret = msm_gem_vaddr_locked(obj);
409	mutex_unlock(&obj->dev->struct_mutex);
410	return ret;
411}
412
413/* setup callback for when bo is no longer busy..
414 * TODO probably want to differentiate read vs write..
 
 
 
415 */
416int msm_gem_queue_inactive_cb(struct drm_gem_object *obj,
417		struct msm_fence_cb *cb)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
418{
419	struct msm_gem_object *msm_obj = to_msm_bo(obj);
420	uint32_t fence = msm_gem_fence(msm_obj,
421			MSM_PREP_READ | MSM_PREP_WRITE);
422	return msm_queue_fence_cb(obj->dev, cb, fence);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
423}
424
425void msm_gem_move_to_active(struct drm_gem_object *obj,
426		struct msm_gpu *gpu, bool write, uint32_t fence)
427{
428	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 
429	msm_obj->gpu = gpu;
430	if (write)
431		msm_obj->write_fence = fence;
432	else
433		msm_obj->read_fence = fence;
434	list_del_init(&msm_obj->mm_list);
435	list_add_tail(&msm_obj->mm_list, &gpu->active_list);
436}
437
438void msm_gem_move_to_inactive(struct drm_gem_object *obj)
439{
440	struct drm_device *dev = obj->dev;
441	struct msm_drm_private *priv = dev->dev_private;
442	struct msm_gem_object *msm_obj = to_msm_bo(obj);
443
444	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
445
446	msm_obj->gpu = NULL;
447	msm_obj->read_fence = 0;
448	msm_obj->write_fence = 0;
449	list_del_init(&msm_obj->mm_list);
450	list_add_tail(&msm_obj->mm_list, &priv->inactive_list);
451}
452
453int msm_gem_cpu_prep(struct drm_gem_object *obj, uint32_t op, ktime_t *timeout)
454{
455	struct drm_device *dev = obj->dev;
456	struct msm_gem_object *msm_obj = to_msm_bo(obj);
457	int ret = 0;
458
459	if (is_active(msm_obj)) {
460		uint32_t fence = msm_gem_fence(msm_obj, op);
461
462		if (op & MSM_PREP_NOSYNC)
463			timeout = NULL;
464
465		ret = msm_wait_fence(dev, fence, timeout, true);
466	}
467
468	/* TODO cache maintenance */
469
470	return ret;
471}
472
473int msm_gem_cpu_fini(struct drm_gem_object *obj)
474{
475	/* TODO cache maintenance */
476	return 0;
477}
478
479#ifdef CONFIG_DEBUG_FS
 
 
 
 
 
 
 
 
 
 
480void msm_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
481{
482	struct drm_device *dev = obj->dev;
483	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 
 
 
 
484	uint64_t off = drm_vma_node_start(&obj->vma_node);
 
485
486	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
487	seq_printf(m, "%08x: %c(r=%u,w=%u) %2d (%2d) %08llx %p %zu\n",
 
 
 
 
 
 
 
 
 
 
 
 
 
 
488			msm_obj->flags, is_active(msm_obj) ? 'A' : 'I',
489			msm_obj->read_fence, msm_obj->write_fence,
490			obj->name, obj->refcount.refcount.counter,
491			off, msm_obj->vaddr, obj->size);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
492}
493
494void msm_gem_describe_objects(struct list_head *list, struct seq_file *m)
495{
496	struct msm_gem_object *msm_obj;
497	int count = 0;
498	size_t size = 0;
499
 
500	list_for_each_entry(msm_obj, list, mm_list) {
501		struct drm_gem_object *obj = &msm_obj->base;
502		seq_printf(m, "   ");
503		msm_gem_describe(obj, m);
504		count++;
505		size += obj->size;
506	}
507
508	seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
509}
510#endif
511
 
512void msm_gem_free_object(struct drm_gem_object *obj)
513{
514	struct drm_device *dev = obj->dev;
515	struct msm_drm_private *priv = obj->dev->dev_private;
516	struct msm_gem_object *msm_obj = to_msm_bo(obj);
517	int id;
 
 
 
 
 
 
 
 
 
 
518
519	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
520
521	/* object should not be on active list: */
522	WARN_ON(is_active(msm_obj));
523
524	list_del(&msm_obj->mm_list);
525
526	for (id = 0; id < ARRAY_SIZE(msm_obj->domain); id++) {
527		struct msm_mmu *mmu = priv->mmus[id];
528		if (mmu && msm_obj->domain[id].iova) {
529			uint32_t offset = msm_obj->domain[id].iova;
530			mmu->funcs->unmap(mmu, offset, msm_obj->sgt, obj->size);
531		}
532	}
533
534	if (obj->import_attach) {
535		if (msm_obj->vaddr)
536			dma_buf_vunmap(obj->import_attach->dmabuf, msm_obj->vaddr);
537
538		/* Don't drop the pages for imported dmabuf, as they are not
539		 * ours, just free the array we allocated:
540		 */
541		if (msm_obj->pages)
542			drm_free_large(msm_obj->pages);
543
544		drm_prime_gem_destroy(obj, msm_obj->sgt);
545	} else {
546		vunmap(msm_obj->vaddr);
547		put_pages(obj);
548	}
549
550	if (msm_obj->resv == &msm_obj->_resv)
551		reservation_object_fini(msm_obj->resv);
552
553	drm_gem_object_release(obj);
554
 
555	kfree(msm_obj);
556}
557
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
558/* convenience method to construct a GEM buffer object, and userspace handle */
559int msm_gem_new_handle(struct drm_device *dev, struct drm_file *file,
560		uint32_t size, uint32_t flags, uint32_t *handle)
 
561{
562	struct drm_gem_object *obj;
563	int ret;
564
565	ret = mutex_lock_interruptible(&dev->struct_mutex);
566	if (ret)
567		return ret;
568
569	obj = msm_gem_new(dev, size, flags);
570
571	mutex_unlock(&dev->struct_mutex);
572
573	if (IS_ERR(obj))
574		return PTR_ERR(obj);
575
 
 
 
576	ret = drm_gem_handle_create(file, obj, handle);
577
578	/* drop reference from allocate - handle holds it now */
579	drm_gem_object_unreference_unlocked(obj);
580
581	return ret;
582}
583
584static int msm_gem_new_impl(struct drm_device *dev,
585		uint32_t size, uint32_t flags,
586		struct drm_gem_object **obj)
 
587{
588	struct msm_drm_private *priv = dev->dev_private;
589	struct msm_gem_object *msm_obj;
590	unsigned sz;
591	bool use_vram = false;
592
593	switch (flags & MSM_BO_CACHE_MASK) {
594	case MSM_BO_UNCACHED:
595	case MSM_BO_CACHED:
596	case MSM_BO_WC:
597		break;
598	default:
599		dev_err(dev->dev, "invalid cache flag: %x\n",
600				(flags & MSM_BO_CACHE_MASK));
601		return -EINVAL;
602	}
603
604	if (!iommu_present(&platform_bus_type))
605		use_vram = true;
606	else if ((flags & MSM_BO_STOLEN) && priv->vram.size)
607		use_vram = true;
608
609	if (WARN_ON(use_vram && !priv->vram.size))
610		return -EINVAL;
611
612	sz = sizeof(*msm_obj);
613	if (use_vram)
614		sz += sizeof(struct drm_mm_node);
615
616	msm_obj = kzalloc(sz, GFP_KERNEL);
617	if (!msm_obj)
618		return -ENOMEM;
619
620	if (use_vram)
621		msm_obj->vram_node = (void *)&msm_obj[1];
622
623	msm_obj->flags = flags;
624
625	msm_obj->resv = &msm_obj->_resv;
626	reservation_object_init(msm_obj->resv);
627
628	INIT_LIST_HEAD(&msm_obj->submit_entry);
629	list_add_tail(&msm_obj->mm_list, &priv->inactive_list);
 
 
 
 
 
 
 
 
 
630
631	*obj = &msm_obj->base;
632
633	return 0;
634}
635
636struct drm_gem_object *msm_gem_new(struct drm_device *dev,
637		uint32_t size, uint32_t flags)
638{
 
639	struct drm_gem_object *obj = NULL;
 
640	int ret;
641
642	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
643
644	size = PAGE_ALIGN(size);
645
646	ret = msm_gem_new_impl(dev, size, flags, &obj);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
647	if (ret)
648		goto fail;
649
650	if (use_pages(obj)) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
651		ret = drm_gem_object_init(dev, obj, size);
652		if (ret)
653			goto fail;
654	} else {
655		drm_gem_private_object_init(dev, obj, size);
 
 
 
 
 
656	}
657
658	return obj;
659
660fail:
661	if (obj)
662		drm_gem_object_unreference(obj);
663
664	return ERR_PTR(ret);
665}
666
 
 
 
 
 
 
 
 
 
 
 
 
667struct drm_gem_object *msm_gem_import(struct drm_device *dev,
668		uint32_t size, struct sg_table *sgt)
669{
670	struct msm_gem_object *msm_obj;
671	struct drm_gem_object *obj;
 
672	int ret, npages;
673
674	/* if we don't have IOMMU, don't bother pretending we can import: */
675	if (!iommu_present(&platform_bus_type)) {
676		dev_err(dev->dev, "cannot import without IOMMU\n");
677		return ERR_PTR(-EINVAL);
678	}
679
680	size = PAGE_ALIGN(size);
681
682	ret = msm_gem_new_impl(dev, size, MSM_BO_WC, &obj);
683	if (ret)
684		goto fail;
685
686	drm_gem_private_object_init(dev, obj, size);
687
688	npages = size / PAGE_SIZE;
689
690	msm_obj = to_msm_bo(obj);
 
691	msm_obj->sgt = sgt;
692	msm_obj->pages = drm_malloc_ab(npages, sizeof(struct page *));
693	if (!msm_obj->pages) {
 
694		ret = -ENOMEM;
695		goto fail;
696	}
697
698	ret = drm_prime_sg_to_page_addr_arrays(sgt, msm_obj->pages, NULL, npages);
699	if (ret)
 
700		goto fail;
 
701
 
702	return obj;
703
704fail:
705	if (obj)
706		drm_gem_object_unreference_unlocked(obj);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
707
708	return ERR_PTR(ret);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
709}
v5.4
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Copyright (C) 2013 Red Hat
   4 * Author: Rob Clark <robdclark@gmail.com>
 
 
 
 
 
 
 
 
 
 
 
 
   5 */
   6
   7#include <linux/spinlock.h>
   8#include <linux/shmem_fs.h>
   9#include <linux/dma-buf.h>
  10#include <linux/pfn_t.h>
  11
  12#include <drm/drm_prime.h>
  13
  14#include "msm_drv.h"
  15#include "msm_fence.h"
  16#include "msm_gem.h"
  17#include "msm_gpu.h"
  18#include "msm_mmu.h"
  19
  20static void msm_gem_vunmap_locked(struct drm_gem_object *obj);
  21
  22
  23static dma_addr_t physaddr(struct drm_gem_object *obj)
  24{
  25	struct msm_gem_object *msm_obj = to_msm_bo(obj);
  26	struct msm_drm_private *priv = obj->dev->dev_private;
  27	return (((dma_addr_t)msm_obj->vram_node->start) << PAGE_SHIFT) +
  28			priv->vram.paddr;
  29}
  30
  31static bool use_pages(struct drm_gem_object *obj)
  32{
  33	struct msm_gem_object *msm_obj = to_msm_bo(obj);
  34	return !msm_obj->vram_node;
  35}
  36
  37/*
  38 * Cache sync.. this is a bit over-complicated, to fit dma-mapping
  39 * API.  Really GPU cache is out of scope here (handled on cmdstream)
  40 * and all we need to do is invalidate newly allocated pages before
  41 * mapping to CPU as uncached/writecombine.
  42 *
  43 * On top of this, we have the added headache, that depending on
  44 * display generation, the display's iommu may be wired up to either
  45 * the toplevel drm device (mdss), or to the mdp sub-node, meaning
  46 * that here we either have dma-direct or iommu ops.
  47 *
  48 * Let this be a cautionary tail of abstraction gone wrong.
  49 */
  50
  51static void sync_for_device(struct msm_gem_object *msm_obj)
  52{
  53	struct device *dev = msm_obj->base.dev->dev;
  54
  55	if (get_dma_ops(dev) && IS_ENABLED(CONFIG_ARM64)) {
  56		dma_sync_sg_for_device(dev, msm_obj->sgt->sgl,
  57			msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
  58	} else {
  59		dma_map_sg(dev, msm_obj->sgt->sgl,
  60			msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
  61	}
  62}
  63
  64static void sync_for_cpu(struct msm_gem_object *msm_obj)
  65{
  66	struct device *dev = msm_obj->base.dev->dev;
  67
  68	if (get_dma_ops(dev) && IS_ENABLED(CONFIG_ARM64)) {
  69		dma_sync_sg_for_cpu(dev, msm_obj->sgt->sgl,
  70			msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
  71	} else {
  72		dma_unmap_sg(dev, msm_obj->sgt->sgl,
  73			msm_obj->sgt->nents, DMA_BIDIRECTIONAL);
  74	}
  75}
  76
  77/* allocate pages from VRAM carveout, used when no IOMMU: */
  78static struct page **get_pages_vram(struct drm_gem_object *obj, int npages)
 
  79{
  80	struct msm_gem_object *msm_obj = to_msm_bo(obj);
  81	struct msm_drm_private *priv = obj->dev->dev_private;
  82	dma_addr_t paddr;
  83	struct page **p;
  84	int ret, i;
  85
  86	p = kvmalloc_array(npages, sizeof(struct page *), GFP_KERNEL);
  87	if (!p)
  88		return ERR_PTR(-ENOMEM);
  89
  90	spin_lock(&priv->vram.lock);
  91	ret = drm_mm_insert_node(&priv->vram.mm, msm_obj->vram_node, npages);
  92	spin_unlock(&priv->vram.lock);
  93	if (ret) {
  94		kvfree(p);
  95		return ERR_PTR(ret);
  96	}
  97
  98	paddr = physaddr(obj);
  99	for (i = 0; i < npages; i++) {
 100		p[i] = phys_to_page(paddr);
 101		paddr += PAGE_SIZE;
 102	}
 103
 104	return p;
 105}
 106
 
 107static struct page **get_pages(struct drm_gem_object *obj)
 108{
 109	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 110
 111	if (!msm_obj->pages) {
 112		struct drm_device *dev = obj->dev;
 113		struct page **p;
 114		int npages = obj->size >> PAGE_SHIFT;
 115
 116		if (use_pages(obj))
 117			p = drm_gem_get_pages(obj);
 118		else
 119			p = get_pages_vram(obj, npages);
 120
 121		if (IS_ERR(p)) {
 122			DRM_DEV_ERROR(dev->dev, "could not get pages: %ld\n",
 123					PTR_ERR(p));
 124			return p;
 125		}
 126
 127		msm_obj->pages = p;
 128
 129		msm_obj->sgt = drm_prime_pages_to_sg(p, npages);
 130		if (IS_ERR(msm_obj->sgt)) {
 131			void *ptr = ERR_CAST(msm_obj->sgt);
 
 
 132
 133			DRM_DEV_ERROR(dev->dev, "failed to allocate sgt\n");
 134			msm_obj->sgt = NULL;
 135			return ptr;
 136		}
 137
 138		/* For non-cached buffers, ensure the new pages are clean
 139		 * because display controller, GPU, etc. are not coherent:
 140		 */
 141		if (msm_obj->flags & (MSM_BO_WC|MSM_BO_UNCACHED))
 142			sync_for_device(msm_obj);
 
 143	}
 144
 145	return msm_obj->pages;
 146}
 147
 148static void put_pages_vram(struct drm_gem_object *obj)
 149{
 150	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 151	struct msm_drm_private *priv = obj->dev->dev_private;
 152
 153	spin_lock(&priv->vram.lock);
 154	drm_mm_remove_node(msm_obj->vram_node);
 155	spin_unlock(&priv->vram.lock);
 156
 157	kvfree(msm_obj->pages);
 158}
 159
 160static void put_pages(struct drm_gem_object *obj)
 161{
 162	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 163
 164	if (msm_obj->pages) {
 165		if (msm_obj->sgt) {
 166			/* For non-cached buffers, ensure the new
 167			 * pages are clean because display controller,
 168			 * GPU, etc. are not coherent:
 169			 */
 170			if (msm_obj->flags & (MSM_BO_WC|MSM_BO_UNCACHED))
 171				sync_for_cpu(msm_obj);
 172
 173			sg_free_table(msm_obj->sgt);
 174			kfree(msm_obj->sgt);
 175		}
 176
 177		if (use_pages(obj))
 178			drm_gem_put_pages(obj, msm_obj->pages, true, false);
 179		else
 180			put_pages_vram(obj);
 
 
 181
 182		msm_obj->pages = NULL;
 183	}
 184}
 185
 186struct page **msm_gem_get_pages(struct drm_gem_object *obj)
 187{
 188	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 189	struct page **p;
 190
 191	mutex_lock(&msm_obj->lock);
 192
 193	if (WARN_ON(msm_obj->madv != MSM_MADV_WILLNEED)) {
 194		mutex_unlock(&msm_obj->lock);
 195		return ERR_PTR(-EBUSY);
 196	}
 197
 198	p = get_pages(obj);
 199	mutex_unlock(&msm_obj->lock);
 200	return p;
 201}
 202
 203void msm_gem_put_pages(struct drm_gem_object *obj)
 204{
 205	/* when we start tracking the pin count, then do something here */
 206}
 207
 208int msm_gem_mmap_obj(struct drm_gem_object *obj,
 209		struct vm_area_struct *vma)
 210{
 211	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 212
 213	vma->vm_flags &= ~VM_PFNMAP;
 214	vma->vm_flags |= VM_MIXEDMAP;
 215
 216	if (msm_obj->flags & MSM_BO_WC) {
 217		vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
 218	} else if (msm_obj->flags & MSM_BO_UNCACHED) {
 219		vma->vm_page_prot = pgprot_noncached(vm_get_page_prot(vma->vm_flags));
 220	} else {
 221		/*
 222		 * Shunt off cached objs to shmem file so they have their own
 223		 * address_space (so unmap_mapping_range does what we want,
 224		 * in particular in the case of mmap'd dmabufs)
 225		 */
 226		fput(vma->vm_file);
 227		get_file(obj->filp);
 228		vma->vm_pgoff = 0;
 229		vma->vm_file  = obj->filp;
 230
 231		vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
 232	}
 233
 234	return 0;
 235}
 236
 237int msm_gem_mmap(struct file *filp, struct vm_area_struct *vma)
 238{
 239	int ret;
 240
 241	ret = drm_gem_mmap(filp, vma);
 242	if (ret) {
 243		DBG("mmap failed: %d", ret);
 244		return ret;
 245	}
 246
 247	return msm_gem_mmap_obj(vma->vm_private_data, vma);
 248}
 249
 250vm_fault_t msm_gem_fault(struct vm_fault *vmf)
 251{
 252	struct vm_area_struct *vma = vmf->vma;
 253	struct drm_gem_object *obj = vma->vm_private_data;
 254	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 255	struct page **pages;
 256	unsigned long pfn;
 257	pgoff_t pgoff;
 258	int err;
 259	vm_fault_t ret;
 260
 261	/*
 262	 * vm_ops.open/drm_gem_mmap_obj and close get and put
 263	 * a reference on obj. So, we dont need to hold one here.
 264	 */
 265	err = mutex_lock_interruptible(&msm_obj->lock);
 266	if (err) {
 267		ret = VM_FAULT_NOPAGE;
 268		goto out;
 269	}
 270
 271	if (WARN_ON(msm_obj->madv != MSM_MADV_WILLNEED)) {
 272		mutex_unlock(&msm_obj->lock);
 273		return VM_FAULT_SIGBUS;
 274	}
 275
 276	/* make sure we have pages attached now */
 277	pages = get_pages(obj);
 278	if (IS_ERR(pages)) {
 279		ret = vmf_error(PTR_ERR(pages));
 280		goto out_unlock;
 281	}
 282
 283	/* We don't use vmf->pgoff since that has the fake offset: */
 284	pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
 
 285
 286	pfn = page_to_pfn(pages[pgoff]);
 287
 288	VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
 289			pfn, pfn << PAGE_SHIFT);
 290
 291	ret = vmf_insert_mixed(vma, vmf->address, __pfn_to_pfn_t(pfn, PFN_DEV));
 
 
 292out_unlock:
 293	mutex_unlock(&msm_obj->lock);
 294out:
 295	return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 296}
 297
 298/** get mmap offset */
 299static uint64_t mmap_offset(struct drm_gem_object *obj)
 300{
 301	struct drm_device *dev = obj->dev;
 302	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 303	int ret;
 304
 305	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 306
 307	/* Make it mmapable */
 308	ret = drm_gem_create_mmap_offset(obj);
 309
 310	if (ret) {
 311		DRM_DEV_ERROR(dev->dev, "could not allocate mmap offset\n");
 312		return 0;
 313	}
 314
 315	return drm_vma_node_offset_addr(&obj->vma_node);
 316}
 317
 318uint64_t msm_gem_mmap_offset(struct drm_gem_object *obj)
 319{
 320	uint64_t offset;
 321	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 322
 323	mutex_lock(&msm_obj->lock);
 324	offset = mmap_offset(obj);
 325	mutex_unlock(&msm_obj->lock);
 326	return offset;
 327}
 328
 329static struct msm_gem_vma *add_vma(struct drm_gem_object *obj,
 330		struct msm_gem_address_space *aspace)
 331{
 332	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 333	struct msm_gem_vma *vma;
 334
 335	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 336
 337	vma = kzalloc(sizeof(*vma), GFP_KERNEL);
 338	if (!vma)
 339		return ERR_PTR(-ENOMEM);
 340
 341	vma->aspace = aspace;
 342
 343	list_add_tail(&vma->list, &msm_obj->vmas);
 344
 345	return vma;
 346}
 347
 348static struct msm_gem_vma *lookup_vma(struct drm_gem_object *obj,
 349		struct msm_gem_address_space *aspace)
 350{
 351	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 352	struct msm_gem_vma *vma;
 353
 354	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 355
 356	list_for_each_entry(vma, &msm_obj->vmas, list) {
 357		if (vma->aspace == aspace)
 358			return vma;
 359	}
 360
 361	return NULL;
 362}
 363
 364static void del_vma(struct msm_gem_vma *vma)
 365{
 366	if (!vma)
 367		return;
 368
 369	list_del(&vma->list);
 370	kfree(vma);
 371}
 372
 373/* Called with msm_obj->lock locked */
 374static void
 375put_iova(struct drm_gem_object *obj)
 376{
 377	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 378	struct msm_gem_vma *vma, *tmp;
 379
 380	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 381
 382	list_for_each_entry_safe(vma, tmp, &msm_obj->vmas, list) {
 383		if (vma->aspace) {
 384			msm_gem_purge_vma(vma->aspace, vma);
 385			msm_gem_close_vma(vma->aspace, vma);
 386		}
 387		del_vma(vma);
 388	}
 389}
 390
 391static int msm_gem_get_iova_locked(struct drm_gem_object *obj,
 392		struct msm_gem_address_space *aspace, uint64_t *iova)
 393{
 394	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 395	struct msm_gem_vma *vma;
 396	int ret = 0;
 397
 398	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 
 
 399
 400	vma = lookup_vma(obj, aspace);
 
 401
 402	if (!vma) {
 403		vma = add_vma(obj, aspace);
 404		if (IS_ERR(vma))
 405			return PTR_ERR(vma);
 406
 407		ret = msm_gem_init_vma(aspace, vma, obj->size >> PAGE_SHIFT);
 408		if (ret) {
 409			del_vma(vma);
 410			return ret;
 
 
 
 
 411		}
 412	}
 413
 414	*iova = vma->iova;
 415	return 0;
 416}
 417
 418static int msm_gem_pin_iova(struct drm_gem_object *obj,
 419		struct msm_gem_address_space *aspace)
 420{
 421	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 422	struct msm_gem_vma *vma;
 423	struct page **pages;
 424	int prot = IOMMU_READ;
 425
 426	if (!(msm_obj->flags & MSM_BO_GPU_READONLY))
 427		prot |= IOMMU_WRITE;
 428
 429	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 430
 431	if (WARN_ON(msm_obj->madv != MSM_MADV_WILLNEED))
 432		return -EBUSY;
 433
 434	vma = lookup_vma(obj, aspace);
 435	if (WARN_ON(!vma))
 436		return -EINVAL;
 437
 438	pages = get_pages(obj);
 439	if (IS_ERR(pages))
 440		return PTR_ERR(pages);
 441
 442	return msm_gem_map_vma(aspace, vma, prot,
 443			msm_obj->sgt, obj->size >> PAGE_SHIFT);
 444}
 445
 446/* get iova and pin it. Should have a matching put */
 447int msm_gem_get_and_pin_iova(struct drm_gem_object *obj,
 448		struct msm_gem_address_space *aspace, uint64_t *iova)
 449{
 450	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 451	u64 local;
 452	int ret;
 453
 454	mutex_lock(&msm_obj->lock);
 455
 456	ret = msm_gem_get_iova_locked(obj, aspace, &local);
 457
 458	if (!ret)
 459		ret = msm_gem_pin_iova(obj, aspace);
 460
 461	if (!ret)
 462		*iova = local;
 463
 464	mutex_unlock(&msm_obj->lock);
 465	return ret;
 466}
 467
 468/*
 469 * Get an iova but don't pin it. Doesn't need a put because iovas are currently
 470 * valid for the life of the object
 471 */
 472int msm_gem_get_iova(struct drm_gem_object *obj,
 473		struct msm_gem_address_space *aspace, uint64_t *iova)
 474{
 475	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 476	int ret;
 477
 478	mutex_lock(&msm_obj->lock);
 479	ret = msm_gem_get_iova_locked(obj, aspace, iova);
 480	mutex_unlock(&msm_obj->lock);
 
 
 
 
 481
 
 
 
 482	return ret;
 483}
 484
 485/* get iova without taking a reference, used in places where you have
 486 * already done a 'msm_gem_get_and_pin_iova' or 'msm_gem_get_iova'
 487 */
 488uint64_t msm_gem_iova(struct drm_gem_object *obj,
 489		struct msm_gem_address_space *aspace)
 490{
 491	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 492	struct msm_gem_vma *vma;
 493
 494	mutex_lock(&msm_obj->lock);
 495	vma = lookup_vma(obj, aspace);
 496	mutex_unlock(&msm_obj->lock);
 497	WARN_ON(!vma);
 498
 499	return vma ? vma->iova : 0;
 500}
 501
 502/*
 503 * Unpin a iova by updating the reference counts. The memory isn't actually
 504 * purged until something else (shrinker, mm_notifier, destroy, etc) decides
 505 * to get rid of it
 506 */
 507void msm_gem_unpin_iova(struct drm_gem_object *obj,
 508		struct msm_gem_address_space *aspace)
 509{
 510	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 511	struct msm_gem_vma *vma;
 512
 513	mutex_lock(&msm_obj->lock);
 514	vma = lookup_vma(obj, aspace);
 515
 516	if (!WARN_ON(!vma))
 517		msm_gem_unmap_vma(aspace, vma);
 518
 519	mutex_unlock(&msm_obj->lock);
 520}
 521
 522int msm_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
 523		struct drm_mode_create_dumb *args)
 524{
 525	args->pitch = align_pitch(args->width, args->bpp);
 526	args->size  = PAGE_ALIGN(args->pitch * args->height);
 527	return msm_gem_new_handle(dev, file, args->size,
 528			MSM_BO_SCANOUT | MSM_BO_WC, &args->handle, "dumb");
 529}
 530
 531int msm_gem_dumb_map_offset(struct drm_file *file, struct drm_device *dev,
 532		uint32_t handle, uint64_t *offset)
 533{
 534	struct drm_gem_object *obj;
 535	int ret = 0;
 536
 537	/* GEM does all our handle to object mapping */
 538	obj = drm_gem_object_lookup(file, handle);
 539	if (obj == NULL) {
 540		ret = -ENOENT;
 541		goto fail;
 542	}
 543
 544	*offset = msm_gem_mmap_offset(obj);
 545
 546	drm_gem_object_put_unlocked(obj);
 547
 548fail:
 549	return ret;
 550}
 551
 552static void *get_vaddr(struct drm_gem_object *obj, unsigned madv)
 553{
 554	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 555	int ret = 0;
 556
 557	mutex_lock(&msm_obj->lock);
 558
 559	if (WARN_ON(msm_obj->madv > madv)) {
 560		DRM_DEV_ERROR(obj->dev->dev, "Invalid madv state: %u vs %u\n",
 561			msm_obj->madv, madv);
 562		mutex_unlock(&msm_obj->lock);
 563		return ERR_PTR(-EBUSY);
 564	}
 565
 566	/* increment vmap_count *before* vmap() call, so shrinker can
 567	 * check vmap_count (is_vunmapable()) outside of msm_obj->lock.
 568	 * This guarantees that we won't try to msm_gem_vunmap() this
 569	 * same object from within the vmap() call (while we already
 570	 * hold msm_obj->lock)
 571	 */
 572	msm_obj->vmap_count++;
 573
 574	if (!msm_obj->vaddr) {
 575		struct page **pages = get_pages(obj);
 576		if (IS_ERR(pages)) {
 577			ret = PTR_ERR(pages);
 578			goto fail;
 579		}
 580		msm_obj->vaddr = vmap(pages, obj->size >> PAGE_SHIFT,
 581				VM_MAP, pgprot_writecombine(PAGE_KERNEL));
 582		if (msm_obj->vaddr == NULL) {
 583			ret = -ENOMEM;
 584			goto fail;
 585		}
 586	}
 587
 588	mutex_unlock(&msm_obj->lock);
 589	return msm_obj->vaddr;
 590
 591fail:
 592	msm_obj->vmap_count--;
 593	mutex_unlock(&msm_obj->lock);
 594	return ERR_PTR(ret);
 595}
 596
 597void *msm_gem_get_vaddr(struct drm_gem_object *obj)
 598{
 599	return get_vaddr(obj, MSM_MADV_WILLNEED);
 
 
 
 
 600}
 601
 602/*
 603 * Don't use this!  It is for the very special case of dumping
 604 * submits from GPU hangs or faults, were the bo may already
 605 * be MSM_MADV_DONTNEED, but we know the buffer is still on the
 606 * active list.
 607 */
 608void *msm_gem_get_vaddr_active(struct drm_gem_object *obj)
 609{
 610	return get_vaddr(obj, __MSM_MADV_PURGED);
 611}
 612
 613void msm_gem_put_vaddr(struct drm_gem_object *obj)
 614{
 615	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 616
 617	mutex_lock(&msm_obj->lock);
 618	WARN_ON(msm_obj->vmap_count < 1);
 619	msm_obj->vmap_count--;
 620	mutex_unlock(&msm_obj->lock);
 621}
 622
 623/* Update madvise status, returns true if not purged, else
 624 * false or -errno.
 625 */
 626int msm_gem_madvise(struct drm_gem_object *obj, unsigned madv)
 627{
 628	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 629
 630	mutex_lock(&msm_obj->lock);
 631
 632	WARN_ON(!mutex_is_locked(&obj->dev->struct_mutex));
 633
 634	if (msm_obj->madv != __MSM_MADV_PURGED)
 635		msm_obj->madv = madv;
 636
 637	madv = msm_obj->madv;
 638
 639	mutex_unlock(&msm_obj->lock);
 640
 641	return (madv != __MSM_MADV_PURGED);
 642}
 643
 644void msm_gem_purge(struct drm_gem_object *obj, enum msm_gem_lock subclass)
 645{
 646	struct drm_device *dev = obj->dev;
 647	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 648
 649	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
 650	WARN_ON(!is_purgeable(msm_obj));
 651	WARN_ON(obj->import_attach);
 652
 653	mutex_lock_nested(&msm_obj->lock, subclass);
 654
 655	put_iova(obj);
 656
 657	msm_gem_vunmap_locked(obj);
 658
 659	put_pages(obj);
 660
 661	msm_obj->madv = __MSM_MADV_PURGED;
 662
 663	drm_vma_node_unmap(&obj->vma_node, dev->anon_inode->i_mapping);
 664	drm_gem_free_mmap_offset(obj);
 665
 666	/* Our goal here is to return as much of the memory as
 667	 * is possible back to the system as we are called from OOM.
 668	 * To do this we must instruct the shmfs to drop all of its
 669	 * backing pages, *now*.
 670	 */
 671	shmem_truncate_range(file_inode(obj->filp), 0, (loff_t)-1);
 672
 673	invalidate_mapping_pages(file_inode(obj->filp)->i_mapping,
 674			0, (loff_t)-1);
 675
 676	mutex_unlock(&msm_obj->lock);
 677}
 678
 679static void msm_gem_vunmap_locked(struct drm_gem_object *obj)
 680{
 681	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 682
 683	WARN_ON(!mutex_is_locked(&msm_obj->lock));
 684
 685	if (!msm_obj->vaddr || WARN_ON(!is_vunmapable(msm_obj)))
 686		return;
 687
 688	vunmap(msm_obj->vaddr);
 689	msm_obj->vaddr = NULL;
 690}
 691
 692void msm_gem_vunmap(struct drm_gem_object *obj, enum msm_gem_lock subclass)
 693{
 694	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 695
 696	mutex_lock_nested(&msm_obj->lock, subclass);
 697	msm_gem_vunmap_locked(obj);
 698	mutex_unlock(&msm_obj->lock);
 699}
 700
 701/* must be called before _move_to_active().. */
 702int msm_gem_sync_object(struct drm_gem_object *obj,
 703		struct msm_fence_context *fctx, bool exclusive)
 704{
 705	struct dma_resv_list *fobj;
 706	struct dma_fence *fence;
 707	int i, ret;
 708
 709	fobj = dma_resv_get_list(obj->resv);
 710	if (!fobj || (fobj->shared_count == 0)) {
 711		fence = dma_resv_get_excl(obj->resv);
 712		/* don't need to wait on our own fences, since ring is fifo */
 713		if (fence && (fence->context != fctx->context)) {
 714			ret = dma_fence_wait(fence, true);
 715			if (ret)
 716				return ret;
 717		}
 718	}
 719
 720	if (!exclusive || !fobj)
 721		return 0;
 722
 723	for (i = 0; i < fobj->shared_count; i++) {
 724		fence = rcu_dereference_protected(fobj->shared[i],
 725						dma_resv_held(obj->resv));
 726		if (fence->context != fctx->context) {
 727			ret = dma_fence_wait(fence, true);
 728			if (ret)
 729				return ret;
 730		}
 731	}
 732
 733	return 0;
 734}
 735
 736void msm_gem_move_to_active(struct drm_gem_object *obj,
 737		struct msm_gpu *gpu, bool exclusive, struct dma_fence *fence)
 738{
 739	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 740	WARN_ON(msm_obj->madv != MSM_MADV_WILLNEED);
 741	msm_obj->gpu = gpu;
 742	if (exclusive)
 743		dma_resv_add_excl_fence(obj->resv, fence);
 744	else
 745		dma_resv_add_shared_fence(obj->resv, fence);
 746	list_del_init(&msm_obj->mm_list);
 747	list_add_tail(&msm_obj->mm_list, &gpu->active_list);
 748}
 749
 750void msm_gem_move_to_inactive(struct drm_gem_object *obj)
 751{
 752	struct drm_device *dev = obj->dev;
 753	struct msm_drm_private *priv = dev->dev_private;
 754	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 755
 756	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
 757
 758	msm_obj->gpu = NULL;
 
 
 759	list_del_init(&msm_obj->mm_list);
 760	list_add_tail(&msm_obj->mm_list, &priv->inactive_list);
 761}
 762
 763int msm_gem_cpu_prep(struct drm_gem_object *obj, uint32_t op, ktime_t *timeout)
 764{
 765	bool write = !!(op & MSM_PREP_WRITE);
 766	unsigned long remain =
 767		op & MSM_PREP_NOSYNC ? 0 : timeout_to_jiffies(timeout);
 768	long ret;
 769
 770	ret = dma_resv_wait_timeout_rcu(obj->resv, write,
 771						  true,  remain);
 772	if (ret == 0)
 773		return remain == 0 ? -EBUSY : -ETIMEDOUT;
 774	else if (ret < 0)
 775		return ret;
 
 776
 777	/* TODO cache maintenance */
 778
 779	return 0;
 780}
 781
 782int msm_gem_cpu_fini(struct drm_gem_object *obj)
 783{
 784	/* TODO cache maintenance */
 785	return 0;
 786}
 787
 788#ifdef CONFIG_DEBUG_FS
 789static void describe_fence(struct dma_fence *fence, const char *type,
 790		struct seq_file *m)
 791{
 792	if (!dma_fence_is_signaled(fence))
 793		seq_printf(m, "\t%9s: %s %s seq %llu\n", type,
 794				fence->ops->get_driver_name(fence),
 795				fence->ops->get_timeline_name(fence),
 796				fence->seqno);
 797}
 798
 799void msm_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
 800{
 
 801	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 802	struct dma_resv *robj = obj->resv;
 803	struct dma_resv_list *fobj;
 804	struct dma_fence *fence;
 805	struct msm_gem_vma *vma;
 806	uint64_t off = drm_vma_node_start(&obj->vma_node);
 807	const char *madv;
 808
 809	mutex_lock(&msm_obj->lock);
 810
 811	switch (msm_obj->madv) {
 812	case __MSM_MADV_PURGED:
 813		madv = " purged";
 814		break;
 815	case MSM_MADV_DONTNEED:
 816		madv = " purgeable";
 817		break;
 818	case MSM_MADV_WILLNEED:
 819	default:
 820		madv = "";
 821		break;
 822	}
 823
 824	seq_printf(m, "%08x: %c %2d (%2d) %08llx %p",
 825			msm_obj->flags, is_active(msm_obj) ? 'A' : 'I',
 826			obj->name, kref_read(&obj->refcount),
 827			off, msm_obj->vaddr);
 828
 829	seq_printf(m, " %08zu %9s %-32s\n", obj->size, madv, msm_obj->name);
 830
 831	if (!list_empty(&msm_obj->vmas)) {
 832
 833		seq_puts(m, "      vmas:");
 834
 835		list_for_each_entry(vma, &msm_obj->vmas, list)
 836			seq_printf(m, " [%s: %08llx,%s,inuse=%d]",
 837				vma->aspace != NULL ? vma->aspace->name : NULL,
 838				vma->iova, vma->mapped ? "mapped" : "unmapped",
 839				vma->inuse);
 840
 841		seq_puts(m, "\n");
 842	}
 843
 844	rcu_read_lock();
 845	fobj = rcu_dereference(robj->fence);
 846	if (fobj) {
 847		unsigned int i, shared_count = fobj->shared_count;
 848
 849		for (i = 0; i < shared_count; i++) {
 850			fence = rcu_dereference(fobj->shared[i]);
 851			describe_fence(fence, "Shared", m);
 852		}
 853	}
 854
 855	fence = rcu_dereference(robj->fence_excl);
 856	if (fence)
 857		describe_fence(fence, "Exclusive", m);
 858	rcu_read_unlock();
 859
 860	mutex_unlock(&msm_obj->lock);
 861}
 862
 863void msm_gem_describe_objects(struct list_head *list, struct seq_file *m)
 864{
 865	struct msm_gem_object *msm_obj;
 866	int count = 0;
 867	size_t size = 0;
 868
 869	seq_puts(m, "   flags       id ref  offset   kaddr            size     madv      name\n");
 870	list_for_each_entry(msm_obj, list, mm_list) {
 871		struct drm_gem_object *obj = &msm_obj->base;
 872		seq_puts(m, "   ");
 873		msm_gem_describe(obj, m);
 874		count++;
 875		size += obj->size;
 876	}
 877
 878	seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
 879}
 880#endif
 881
 882/* don't call directly!  Use drm_gem_object_put() and friends */
 883void msm_gem_free_object(struct drm_gem_object *obj)
 884{
 
 
 885	struct msm_gem_object *msm_obj = to_msm_bo(obj);
 886	struct drm_device *dev = obj->dev;
 887	struct msm_drm_private *priv = dev->dev_private;
 888
 889	if (llist_add(&msm_obj->freed, &priv->free_list))
 890		queue_work(priv->wq, &priv->free_work);
 891}
 892
 893static void free_object(struct msm_gem_object *msm_obj)
 894{
 895	struct drm_gem_object *obj = &msm_obj->base;
 896	struct drm_device *dev = obj->dev;
 897
 898	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
 899
 900	/* object should not be on active list: */
 901	WARN_ON(is_active(msm_obj));
 902
 903	list_del(&msm_obj->mm_list);
 904
 905	mutex_lock(&msm_obj->lock);
 906
 907	put_iova(obj);
 
 
 
 
 908
 909	if (obj->import_attach) {
 910		if (msm_obj->vaddr)
 911			dma_buf_vunmap(obj->import_attach->dmabuf, msm_obj->vaddr);
 912
 913		/* Don't drop the pages for imported dmabuf, as they are not
 914		 * ours, just free the array we allocated:
 915		 */
 916		if (msm_obj->pages)
 917			kvfree(msm_obj->pages);
 918
 919		drm_prime_gem_destroy(obj, msm_obj->sgt);
 920	} else {
 921		msm_gem_vunmap_locked(obj);
 922		put_pages(obj);
 923	}
 924
 
 
 
 925	drm_gem_object_release(obj);
 926
 927	mutex_unlock(&msm_obj->lock);
 928	kfree(msm_obj);
 929}
 930
 931void msm_gem_free_work(struct work_struct *work)
 932{
 933	struct msm_drm_private *priv =
 934		container_of(work, struct msm_drm_private, free_work);
 935	struct drm_device *dev = priv->dev;
 936	struct llist_node *freed;
 937	struct msm_gem_object *msm_obj, *next;
 938
 939	while ((freed = llist_del_all(&priv->free_list))) {
 940
 941		mutex_lock(&dev->struct_mutex);
 942
 943		llist_for_each_entry_safe(msm_obj, next,
 944					  freed, freed)
 945			free_object(msm_obj);
 946
 947		mutex_unlock(&dev->struct_mutex);
 948
 949		if (need_resched())
 950			break;
 951	}
 952}
 953
 954/* convenience method to construct a GEM buffer object, and userspace handle */
 955int msm_gem_new_handle(struct drm_device *dev, struct drm_file *file,
 956		uint32_t size, uint32_t flags, uint32_t *handle,
 957		char *name)
 958{
 959	struct drm_gem_object *obj;
 960	int ret;
 961
 
 
 
 
 962	obj = msm_gem_new(dev, size, flags);
 963
 
 
 964	if (IS_ERR(obj))
 965		return PTR_ERR(obj);
 966
 967	if (name)
 968		msm_gem_object_set_name(obj, "%s", name);
 969
 970	ret = drm_gem_handle_create(file, obj, handle);
 971
 972	/* drop reference from allocate - handle holds it now */
 973	drm_gem_object_put_unlocked(obj);
 974
 975	return ret;
 976}
 977
 978static int msm_gem_new_impl(struct drm_device *dev,
 979		uint32_t size, uint32_t flags,
 980		struct drm_gem_object **obj,
 981		bool struct_mutex_locked)
 982{
 983	struct msm_drm_private *priv = dev->dev_private;
 984	struct msm_gem_object *msm_obj;
 
 
 985
 986	switch (flags & MSM_BO_CACHE_MASK) {
 987	case MSM_BO_UNCACHED:
 988	case MSM_BO_CACHED:
 989	case MSM_BO_WC:
 990		break;
 991	default:
 992		DRM_DEV_ERROR(dev->dev, "invalid cache flag: %x\n",
 993				(flags & MSM_BO_CACHE_MASK));
 994		return -EINVAL;
 995	}
 996
 997	msm_obj = kzalloc(sizeof(*msm_obj), GFP_KERNEL);
 
 
 
 
 
 
 
 
 
 
 
 
 998	if (!msm_obj)
 999		return -ENOMEM;
1000
1001	mutex_init(&msm_obj->lock);
 
1002
1003	msm_obj->flags = flags;
1004	msm_obj->madv = MSM_MADV_WILLNEED;
 
 
1005
1006	INIT_LIST_HEAD(&msm_obj->submit_entry);
1007	INIT_LIST_HEAD(&msm_obj->vmas);
1008
1009	if (struct_mutex_locked) {
1010		WARN_ON(!mutex_is_locked(&dev->struct_mutex));
1011		list_add_tail(&msm_obj->mm_list, &priv->inactive_list);
1012	} else {
1013		mutex_lock(&dev->struct_mutex);
1014		list_add_tail(&msm_obj->mm_list, &priv->inactive_list);
1015		mutex_unlock(&dev->struct_mutex);
1016	}
1017
1018	*obj = &msm_obj->base;
1019
1020	return 0;
1021}
1022
1023static struct drm_gem_object *_msm_gem_new(struct drm_device *dev,
1024		uint32_t size, uint32_t flags, bool struct_mutex_locked)
1025{
1026	struct msm_drm_private *priv = dev->dev_private;
1027	struct drm_gem_object *obj = NULL;
1028	bool use_vram = false;
1029	int ret;
1030
 
 
1031	size = PAGE_ALIGN(size);
1032
1033	if (!msm_use_mmu(dev))
1034		use_vram = true;
1035	else if ((flags & (MSM_BO_STOLEN | MSM_BO_SCANOUT)) && priv->vram.size)
1036		use_vram = true;
1037
1038	if (WARN_ON(use_vram && !priv->vram.size))
1039		return ERR_PTR(-EINVAL);
1040
1041	/* Disallow zero sized objects as they make the underlying
1042	 * infrastructure grumpy
1043	 */
1044	if (size == 0)
1045		return ERR_PTR(-EINVAL);
1046
1047	ret = msm_gem_new_impl(dev, size, flags, &obj, struct_mutex_locked);
1048	if (ret)
1049		goto fail;
1050
1051	if (use_vram) {
1052		struct msm_gem_vma *vma;
1053		struct page **pages;
1054		struct msm_gem_object *msm_obj = to_msm_bo(obj);
1055
1056		mutex_lock(&msm_obj->lock);
1057
1058		vma = add_vma(obj, NULL);
1059		mutex_unlock(&msm_obj->lock);
1060		if (IS_ERR(vma)) {
1061			ret = PTR_ERR(vma);
1062			goto fail;
1063		}
1064
1065		to_msm_bo(obj)->vram_node = &vma->node;
1066
1067		drm_gem_private_object_init(dev, obj, size);
1068
1069		pages = get_pages(obj);
1070		if (IS_ERR(pages)) {
1071			ret = PTR_ERR(pages);
1072			goto fail;
1073		}
1074
1075		vma->iova = physaddr(obj);
1076	} else {
1077		ret = drm_gem_object_init(dev, obj, size);
1078		if (ret)
1079			goto fail;
1080		/*
1081		 * Our buffers are kept pinned, so allocating them from the
1082		 * MOVABLE zone is a really bad idea, and conflicts with CMA.
1083		 * See comments above new_inode() why this is required _and_
1084		 * expected if you're going to pin these pages.
1085		 */
1086		mapping_set_gfp_mask(obj->filp->f_mapping, GFP_HIGHUSER);
1087	}
1088
1089	return obj;
1090
1091fail:
1092	drm_gem_object_put_unlocked(obj);
 
 
1093	return ERR_PTR(ret);
1094}
1095
1096struct drm_gem_object *msm_gem_new_locked(struct drm_device *dev,
1097		uint32_t size, uint32_t flags)
1098{
1099	return _msm_gem_new(dev, size, flags, true);
1100}
1101
1102struct drm_gem_object *msm_gem_new(struct drm_device *dev,
1103		uint32_t size, uint32_t flags)
1104{
1105	return _msm_gem_new(dev, size, flags, false);
1106}
1107
1108struct drm_gem_object *msm_gem_import(struct drm_device *dev,
1109		struct dma_buf *dmabuf, struct sg_table *sgt)
1110{
1111	struct msm_gem_object *msm_obj;
1112	struct drm_gem_object *obj;
1113	uint32_t size;
1114	int ret, npages;
1115
1116	/* if we don't have IOMMU, don't bother pretending we can import: */
1117	if (!msm_use_mmu(dev)) {
1118		DRM_DEV_ERROR(dev->dev, "cannot import without IOMMU\n");
1119		return ERR_PTR(-EINVAL);
1120	}
1121
1122	size = PAGE_ALIGN(dmabuf->size);
1123
1124	ret = msm_gem_new_impl(dev, size, MSM_BO_WC, &obj, false);
1125	if (ret)
1126		goto fail;
1127
1128	drm_gem_private_object_init(dev, obj, size);
1129
1130	npages = size / PAGE_SIZE;
1131
1132	msm_obj = to_msm_bo(obj);
1133	mutex_lock(&msm_obj->lock);
1134	msm_obj->sgt = sgt;
1135	msm_obj->pages = kvmalloc_array(npages, sizeof(struct page *), GFP_KERNEL);
1136	if (!msm_obj->pages) {
1137		mutex_unlock(&msm_obj->lock);
1138		ret = -ENOMEM;
1139		goto fail;
1140	}
1141
1142	ret = drm_prime_sg_to_page_addr_arrays(sgt, msm_obj->pages, NULL, npages);
1143	if (ret) {
1144		mutex_unlock(&msm_obj->lock);
1145		goto fail;
1146	}
1147
1148	mutex_unlock(&msm_obj->lock);
1149	return obj;
1150
1151fail:
1152	drm_gem_object_put_unlocked(obj);
1153	return ERR_PTR(ret);
1154}
1155
1156static void *_msm_gem_kernel_new(struct drm_device *dev, uint32_t size,
1157		uint32_t flags, struct msm_gem_address_space *aspace,
1158		struct drm_gem_object **bo, uint64_t *iova, bool locked)
1159{
1160	void *vaddr;
1161	struct drm_gem_object *obj = _msm_gem_new(dev, size, flags, locked);
1162	int ret;
1163
1164	if (IS_ERR(obj))
1165		return ERR_CAST(obj);
1166
1167	if (iova) {
1168		ret = msm_gem_get_and_pin_iova(obj, aspace, iova);
1169		if (ret)
1170			goto err;
1171	}
1172
1173	vaddr = msm_gem_get_vaddr(obj);
1174	if (IS_ERR(vaddr)) {
1175		msm_gem_unpin_iova(obj, aspace);
1176		ret = PTR_ERR(vaddr);
1177		goto err;
1178	}
1179
1180	if (bo)
1181		*bo = obj;
1182
1183	return vaddr;
1184err:
1185	if (locked)
1186		drm_gem_object_put(obj);
1187	else
1188		drm_gem_object_put_unlocked(obj);
1189
1190	return ERR_PTR(ret);
1191
1192}
1193
1194void *msm_gem_kernel_new(struct drm_device *dev, uint32_t size,
1195		uint32_t flags, struct msm_gem_address_space *aspace,
1196		struct drm_gem_object **bo, uint64_t *iova)
1197{
1198	return _msm_gem_kernel_new(dev, size, flags, aspace, bo, iova, false);
1199}
1200
1201void *msm_gem_kernel_new_locked(struct drm_device *dev, uint32_t size,
1202		uint32_t flags, struct msm_gem_address_space *aspace,
1203		struct drm_gem_object **bo, uint64_t *iova)
1204{
1205	return _msm_gem_kernel_new(dev, size, flags, aspace, bo, iova, true);
1206}
1207
1208void msm_gem_kernel_put(struct drm_gem_object *bo,
1209		struct msm_gem_address_space *aspace, bool locked)
1210{
1211	if (IS_ERR_OR_NULL(bo))
1212		return;
1213
1214	msm_gem_put_vaddr(bo);
1215	msm_gem_unpin_iova(bo, aspace);
1216
1217	if (locked)
1218		drm_gem_object_put(bo);
1219	else
1220		drm_gem_object_put_unlocked(bo);
1221}
1222
1223void msm_gem_object_set_name(struct drm_gem_object *bo, const char *fmt, ...)
1224{
1225	struct msm_gem_object *msm_obj = to_msm_bo(bo);
1226	va_list ap;
1227
1228	if (!fmt)
1229		return;
1230
1231	va_start(ap, fmt);
1232	vsnprintf(msm_obj->name, sizeof(msm_obj->name), fmt, ap);
1233	va_end(ap);
1234}