Linux Audio

Check our new training course

Loading...
v4.6
 
   1/*
   2 * drivers/gpu/drm/omapdrm/omap_gem.c
   3 *
   4 * Copyright (C) 2011 Texas Instruments
   5 * Author: Rob Clark <rob.clark@linaro.org>
   6 *
   7 * This program is free software; you can redistribute it and/or modify it
   8 * under the terms of the GNU General Public License version 2 as published by
   9 * the Free Software Foundation.
  10 *
  11 * This program is distributed in the hope that it will be useful, but WITHOUT
  12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  14 * more details.
  15 *
  16 * You should have received a copy of the GNU General Public License along with
  17 * this program.  If not, see <http://www.gnu.org/licenses/>.
  18 */
  19
 
 
  20#include <linux/shmem_fs.h>
  21#include <linux/spinlock.h>
  22#include <linux/pfn_t.h>
 
  23
 
  24#include <drm/drm_vma_manager.h>
  25
  26#include "omap_drv.h"
  27#include "omap_dmm_tiler.h"
  28
  29/*
  30 * GEM buffer object implementation.
  31 */
  32
  33/* note: we use upper 8 bits of flags for driver-internal flags: */
  34#define OMAP_BO_MEM_DMA_API	0x01000000	/* memory allocated with the dma_alloc_* API */
  35#define OMAP_BO_MEM_SHMEM	0x02000000	/* memory allocated through shmem backing */
  36#define OMAP_BO_MEM_DMABUF	0x08000000	/* memory imported from a dmabuf */
  37
  38struct omap_gem_object {
  39	struct drm_gem_object base;
  40
  41	struct list_head mm_list;
  42
  43	uint32_t flags;
  44
  45	/** width/height for tiled formats (rounded up to slot boundaries) */
  46	uint16_t width, height;
  47
  48	/** roll applied when mapping to DMM */
  49	uint32_t roll;
 
 
 
  50
  51	/**
  52	 * paddr contains the buffer DMA address. It is valid for
  53	 *
  54	 * - buffers allocated through the DMA mapping API (with the
  55	 *   OMAP_BO_MEM_DMA_API flag set)
  56	 *
  57	 * - buffers imported from dmabuf (with the OMAP_BO_MEM_DMABUF flag set)
  58	 *   if they are physically contiguous (when sgt->orig_nents == 1)
  59	 *
  60	 * - buffers mapped through the TILER when paddr_cnt is not zero, in
  61	 *   which case the DMA address points to the TILER aperture
  62	 *
  63	 * Physically contiguous buffers have their DMA address equal to the
  64	 * physical address as we don't remap those buffers through the TILER.
  65	 *
  66	 * Buffers mapped to the TILER have their DMA address pointing to the
  67	 * TILER aperture. As TILER mappings are refcounted (through paddr_cnt)
  68	 * the DMA address must be accessed through omap_get_get_paddr() to
  69	 * ensure that the mapping won't disappear unexpectedly. References must
  70	 * be released with omap_gem_put_paddr().
  71	 */
  72	dma_addr_t paddr;
  73
  74	/**
  75	 * # of users of paddr
  76	 */
  77	uint32_t paddr_cnt;
  78
  79	/**
  80	 * If the buffer has been imported from a dmabuf the OMAP_DB_DMABUF flag
  81	 * is set and the sgt field is valid.
  82	 */
  83	struct sg_table *sgt;
  84
  85	/**
  86	 * tiler block used when buffer is remapped in DMM/TILER.
  87	 */
  88	struct tiler_block *block;
  89
  90	/**
  91	 * Array of backing pages, if allocated.  Note that pages are never
  92	 * allocated for buffers originally allocated from contiguous memory
  93	 */
  94	struct page **pages;
  95
  96	/** addresses corresponding to pages in above array */
  97	dma_addr_t *addrs;
  98
  99	/**
 100	 * Virtual address, if mapped.
 101	 */
 102	void *vaddr;
 103
 104	/**
 105	 * sync-object allocated on demand (if needed)
 106	 *
 107	 * Per-buffer sync-object for tracking pending and completed hw/dma
 108	 * read and write operations.
 109	 */
 110	struct {
 111		uint32_t write_pending;
 112		uint32_t write_complete;
 113		uint32_t read_pending;
 114		uint32_t read_complete;
 115	} *sync;
 116};
 117
 118#define to_omap_bo(x) container_of(x, struct omap_gem_object, base)
 119
 120/* To deal with userspace mmap'ings of 2d tiled buffers, which (a) are
 121 * not necessarily pinned in TILER all the time, and (b) when they are
 122 * they are not necessarily page aligned, we reserve one or more small
 123 * regions in each of the 2d containers to use as a user-GART where we
 124 * can create a second page-aligned mapping of parts of the buffer
 125 * being accessed from userspace.
 126 *
 127 * Note that we could optimize slightly when we know that multiple
 128 * tiler containers are backed by the same PAT.. but I'll leave that
 129 * for later..
 130 */
 131#define NUM_USERGART_ENTRIES 2
 132struct omap_drm_usergart_entry {
 133	struct tiler_block *block;	/* the reserved tiler block */
 134	dma_addr_t paddr;
 135	struct drm_gem_object *obj;	/* the current pinned obj */
 136	pgoff_t obj_pgoff;		/* page offset of obj currently
 137					   mapped in */
 138};
 139
 140struct omap_drm_usergart {
 141	struct omap_drm_usergart_entry entry[NUM_USERGART_ENTRIES];
 142	int height;				/* height in rows */
 143	int height_shift;		/* ilog2(height in rows) */
 144	int slot_shift;			/* ilog2(width per slot) */
 145	int stride_pfn;			/* stride in pages */
 146	int last;				/* index of last used entry */
 147};
 148
 149/* -----------------------------------------------------------------------------
 150 * Helpers
 151 */
 152
 153/** get mmap offset */
 154static uint64_t mmap_offset(struct drm_gem_object *obj)
 155{
 156	struct drm_device *dev = obj->dev;
 157	int ret;
 158	size_t size;
 159
 160	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
 161
 162	/* Make it mmapable */
 163	size = omap_gem_mmap_size(obj);
 164	ret = drm_gem_create_mmap_offset_size(obj, size);
 165	if (ret) {
 166		dev_err(dev->dev, "could not allocate mmap offset\n");
 167		return 0;
 168	}
 169
 170	return drm_vma_node_offset_addr(&obj->vma_node);
 171}
 172
 173static bool is_contiguous(struct omap_gem_object *omap_obj)
 
 
 
 
 
 174{
 175	if (omap_obj->flags & OMAP_BO_MEM_DMA_API)
 176		return true;
 177
 178	if ((omap_obj->flags & OMAP_BO_MEM_DMABUF) && omap_obj->sgt->nents == 1)
 
 179		return true;
 180
 181	return false;
 182}
 183
 184/* -----------------------------------------------------------------------------
 185 * Eviction
 186 */
 187
 188static void evict_entry(struct drm_gem_object *obj,
 189		enum tiler_fmt fmt, struct omap_drm_usergart_entry *entry)
 190{
 191	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 192	struct omap_drm_private *priv = obj->dev->dev_private;
 193	int n = priv->usergart[fmt].height;
 194	size_t size = PAGE_SIZE * n;
 195	loff_t off = mmap_offset(obj) +
 196			(entry->obj_pgoff << PAGE_SHIFT);
 197	const int m = 1 + ((omap_obj->width << fmt) / PAGE_SIZE);
 198
 199	if (m > 1) {
 200		int i;
 201		/* if stride > than PAGE_SIZE then sparse mapping: */
 202		for (i = n; i > 0; i--) {
 203			unmap_mapping_range(obj->dev->anon_inode->i_mapping,
 204					    off, PAGE_SIZE, 1);
 205			off += PAGE_SIZE * m;
 206		}
 207	} else {
 208		unmap_mapping_range(obj->dev->anon_inode->i_mapping,
 209				    off, size, 1);
 210	}
 211
 212	entry->obj = NULL;
 213}
 214
 215/* Evict a buffer from usergart, if it is mapped there */
 216static void evict(struct drm_gem_object *obj)
 217{
 218	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 219	struct omap_drm_private *priv = obj->dev->dev_private;
 220
 221	if (omap_obj->flags & OMAP_BO_TILED) {
 222		enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 223		int i;
 224
 225		for (i = 0; i < NUM_USERGART_ENTRIES; i++) {
 226			struct omap_drm_usergart_entry *entry =
 227				&priv->usergart[fmt].entry[i];
 228
 229			if (entry->obj == obj)
 230				evict_entry(obj, fmt, entry);
 231		}
 232	}
 233}
 234
 235/* -----------------------------------------------------------------------------
 236 * Page Management
 237 */
 238
 239/** ensure backing pages are allocated */
 
 
 
 240static int omap_gem_attach_pages(struct drm_gem_object *obj)
 241{
 242	struct drm_device *dev = obj->dev;
 243	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 244	struct page **pages;
 245	int npages = obj->size >> PAGE_SHIFT;
 246	int i, ret;
 247	dma_addr_t *addrs;
 248
 249	WARN_ON(omap_obj->pages);
 
 
 
 
 
 
 
 250
 251	pages = drm_gem_get_pages(obj);
 252	if (IS_ERR(pages)) {
 253		dev_err(obj->dev->dev, "could not get pages: %ld\n", PTR_ERR(pages));
 254		return PTR_ERR(pages);
 255	}
 256
 257	/* for non-cached buffers, ensure the new pages are clean because
 258	 * DSS, GPU, etc. are not cache coherent:
 259	 */
 260	if (omap_obj->flags & (OMAP_BO_WC|OMAP_BO_UNCACHED)) {
 261		addrs = kmalloc(npages * sizeof(*addrs), GFP_KERNEL);
 262		if (!addrs) {
 263			ret = -ENOMEM;
 264			goto free_pages;
 265		}
 266
 267		for (i = 0; i < npages; i++) {
 268			addrs[i] = dma_map_page(dev->dev, pages[i],
 269					0, PAGE_SIZE, DMA_BIDIRECTIONAL);
 270
 271			if (dma_mapping_error(dev->dev, addrs[i])) {
 272				dev_warn(dev->dev,
 273					"%s: failed to map page\n", __func__);
 274
 275				for (i = i - 1; i >= 0; --i) {
 276					dma_unmap_page(dev->dev, addrs[i],
 277						PAGE_SIZE, DMA_BIDIRECTIONAL);
 278				}
 279
 280				ret = -ENOMEM;
 281				goto free_addrs;
 282			}
 283		}
 284	} else {
 285		addrs = kzalloc(npages * sizeof(*addrs), GFP_KERNEL);
 286		if (!addrs) {
 287			ret = -ENOMEM;
 288			goto free_pages;
 289		}
 290	}
 291
 292	omap_obj->addrs = addrs;
 293	omap_obj->pages = pages;
 294
 295	return 0;
 296
 297free_addrs:
 298	kfree(addrs);
 299free_pages:
 300	drm_gem_put_pages(obj, pages, true, false);
 301
 302	return ret;
 303}
 304
 305/* acquire pages when needed (for example, for DMA where physically
 306 * contiguous buffer is not required
 307 */
 308static int get_pages(struct drm_gem_object *obj, struct page ***pages)
 309{
 310	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 311	int ret = 0;
 312
 313	if ((omap_obj->flags & OMAP_BO_MEM_SHMEM) && !omap_obj->pages) {
 314		ret = omap_gem_attach_pages(obj);
 315		if (ret) {
 316			dev_err(obj->dev->dev, "could not attach pages\n");
 317			return ret;
 318		}
 319	}
 320
 321	/* TODO: even phys-contig.. we should have a list of pages? */
 322	*pages = omap_obj->pages;
 323
 324	return 0;
 325}
 326
 327/** release backing pages */
 328static void omap_gem_detach_pages(struct drm_gem_object *obj)
 329{
 330	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 
 
 331
 332	/* for non-cached buffers, ensure the new pages are clean because
 333	 * DSS, GPU, etc. are not cache coherent:
 334	 */
 335	if (omap_obj->flags & (OMAP_BO_WC|OMAP_BO_UNCACHED)) {
 336		int i, npages = obj->size >> PAGE_SHIFT;
 337		for (i = 0; i < npages; i++) {
 338			dma_unmap_page(obj->dev->dev, omap_obj->addrs[i],
 339					PAGE_SIZE, DMA_BIDIRECTIONAL);
 340		}
 341	}
 342
 343	kfree(omap_obj->addrs);
 344	omap_obj->addrs = NULL;
 345
 346	drm_gem_put_pages(obj, omap_obj->pages, true, false);
 347	omap_obj->pages = NULL;
 348}
 349
 350/* get buffer flags */
 351uint32_t omap_gem_flags(struct drm_gem_object *obj)
 352{
 353	return to_omap_bo(obj)->flags;
 354}
 355
 356uint64_t omap_gem_mmap_offset(struct drm_gem_object *obj)
 357{
 358	uint64_t offset;
 359	mutex_lock(&obj->dev->struct_mutex);
 360	offset = mmap_offset(obj);
 361	mutex_unlock(&obj->dev->struct_mutex);
 362	return offset;
 363}
 364
 365/** get mmap size */
 366size_t omap_gem_mmap_size(struct drm_gem_object *obj)
 367{
 368	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 369	size_t size = obj->size;
 370
 371	if (omap_obj->flags & OMAP_BO_TILED) {
 372		/* for tiled buffers, the virtual size has stride rounded up
 373		 * to 4kb.. (to hide the fact that row n+1 might start 16kb or
 374		 * 32kb later!).  But we don't back the entire buffer with
 375		 * pages, only the valid picture part.. so need to adjust for
 376		 * this in the size used to mmap and generate mmap offset
 377		 */
 378		size = tiler_vsize(gem2fmt(omap_obj->flags),
 379				omap_obj->width, omap_obj->height);
 380	}
 381
 382	return size;
 383}
 384
 385/* get tiled size, returns -EINVAL if not tiled buffer */
 386int omap_gem_tiled_size(struct drm_gem_object *obj, uint16_t *w, uint16_t *h)
 387{
 388	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 389	if (omap_obj->flags & OMAP_BO_TILED) {
 390		*w = omap_obj->width;
 391		*h = omap_obj->height;
 392		return 0;
 393	}
 394	return -EINVAL;
 395}
 396
 397/* -----------------------------------------------------------------------------
 398 * Fault Handling
 399 */
 400
 401/* Normal handling for the case of faulting in non-tiled buffers */
 402static int fault_1d(struct drm_gem_object *obj,
 403		struct vm_area_struct *vma, struct vm_fault *vmf)
 404{
 405	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 406	unsigned long pfn;
 407	pgoff_t pgoff;
 408
 409	/* We don't use vmf->pgoff since that has the fake offset: */
 410	pgoff = ((unsigned long)vmf->virtual_address -
 411			vma->vm_start) >> PAGE_SHIFT;
 412
 413	if (omap_obj->pages) {
 414		omap_gem_cpu_sync(obj, pgoff);
 415		pfn = page_to_pfn(omap_obj->pages[pgoff]);
 416	} else {
 417		BUG_ON(!is_contiguous(omap_obj));
 418		pfn = (omap_obj->paddr >> PAGE_SHIFT) + pgoff;
 419	}
 420
 421	VERB("Inserting %p pfn %lx, pa %lx", vmf->virtual_address,
 422			pfn, pfn << PAGE_SHIFT);
 423
 424	return vm_insert_mixed(vma, (unsigned long)vmf->virtual_address,
 425			__pfn_to_pfn_t(pfn, PFN_DEV));
 426}
 427
 428/* Special handling for the case of faulting in 2d tiled buffers */
 429static int fault_2d(struct drm_gem_object *obj,
 430		struct vm_area_struct *vma, struct vm_fault *vmf)
 431{
 432	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 433	struct omap_drm_private *priv = obj->dev->dev_private;
 434	struct omap_drm_usergart_entry *entry;
 435	enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 436	struct page *pages[64];  /* XXX is this too much to have on stack? */
 437	unsigned long pfn;
 438	pgoff_t pgoff, base_pgoff;
 439	void __user *vaddr;
 440	int i, ret, slots;
 
 441
 442	/*
 443	 * Note the height of the slot is also equal to the number of pages
 444	 * that need to be mapped in to fill 4kb wide CPU page.  If the slot
 445	 * height is 64, then 64 pages fill a 4kb wide by 64 row region.
 446	 */
 447	const int n = priv->usergart[fmt].height;
 448	const int n_shift = priv->usergart[fmt].height_shift;
 449
 450	/*
 451	 * If buffer width in bytes > PAGE_SIZE then the virtual stride is
 452	 * rounded up to next multiple of PAGE_SIZE.. this need to be taken
 453	 * into account in some of the math, so figure out virtual stride
 454	 * in pages
 455	 */
 456	const int m = 1 + ((omap_obj->width << fmt) / PAGE_SIZE);
 457
 458	/* We don't use vmf->pgoff since that has the fake offset: */
 459	pgoff = ((unsigned long)vmf->virtual_address -
 460			vma->vm_start) >> PAGE_SHIFT;
 461
 462	/*
 463	 * Actual address we start mapping at is rounded down to previous slot
 464	 * boundary in the y direction:
 465	 */
 466	base_pgoff = round_down(pgoff, m << n_shift);
 467
 468	/* figure out buffer width in slots */
 469	slots = omap_obj->width >> priv->usergart[fmt].slot_shift;
 470
 471	vaddr = vmf->virtual_address - ((pgoff - base_pgoff) << PAGE_SHIFT);
 472
 473	entry = &priv->usergart[fmt].entry[priv->usergart[fmt].last];
 474
 475	/* evict previous buffer using this usergart entry, if any: */
 476	if (entry->obj)
 477		evict_entry(entry->obj, fmt, entry);
 478
 479	entry->obj = obj;
 480	entry->obj_pgoff = base_pgoff;
 481
 482	/* now convert base_pgoff to phys offset from virt offset: */
 483	base_pgoff = (base_pgoff >> n_shift) * slots;
 484
 485	/* for wider-than 4k.. figure out which part of the slot-row we want: */
 486	if (m > 1) {
 487		int off = pgoff % m;
 488		entry->obj_pgoff += off;
 489		base_pgoff /= m;
 490		slots = min(slots - (off << n_shift), n);
 491		base_pgoff += off << n_shift;
 492		vaddr += off << PAGE_SHIFT;
 493	}
 494
 495	/*
 496	 * Map in pages. Beyond the valid pixel part of the buffer, we set
 497	 * pages[i] to NULL to get a dummy page mapped in.. if someone
 498	 * reads/writes it they will get random/undefined content, but at
 499	 * least it won't be corrupting whatever other random page used to
 500	 * be mapped in, or other undefined behavior.
 501	 */
 502	memcpy(pages, &omap_obj->pages[base_pgoff],
 503			sizeof(struct page *) * slots);
 504	memset(pages + slots, 0,
 505			sizeof(struct page *) * (n - slots));
 506
 507	ret = tiler_pin(entry->block, pages, ARRAY_SIZE(pages), 0, true);
 508	if (ret) {
 509		dev_err(obj->dev->dev, "failed to pin: %d\n", ret);
 
 510		return ret;
 511	}
 512
 513	pfn = entry->paddr >> PAGE_SHIFT;
 514
 515	VERB("Inserting %p pfn %lx, pa %lx", vmf->virtual_address,
 516			pfn, pfn << PAGE_SHIFT);
 517
 518	for (i = n; i > 0; i--) {
 519		vm_insert_mixed(vma, (unsigned long)vaddr,
 520				__pfn_to_pfn_t(pfn, PFN_DEV));
 
 
 521		pfn += priv->usergart[fmt].stride_pfn;
 522		vaddr += PAGE_SIZE * m;
 523	}
 524
 525	/* simple round-robin: */
 526	priv->usergart[fmt].last = (priv->usergart[fmt].last + 1)
 527				 % NUM_USERGART_ENTRIES;
 528
 529	return 0;
 530}
 531
 532/**
 533 * omap_gem_fault		-	pagefault handler for GEM objects
 534 * @vma: the VMA of the GEM object
 535 * @vmf: fault detail
 536 *
 537 * Invoked when a fault occurs on an mmap of a GEM managed area. GEM
 538 * does most of the work for us including the actual map/unmap calls
 539 * but we need to do the actual page work.
 540 *
 541 * The VMA was set up by GEM. In doing so it also ensured that the
 542 * vma->vm_private_data points to the GEM object that is backing this
 543 * mapping.
 544 */
 545int omap_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
 546{
 
 547	struct drm_gem_object *obj = vma->vm_private_data;
 548	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 549	struct drm_device *dev = obj->dev;
 550	struct page **pages;
 551	int ret;
 552
 553	/* Make sure we don't parallel update on a fault, nor move or remove
 554	 * something from beneath our feet
 555	 */
 556	mutex_lock(&dev->struct_mutex);
 557
 558	/* if a shmem backed object, make sure we have pages attached now */
 559	ret = get_pages(obj, &pages);
 560	if (ret)
 
 561		goto fail;
 
 562
 563	/* where should we do corresponding put_pages().. we are mapping
 564	 * the original page, rather than thru a GART, so we can't rely
 565	 * on eviction to trigger this.  But munmap() or all mappings should
 566	 * probably trigger put_pages()?
 567	 */
 568
 569	if (omap_obj->flags & OMAP_BO_TILED)
 570		ret = fault_2d(obj, vma, vmf);
 571	else
 572		ret = fault_1d(obj, vma, vmf);
 573
 574
 575fail:
 576	mutex_unlock(&dev->struct_mutex);
 577	switch (ret) {
 578	case 0:
 579	case -ERESTARTSYS:
 580	case -EINTR:
 581	case -EBUSY:
 582		/*
 583		 * EBUSY is ok: this just means that another thread
 584		 * already did the job.
 585		 */
 586		return VM_FAULT_NOPAGE;
 587	case -ENOMEM:
 588		return VM_FAULT_OOM;
 589	default:
 590		return VM_FAULT_SIGBUS;
 591	}
 592}
 593
 594/** We override mainly to fix up some of the vm mapping flags.. */
 595int omap_gem_mmap(struct file *filp, struct vm_area_struct *vma)
 596{
 597	int ret;
 598
 599	ret = drm_gem_mmap(filp, vma);
 600	if (ret) {
 601		DBG("mmap failed: %d", ret);
 602		return ret;
 603	}
 604
 605	return omap_gem_mmap_obj(vma->vm_private_data, vma);
 606}
 607
 608int omap_gem_mmap_obj(struct drm_gem_object *obj,
 609		struct vm_area_struct *vma)
 610{
 611	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 612
 613	vma->vm_flags &= ~VM_PFNMAP;
 614	vma->vm_flags |= VM_MIXEDMAP;
 615
 616	if (omap_obj->flags & OMAP_BO_WC) {
 617		vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
 618	} else if (omap_obj->flags & OMAP_BO_UNCACHED) {
 619		vma->vm_page_prot = pgprot_noncached(vm_get_page_prot(vma->vm_flags));
 620	} else {
 621		/*
 622		 * We do have some private objects, at least for scanout buffers
 623		 * on hardware without DMM/TILER.  But these are allocated write-
 624		 * combine
 625		 */
 626		if (WARN_ON(!obj->filp))
 627			return -EINVAL;
 628
 629		/*
 630		 * Shunt off cached objs to shmem file so they have their own
 631		 * address_space (so unmap_mapping_range does what we want,
 632		 * in particular in the case of mmap'd dmabufs)
 633		 */
 634		fput(vma->vm_file);
 635		vma->vm_pgoff = 0;
 636		vma->vm_file  = get_file(obj->filp);
 637
 638		vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
 639	}
 640
 
 
 641	return 0;
 642}
 643
 644/* -----------------------------------------------------------------------------
 645 * Dumb Buffers
 646 */
 647
 648/**
 649 * omap_gem_dumb_create	-	create a dumb buffer
 650 * @drm_file: our client file
 651 * @dev: our device
 652 * @args: the requested arguments copied from userspace
 653 *
 654 * Allocate a buffer suitable for use for a frame buffer of the
 655 * form described by user space. Give userspace a handle by which
 656 * to reference it.
 657 */
 658int omap_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
 659		struct drm_mode_create_dumb *args)
 660{
 661	union omap_gem_size gsize;
 662
 663	args->pitch = align_pitch(0, args->width, args->bpp);
 
 664	args->size = PAGE_ALIGN(args->pitch * args->height);
 665
 666	gsize = (union omap_gem_size){
 667		.bytes = args->size,
 668	};
 669
 670	return omap_gem_new_handle(dev, file, gsize,
 671			OMAP_BO_SCANOUT | OMAP_BO_WC, &args->handle);
 672}
 673
 674/**
 675 * omap_gem_dumb_map	-	buffer mapping for dumb interface
 676 * @file: our drm client file
 677 * @dev: drm device
 678 * @handle: GEM handle to the object (from dumb_create)
 
 679 *
 680 * Do the necessary setup to allow the mapping of the frame buffer
 681 * into user memory. We don't have to do much here at the moment.
 682 */
 683int omap_gem_dumb_map_offset(struct drm_file *file, struct drm_device *dev,
 684		uint32_t handle, uint64_t *offset)
 685{
 686	struct drm_gem_object *obj;
 687	int ret = 0;
 688
 689	/* GEM does all our handle to object mapping */
 690	obj = drm_gem_object_lookup(dev, file, handle);
 691	if (obj == NULL) {
 692		ret = -ENOENT;
 693		goto fail;
 694	}
 695
 696	*offset = omap_gem_mmap_offset(obj);
 697
 698	drm_gem_object_unreference_unlocked(obj);
 699
 700fail:
 701	return ret;
 702}
 703
 704#ifdef CONFIG_DRM_FBDEV_EMULATION
 705/* Set scrolling position.  This allows us to implement fast scrolling
 706 * for console.
 707 *
 708 * Call only from non-atomic contexts.
 709 */
 710int omap_gem_roll(struct drm_gem_object *obj, uint32_t roll)
 711{
 712	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 713	uint32_t npages = obj->size >> PAGE_SHIFT;
 714	int ret = 0;
 715
 716	if (roll > npages) {
 717		dev_err(obj->dev->dev, "invalid roll: %d\n", roll);
 718		return -EINVAL;
 719	}
 720
 721	omap_obj->roll = roll;
 722
 723	mutex_lock(&obj->dev->struct_mutex);
 724
 725	/* if we aren't mapped yet, we don't need to do anything */
 726	if (omap_obj->block) {
 727		struct page **pages;
 728		ret = get_pages(obj, &pages);
 729		if (ret)
 730			goto fail;
 731		ret = tiler_pin(omap_obj->block, pages, npages, roll, true);
 
 
 732		if (ret)
 733			dev_err(obj->dev->dev, "could not repin: %d\n", ret);
 734	}
 735
 736fail:
 737	mutex_unlock(&obj->dev->struct_mutex);
 738
 739	return ret;
 740}
 741#endif
 742
 743/* -----------------------------------------------------------------------------
 744 * Memory Management & DMA Sync
 745 */
 746
 747/**
 748 * shmem buffers that are mapped cached can simulate coherency via using
 749 * page faulting to keep track of dirty pages
 
 
 
 
 
 750 */
 751static inline bool is_cached_coherent(struct drm_gem_object *obj)
 752{
 753	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 754
 755	return (omap_obj->flags & OMAP_BO_MEM_SHMEM) &&
 756		((omap_obj->flags & OMAP_BO_CACHE_MASK) == OMAP_BO_CACHED);
 757}
 758
 759/* Sync the buffer for CPU access.. note pages should already be
 760 * attached, ie. omap_gem_get_pages()
 761 */
 762void omap_gem_cpu_sync(struct drm_gem_object *obj, int pgoff)
 763{
 764	struct drm_device *dev = obj->dev;
 765	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 766
 767	if (is_cached_coherent(obj) && omap_obj->addrs[pgoff]) {
 768		dma_unmap_page(dev->dev, omap_obj->addrs[pgoff],
 769				PAGE_SIZE, DMA_BIDIRECTIONAL);
 770		omap_obj->addrs[pgoff] = 0;
 
 
 
 771	}
 772}
 773
 774/* sync the buffer for DMA access */
 775void omap_gem_dma_sync(struct drm_gem_object *obj,
 776		enum dma_data_direction dir)
 777{
 778	struct drm_device *dev = obj->dev;
 779	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 
 
 
 780
 781	if (is_cached_coherent(obj)) {
 782		int i, npages = obj->size >> PAGE_SHIFT;
 783		struct page **pages = omap_obj->pages;
 784		bool dirty = false;
 785
 786		for (i = 0; i < npages; i++) {
 787			if (!omap_obj->addrs[i]) {
 788				dma_addr_t addr;
 
 
 
 
 
 
 
 
 789
 790				addr = dma_map_page(dev->dev, pages[i], 0,
 791						PAGE_SIZE, DMA_BIDIRECTIONAL);
 
 
 792
 793				if (dma_mapping_error(dev->dev, addr)) {
 794					dev_warn(dev->dev,
 795						"%s: failed to map page\n",
 796						__func__);
 797					break;
 798				}
 799
 800				dirty = true;
 801				omap_obj->addrs[i] = addr;
 802			}
 803		}
 
 
 
 804
 805		if (dirty) {
 806			unmap_mapping_range(obj->filp->f_mapping, 0,
 807					omap_gem_mmap_size(obj), 1);
 808		}
 
 
 
 
 
 
 
 
 
 809	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 810}
 811
 812/* Get physical address for DMA.. if 'remap' is true, and the buffer is not
 813 * already contiguous, remap it to pin in physically contiguous memory.. (ie.
 814 * map in TILER)
 
 
 
 
 
 
 
 
 
 
 815 */
 816int omap_gem_get_paddr(struct drm_gem_object *obj,
 817		dma_addr_t *paddr, bool remap)
 818{
 819	struct omap_drm_private *priv = obj->dev->dev_private;
 820	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 821	int ret = 0;
 822
 823	mutex_lock(&obj->dev->struct_mutex);
 824
 825	if (!is_contiguous(omap_obj) && remap && priv->has_dmm) {
 826		if (omap_obj->paddr_cnt == 0) {
 827			struct page **pages;
 828			uint32_t npages = obj->size >> PAGE_SHIFT;
 829			enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 830			struct tiler_block *block;
 831
 832			BUG_ON(omap_obj->block);
 833
 834			ret = get_pages(obj, &pages);
 835			if (ret)
 836				goto fail;
 837
 838			if (omap_obj->flags & OMAP_BO_TILED) {
 839				block = tiler_reserve_2d(fmt,
 840						omap_obj->width,
 841						omap_obj->height, 0);
 842			} else {
 843				block = tiler_reserve_1d(obj->size);
 844			}
 845
 846			if (IS_ERR(block)) {
 847				ret = PTR_ERR(block);
 848				dev_err(obj->dev->dev,
 849					"could not remap: %d (%d)\n", ret, fmt);
 850				goto fail;
 851			}
 852
 853			/* TODO: enable async refill.. */
 854			ret = tiler_pin(block, pages, npages,
 855					omap_obj->roll, true);
 856			if (ret) {
 857				tiler_release(block);
 858				dev_err(obj->dev->dev,
 859						"could not pin: %d\n", ret);
 860				goto fail;
 861			}
 862
 863			omap_obj->paddr = tiler_ssptr(block);
 864			omap_obj->block = block;
 865
 866			DBG("got paddr: %pad", &omap_obj->paddr);
 867		}
 868
 869		omap_obj->paddr_cnt++;
 870
 871		*paddr = omap_obj->paddr;
 872	} else if (is_contiguous(omap_obj)) {
 873		*paddr = omap_obj->paddr;
 874	} else {
 875		ret = -EINVAL;
 876		goto fail;
 877	}
 878
 
 
 
 879fail:
 880	mutex_unlock(&obj->dev->struct_mutex);
 881
 882	return ret;
 883}
 884
 885/* Release physical address, when DMA is no longer being performed.. this
 886 * could potentially unpin and unmap buffers from TILER
 
 
 
 887 */
 888void omap_gem_put_paddr(struct drm_gem_object *obj)
 889{
 
 890	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 891	int ret;
 892
 893	mutex_lock(&obj->dev->struct_mutex);
 894	if (omap_obj->paddr_cnt > 0) {
 895		omap_obj->paddr_cnt--;
 896		if (omap_obj->paddr_cnt == 0) {
 
 
 
 
 
 
 
 
 897			ret = tiler_unpin(omap_obj->block);
 898			if (ret) {
 899				dev_err(obj->dev->dev,
 900					"could not unpin pages: %d\n", ret);
 901			}
 902			ret = tiler_release(omap_obj->block);
 903			if (ret) {
 904				dev_err(obj->dev->dev,
 905					"could not release unmap: %d\n", ret);
 906			}
 907			omap_obj->paddr = 0;
 908			omap_obj->block = NULL;
 909		}
 910	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 911
 912	mutex_unlock(&obj->dev->struct_mutex);
 
 
 913}
 914
 915/* Get rotated scanout address (only valid if already pinned), at the
 916 * specified orientation and x,y offset from top-left corner of buffer
 917 * (only valid for tiled 2d buffers)
 918 */
 919int omap_gem_rotated_paddr(struct drm_gem_object *obj, uint32_t orient,
 920		int x, int y, dma_addr_t *paddr)
 921{
 922	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 923	int ret = -EINVAL;
 924
 925	mutex_lock(&obj->dev->struct_mutex);
 926	if ((omap_obj->paddr_cnt > 0) && omap_obj->block &&
 927			(omap_obj->flags & OMAP_BO_TILED)) {
 928		*paddr = tiler_tsptr(omap_obj->block, orient, x, y);
 
 929		ret = 0;
 930	}
 931	mutex_unlock(&obj->dev->struct_mutex);
 
 
 932	return ret;
 933}
 934
 935/* Get tiler stride for the buffer (only valid for 2d tiled buffers) */
 936int omap_gem_tiled_stride(struct drm_gem_object *obj, uint32_t orient)
 937{
 938	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 939	int ret = -EINVAL;
 940	if (omap_obj->flags & OMAP_BO_TILED)
 941		ret = tiler_stride(gem2fmt(omap_obj->flags), orient);
 942	return ret;
 943}
 944
 945/* if !remap, and we don't have pages backing, then fail, rather than
 946 * increasing the pin count (which we don't really do yet anyways,
 947 * because we don't support swapping pages back out).  And 'remap'
 948 * might not be quite the right name, but I wanted to keep it working
 949 * similarly to omap_gem_get_paddr().  Note though that mutex is not
 950 * aquired if !remap (because this can be called in atomic ctxt),
 951 * but probably omap_gem_get_paddr() should be changed to work in the
 952 * same way.  If !remap, a matching omap_gem_put_pages() call is not
 953 * required (and should not be made).
 954 */
 955int omap_gem_get_pages(struct drm_gem_object *obj, struct page ***pages,
 956		bool remap)
 957{
 958	int ret;
 959	if (!remap) {
 960		struct omap_gem_object *omap_obj = to_omap_bo(obj);
 961		if (!omap_obj->pages)
 962			return -ENOMEM;
 963		*pages = omap_obj->pages;
 964		return 0;
 
 
 965	}
 966	mutex_lock(&obj->dev->struct_mutex);
 967	ret = get_pages(obj, pages);
 968	mutex_unlock(&obj->dev->struct_mutex);
 
 
 
 
 
 
 
 
 969	return ret;
 970}
 971
 972/* release pages when DMA no longer being performed */
 973int omap_gem_put_pages(struct drm_gem_object *obj)
 974{
 975	/* do something here if we dynamically attach/detach pages.. at
 976	 * least they would no longer need to be pinned if everyone has
 977	 * released the pages..
 978	 */
 979	return 0;
 980}
 981
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 982#ifdef CONFIG_DRM_FBDEV_EMULATION
 983/* Get kernel virtual address for CPU access.. this more or less only
 984 * exists for omap_fbdev.  This should be called with struct_mutex
 985 * held.
 986 */
 987void *omap_gem_vaddr(struct drm_gem_object *obj)
 988{
 989	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 990	WARN_ON(!mutex_is_locked(&obj->dev->struct_mutex));
 
 
 
 
 991	if (!omap_obj->vaddr) {
 992		struct page **pages;
 993		int ret = get_pages(obj, &pages);
 994		if (ret)
 995			return ERR_PTR(ret);
 996		omap_obj->vaddr = vmap(pages, obj->size >> PAGE_SHIFT,
 
 
 997				VM_MAP, pgprot_writecombine(PAGE_KERNEL));
 998	}
 999	return omap_obj->vaddr;
 
 
 
 
 
1000}
1001#endif
1002
1003/* -----------------------------------------------------------------------------
1004 * Power Management
1005 */
1006
1007#ifdef CONFIG_PM
1008/* re-pin objects in DMM in resume path: */
1009int omap_gem_resume(struct device *dev)
1010{
1011	struct drm_device *drm_dev = dev_get_drvdata(dev);
1012	struct omap_drm_private *priv = drm_dev->dev_private;
1013	struct omap_gem_object *omap_obj;
1014	int ret = 0;
1015
 
1016	list_for_each_entry(omap_obj, &priv->obj_list, mm_list) {
1017		if (omap_obj->block) {
1018			struct drm_gem_object *obj = &omap_obj->base;
1019			uint32_t npages = obj->size >> PAGE_SHIFT;
 
1020			WARN_ON(!omap_obj->pages);  /* this can't happen */
1021			ret = tiler_pin(omap_obj->block,
1022					omap_obj->pages, npages,
1023					omap_obj->roll, true);
1024			if (ret) {
1025				dev_err(dev, "could not repin: %d\n", ret);
1026				return ret;
1027			}
1028		}
1029	}
1030
1031	return 0;
 
 
1032}
1033#endif
1034
1035/* -----------------------------------------------------------------------------
1036 * DebugFS
1037 */
1038
1039#ifdef CONFIG_DEBUG_FS
1040void omap_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
1041{
1042	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1043	uint64_t off;
1044
1045	off = drm_vma_node_start(&obj->vma_node);
1046
 
 
1047	seq_printf(m, "%08x: %2d (%2d) %08llx %pad (%2d) %p %4d",
1048			omap_obj->flags, obj->name, obj->refcount.refcount.counter,
1049			off, &omap_obj->paddr, omap_obj->paddr_cnt,
 
1050			omap_obj->vaddr, omap_obj->roll);
1051
1052	if (omap_obj->flags & OMAP_BO_TILED) {
1053		seq_printf(m, " %dx%d", omap_obj->width, omap_obj->height);
1054		if (omap_obj->block) {
1055			struct tcm_area *area = &omap_obj->block->area;
1056			seq_printf(m, " (%dx%d, %dx%d)",
1057					area->p0.x, area->p0.y,
1058					area->p1.x, area->p1.y);
1059		}
1060	} else {
1061		seq_printf(m, " %d", obj->size);
1062	}
1063
 
 
1064	seq_printf(m, "\n");
1065}
1066
1067void omap_gem_describe_objects(struct list_head *list, struct seq_file *m)
1068{
1069	struct omap_gem_object *omap_obj;
1070	int count = 0;
1071	size_t size = 0;
1072
1073	list_for_each_entry(omap_obj, list, mm_list) {
1074		struct drm_gem_object *obj = &omap_obj->base;
1075		seq_printf(m, "   ");
1076		omap_gem_describe(obj, m);
1077		count++;
1078		size += obj->size;
1079	}
1080
1081	seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
1082}
1083#endif
1084
1085/* -----------------------------------------------------------------------------
1086 * Buffer Synchronization
1087 */
1088
1089static DEFINE_SPINLOCK(sync_lock);
1090
1091struct omap_gem_sync_waiter {
1092	struct list_head list;
1093	struct omap_gem_object *omap_obj;
1094	enum omap_gem_op op;
1095	uint32_t read_target, write_target;
1096	/* notify called w/ sync_lock held */
1097	void (*notify)(void *arg);
1098	void *arg;
1099};
1100
1101/* list of omap_gem_sync_waiter.. the notify fxn gets called back when
1102 * the read and/or write target count is achieved which can call a user
1103 * callback (ex. to kick 3d and/or 2d), wakeup blocked task (prep for
1104 * cpu access), etc.
1105 */
1106static LIST_HEAD(waiters);
1107
1108static inline bool is_waiting(struct omap_gem_sync_waiter *waiter)
1109{
1110	struct omap_gem_object *omap_obj = waiter->omap_obj;
1111	if ((waiter->op & OMAP_GEM_READ) &&
1112			(omap_obj->sync->write_complete < waiter->write_target))
1113		return true;
1114	if ((waiter->op & OMAP_GEM_WRITE) &&
1115			(omap_obj->sync->read_complete < waiter->read_target))
1116		return true;
1117	return false;
1118}
1119
1120/* macro for sync debug.. */
1121#define SYNCDBG 0
1122#define SYNC(fmt, ...) do { if (SYNCDBG) \
1123		printk(KERN_ERR "%s:%d: "fmt"\n", \
1124				__func__, __LINE__, ##__VA_ARGS__); \
1125	} while (0)
1126
1127
1128static void sync_op_update(void)
1129{
1130	struct omap_gem_sync_waiter *waiter, *n;
1131	list_for_each_entry_safe(waiter, n, &waiters, list) {
1132		if (!is_waiting(waiter)) {
1133			list_del(&waiter->list);
1134			SYNC("notify: %p", waiter);
1135			waiter->notify(waiter->arg);
1136			kfree(waiter);
1137		}
1138	}
1139}
1140
1141static inline int sync_op(struct drm_gem_object *obj,
1142		enum omap_gem_op op, bool start)
1143{
1144	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1145	int ret = 0;
1146
1147	spin_lock(&sync_lock);
1148
1149	if (!omap_obj->sync) {
1150		omap_obj->sync = kzalloc(sizeof(*omap_obj->sync), GFP_ATOMIC);
1151		if (!omap_obj->sync) {
1152			ret = -ENOMEM;
1153			goto unlock;
1154		}
1155	}
1156
1157	if (start) {
1158		if (op & OMAP_GEM_READ)
1159			omap_obj->sync->read_pending++;
1160		if (op & OMAP_GEM_WRITE)
1161			omap_obj->sync->write_pending++;
1162	} else {
1163		if (op & OMAP_GEM_READ)
1164			omap_obj->sync->read_complete++;
1165		if (op & OMAP_GEM_WRITE)
1166			omap_obj->sync->write_complete++;
1167		sync_op_update();
1168	}
1169
1170unlock:
1171	spin_unlock(&sync_lock);
1172
1173	return ret;
1174}
1175
1176/* mark the start of read and/or write operation */
1177int omap_gem_op_start(struct drm_gem_object *obj, enum omap_gem_op op)
1178{
1179	return sync_op(obj, op, true);
1180}
1181
1182int omap_gem_op_finish(struct drm_gem_object *obj, enum omap_gem_op op)
1183{
1184	return sync_op(obj, op, false);
1185}
1186
1187static DECLARE_WAIT_QUEUE_HEAD(sync_event);
1188
1189static void sync_notify(void *arg)
1190{
1191	struct task_struct **waiter_task = arg;
1192	*waiter_task = NULL;
1193	wake_up_all(&sync_event);
1194}
1195
1196int omap_gem_op_sync(struct drm_gem_object *obj, enum omap_gem_op op)
1197{
1198	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1199	int ret = 0;
1200	if (omap_obj->sync) {
1201		struct task_struct *waiter_task = current;
1202		struct omap_gem_sync_waiter *waiter =
1203				kzalloc(sizeof(*waiter), GFP_KERNEL);
1204
1205		if (!waiter)
1206			return -ENOMEM;
1207
1208		waiter->omap_obj = omap_obj;
1209		waiter->op = op;
1210		waiter->read_target = omap_obj->sync->read_pending;
1211		waiter->write_target = omap_obj->sync->write_pending;
1212		waiter->notify = sync_notify;
1213		waiter->arg = &waiter_task;
1214
1215		spin_lock(&sync_lock);
1216		if (is_waiting(waiter)) {
1217			SYNC("waited: %p", waiter);
1218			list_add_tail(&waiter->list, &waiters);
1219			spin_unlock(&sync_lock);
1220			ret = wait_event_interruptible(sync_event,
1221					(waiter_task == NULL));
1222			spin_lock(&sync_lock);
1223			if (waiter_task) {
1224				SYNC("interrupted: %p", waiter);
1225				/* we were interrupted */
1226				list_del(&waiter->list);
1227				waiter_task = NULL;
1228			} else {
1229				/* freed in sync_op_update() */
1230				waiter = NULL;
1231			}
1232		}
1233		spin_unlock(&sync_lock);
1234		kfree(waiter);
1235	}
1236	return ret;
1237}
1238
1239/* call fxn(arg), either synchronously or asynchronously if the op
1240 * is currently blocked..  fxn() can be called from any context
1241 *
1242 * (TODO for now fxn is called back from whichever context calls
1243 * omap_gem_op_finish().. but this could be better defined later
1244 * if needed)
1245 *
1246 * TODO more code in common w/ _sync()..
1247 */
1248int omap_gem_op_async(struct drm_gem_object *obj, enum omap_gem_op op,
1249		void (*fxn)(void *arg), void *arg)
1250{
1251	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1252	if (omap_obj->sync) {
1253		struct omap_gem_sync_waiter *waiter =
1254				kzalloc(sizeof(*waiter), GFP_ATOMIC);
1255
1256		if (!waiter)
1257			return -ENOMEM;
1258
1259		waiter->omap_obj = omap_obj;
1260		waiter->op = op;
1261		waiter->read_target = omap_obj->sync->read_pending;
1262		waiter->write_target = omap_obj->sync->write_pending;
1263		waiter->notify = fxn;
1264		waiter->arg = arg;
1265
1266		spin_lock(&sync_lock);
1267		if (is_waiting(waiter)) {
1268			SYNC("waited: %p", waiter);
1269			list_add_tail(&waiter->list, &waiters);
1270			spin_unlock(&sync_lock);
1271			return 0;
1272		}
1273
1274		spin_unlock(&sync_lock);
1275
1276		kfree(waiter);
1277	}
1278
1279	/* no waiting.. */
1280	fxn(arg);
1281
1282	return 0;
1283}
1284
1285/* -----------------------------------------------------------------------------
1286 * Constructor & Destructor
1287 */
1288
1289void omap_gem_free_object(struct drm_gem_object *obj)
1290{
1291	struct drm_device *dev = obj->dev;
1292	struct omap_drm_private *priv = dev->dev_private;
1293	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1294
1295	evict(obj);
1296
1297	WARN_ON(!mutex_is_locked(&dev->struct_mutex));
1298
1299	spin_lock(&priv->list_lock);
1300	list_del(&omap_obj->mm_list);
1301	spin_unlock(&priv->list_lock);
1302
1303	/* this means the object is still pinned.. which really should
1304	 * not happen.  I think..
 
 
 
1305	 */
1306	WARN_ON(omap_obj->paddr_cnt > 0);
 
 
 
1307
1308	if (omap_obj->pages) {
1309		if (omap_obj->flags & OMAP_BO_MEM_DMABUF)
1310			kfree(omap_obj->pages);
1311		else
1312			omap_gem_detach_pages(obj);
1313	}
1314
1315	if (omap_obj->flags & OMAP_BO_MEM_DMA_API) {
1316		dma_free_wc(dev->dev, obj->size, omap_obj->vaddr,
1317			    omap_obj->paddr);
1318	} else if (omap_obj->vaddr) {
1319		vunmap(omap_obj->vaddr);
1320	} else if (obj->import_attach) {
1321		drm_prime_gem_destroy(obj, omap_obj->sgt);
1322	}
1323
1324	kfree(omap_obj->sync);
1325
1326	drm_gem_object_release(obj);
1327
 
 
1328	kfree(omap_obj);
1329}
1330
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1331/* GEM buffer object constructor */
1332struct drm_gem_object *omap_gem_new(struct drm_device *dev,
1333		union omap_gem_size gsize, uint32_t flags)
1334{
1335	struct omap_drm_private *priv = dev->dev_private;
1336	struct omap_gem_object *omap_obj;
1337	struct drm_gem_object *obj;
1338	struct address_space *mapping;
1339	size_t size;
1340	int ret;
1341
1342	/* Validate the flags and compute the memory and cache flags. */
1343	if (flags & OMAP_BO_TILED) {
1344		if (!priv->usergart) {
1345			dev_err(dev->dev, "Tiled buffers require DMM\n");
1346			return NULL;
1347		}
1348
 
 
1349		/*
1350		 * Tiled buffers are always shmem paged backed. When they are
1351		 * scanned out, they are remapped into DMM/TILER.
1352		 */
1353		flags &= ~OMAP_BO_SCANOUT;
1354		flags |= OMAP_BO_MEM_SHMEM;
1355
1356		/*
1357		 * Currently don't allow cached buffers. There is some caching
1358		 * stuff that needs to be handled better.
1359		 */
1360		flags &= ~(OMAP_BO_CACHED|OMAP_BO_WC|OMAP_BO_UNCACHED);
1361		flags |= tiler_get_cpu_cache_flags();
1362	} else if ((flags & OMAP_BO_SCANOUT) && !priv->has_dmm) {
1363		/*
1364		 * OMAP_BO_SCANOUT hints that the buffer doesn't need to be
1365		 * tiled. However, to lower the pressure on memory allocation,
1366		 * use contiguous memory only if no TILER is available.
1367		 */
1368		flags |= OMAP_BO_MEM_DMA_API;
1369	} else if (!(flags & OMAP_BO_MEM_DMABUF)) {
1370		/*
1371		 * All other buffers not backed by dma_buf are shmem-backed.
1372		 */
1373		flags |= OMAP_BO_MEM_SHMEM;
1374	}
1375
1376	/* Allocate the initialize the OMAP GEM object. */
1377	omap_obj = kzalloc(sizeof(*omap_obj), GFP_KERNEL);
1378	if (!omap_obj)
1379		return NULL;
1380
1381	obj = &omap_obj->base;
1382	omap_obj->flags = flags;
 
1383
1384	if (flags & OMAP_BO_TILED) {
1385		/*
1386		 * For tiled buffers align dimensions to slot boundaries and
1387		 * calculate size based on aligned dimensions.
1388		 */
1389		tiler_align(gem2fmt(flags), &gsize.tiled.width,
1390			    &gsize.tiled.height);
1391
1392		size = tiler_size(gem2fmt(flags), gsize.tiled.width,
1393				  gsize.tiled.height);
1394
1395		omap_obj->width = gsize.tiled.width;
1396		omap_obj->height = gsize.tiled.height;
1397	} else {
1398		size = PAGE_ALIGN(gsize.bytes);
1399	}
1400
 
 
1401	/* Initialize the GEM object. */
1402	if (!(flags & OMAP_BO_MEM_SHMEM)) {
1403		drm_gem_private_object_init(dev, obj, size);
1404	} else {
1405		ret = drm_gem_object_init(dev, obj, size);
1406		if (ret)
1407			goto err_free;
1408
1409		mapping = file_inode(obj->filp)->i_mapping;
1410		mapping_set_gfp_mask(mapping, GFP_USER | __GFP_DMA32);
1411	}
1412
1413	/* Allocate memory if needed. */
1414	if (flags & OMAP_BO_MEM_DMA_API) {
1415		omap_obj->vaddr = dma_alloc_wc(dev->dev, size,
1416					       &omap_obj->paddr,
1417					       GFP_KERNEL);
1418		if (!omap_obj->vaddr)
1419			goto err_release;
1420	}
1421
1422	spin_lock(&priv->list_lock);
1423	list_add(&omap_obj->mm_list, &priv->obj_list);
1424	spin_unlock(&priv->list_lock);
1425
1426	return obj;
1427
1428err_release:
1429	drm_gem_object_release(obj);
1430err_free:
1431	kfree(omap_obj);
1432	return NULL;
1433}
1434
1435struct drm_gem_object *omap_gem_new_dmabuf(struct drm_device *dev, size_t size,
1436					   struct sg_table *sgt)
1437{
1438	struct omap_drm_private *priv = dev->dev_private;
1439	struct omap_gem_object *omap_obj;
1440	struct drm_gem_object *obj;
1441	union omap_gem_size gsize;
1442
1443	/* Without a DMM only physically contiguous buffers can be supported. */
1444	if (sgt->orig_nents != 1 && !priv->has_dmm)
1445		return ERR_PTR(-EINVAL);
1446
1447	mutex_lock(&dev->struct_mutex);
1448
1449	gsize.bytes = PAGE_ALIGN(size);
1450	obj = omap_gem_new(dev, gsize, OMAP_BO_MEM_DMABUF | OMAP_BO_WC);
1451	if (!obj) {
1452		obj = ERR_PTR(-ENOMEM);
1453		goto done;
1454	}
1455
1456	omap_obj = to_omap_bo(obj);
 
1457	omap_obj->sgt = sgt;
1458
1459	if (sgt->orig_nents == 1) {
1460		omap_obj->paddr = sg_dma_address(sgt->sgl);
1461	} else {
1462		/* Create pages list from sgt */
1463		struct sg_page_iter iter;
1464		struct page **pages;
1465		unsigned int npages;
1466		unsigned int i = 0;
1467
1468		npages = DIV_ROUND_UP(size, PAGE_SIZE);
1469		pages = kcalloc(npages, sizeof(*pages), GFP_KERNEL);
1470		if (!pages) {
1471			omap_gem_free_object(obj);
1472			obj = ERR_PTR(-ENOMEM);
1473			goto done;
1474		}
1475
1476		omap_obj->pages = pages;
1477
1478		for_each_sg_page(sgt->sgl, &iter, sgt->orig_nents, 0) {
1479			pages[i++] = sg_page_iter_page(&iter);
1480			if (i > npages)
1481				break;
1482		}
1483
1484		if (WARN_ON(i != npages)) {
1485			omap_gem_free_object(obj);
1486			obj = ERR_PTR(-ENOMEM);
1487			goto done;
1488		}
1489	}
1490
1491done:
1492	mutex_unlock(&dev->struct_mutex);
1493	return obj;
1494}
1495
1496/* convenience method to construct a GEM buffer object, and userspace handle */
1497int omap_gem_new_handle(struct drm_device *dev, struct drm_file *file,
1498		union omap_gem_size gsize, uint32_t flags, uint32_t *handle)
1499{
1500	struct drm_gem_object *obj;
1501	int ret;
1502
1503	obj = omap_gem_new(dev, gsize, flags);
1504	if (!obj)
1505		return -ENOMEM;
1506
1507	ret = drm_gem_handle_create(file, obj, handle);
1508	if (ret) {
1509		omap_gem_free_object(obj);
1510		return ret;
1511	}
1512
1513	/* drop reference from allocate - handle holds it now */
1514	drm_gem_object_unreference_unlocked(obj);
1515
1516	return 0;
1517}
1518
1519/* -----------------------------------------------------------------------------
1520 * Init & Cleanup
1521 */
1522
1523/* If DMM is used, we need to set some stuff up.. */
1524void omap_gem_init(struct drm_device *dev)
1525{
1526	struct omap_drm_private *priv = dev->dev_private;
1527	struct omap_drm_usergart *usergart;
1528	const enum tiler_fmt fmts[] = {
1529			TILFMT_8BIT, TILFMT_16BIT, TILFMT_32BIT
1530	};
1531	int i, j;
1532
1533	if (!dmm_is_available()) {
1534		/* DMM only supported on OMAP4 and later, so this isn't fatal */
1535		dev_warn(dev->dev, "DMM not available, disable DMM support\n");
1536		return;
1537	}
1538
1539	usergart = kcalloc(3, sizeof(*usergart), GFP_KERNEL);
1540	if (!usergart)
1541		return;
1542
1543	/* reserve 4k aligned/wide regions for userspace mappings: */
1544	for (i = 0; i < ARRAY_SIZE(fmts); i++) {
1545		uint16_t h = 1, w = PAGE_SIZE >> i;
 
1546		tiler_align(fmts[i], &w, &h);
1547		/* note: since each region is 1 4kb page wide, and minimum
1548		 * number of rows, the height ends up being the same as the
1549		 * # of pages in the region
1550		 */
1551		usergart[i].height = h;
1552		usergart[i].height_shift = ilog2(h);
1553		usergart[i].stride_pfn = tiler_stride(fmts[i], 0) >> PAGE_SHIFT;
1554		usergart[i].slot_shift = ilog2((PAGE_SIZE / h) >> i);
1555		for (j = 0; j < NUM_USERGART_ENTRIES; j++) {
1556			struct omap_drm_usergart_entry *entry;
1557			struct tiler_block *block;
1558
1559			entry = &usergart[i].entry[j];
1560			block = tiler_reserve_2d(fmts[i], w, h, PAGE_SIZE);
1561			if (IS_ERR(block)) {
1562				dev_err(dev->dev,
1563						"reserve failed: %d, %d, %ld\n",
1564						i, j, PTR_ERR(block));
1565				return;
1566			}
1567			entry->paddr = tiler_ssptr(block);
1568			entry->block = block;
1569
1570			DBG("%d:%d: %dx%d: paddr=%pad stride=%d", i, j, w, h,
1571					&entry->paddr,
1572					usergart[i].stride_pfn << PAGE_SHIFT);
1573		}
1574	}
1575
1576	priv->usergart = usergart;
1577	priv->has_dmm = true;
1578}
1579
1580void omap_gem_deinit(struct drm_device *dev)
1581{
1582	struct omap_drm_private *priv = dev->dev_private;
1583
1584	/* I believe we can rely on there being no more outstanding GEM
1585	 * objects which could depend on usergart/dmm at this point.
1586	 */
1587	kfree(priv->usergart);
1588}
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Copyright (C) 2011 Texas Instruments Incorporated - https://www.ti.com/
 
 
   4 * Author: Rob Clark <rob.clark@linaro.org>
 
 
 
 
 
 
 
 
 
 
 
 
   5 */
   6
   7#include <linux/dma-mapping.h>
   8#include <linux/seq_file.h>
   9#include <linux/shmem_fs.h>
  10#include <linux/spinlock.h>
  11#include <linux/pfn_t.h>
  12#include <linux/vmalloc.h>
  13
  14#include <drm/drm_prime.h>
  15#include <drm/drm_vma_manager.h>
  16
  17#include "omap_drv.h"
  18#include "omap_dmm_tiler.h"
  19
  20/*
  21 * GEM buffer object implementation.
  22 */
  23
  24/* note: we use upper 8 bits of flags for driver-internal flags: */
  25#define OMAP_BO_MEM_DMA_API	0x01000000	/* memory allocated with the dma_alloc_* API */
  26#define OMAP_BO_MEM_SHMEM	0x02000000	/* memory allocated through shmem backing */
  27#define OMAP_BO_MEM_DMABUF	0x08000000	/* memory imported from a dmabuf */
  28
  29struct omap_gem_object {
  30	struct drm_gem_object base;
  31
  32	struct list_head mm_list;
  33
  34	u32 flags;
  35
  36	/** width/height for tiled formats (rounded up to slot boundaries) */
  37	u16 width, height;
  38
  39	/** roll applied when mapping to DMM */
  40	u32 roll;
  41
  42	/** protects pin_cnt, block, pages, dma_addrs and vaddr */
  43	struct mutex lock;
  44
  45	/**
  46	 * dma_addr contains the buffer DMA address. It is valid for
  47	 *
  48	 * - buffers allocated through the DMA mapping API (with the
  49	 *   OMAP_BO_MEM_DMA_API flag set)
  50	 *
  51	 * - buffers imported from dmabuf (with the OMAP_BO_MEM_DMABUF flag set)
  52	 *   if they are physically contiguous
  53	 *
  54	 * - buffers mapped through the TILER when pin_cnt is not zero, in which
  55	 *   case the DMA address points to the TILER aperture
  56	 *
  57	 * Physically contiguous buffers have their DMA address equal to the
  58	 * physical address as we don't remap those buffers through the TILER.
  59	 *
  60	 * Buffers mapped to the TILER have their DMA address pointing to the
  61	 * TILER aperture. As TILER mappings are refcounted (through pin_cnt)
  62	 * the DMA address must be accessed through omap_gem_pin() to ensure
  63	 * that the mapping won't disappear unexpectedly. References must be
  64	 * released with omap_gem_unpin().
  65	 */
  66	dma_addr_t dma_addr;
  67
  68	/**
  69	 * # of users
  70	 */
  71	refcount_t pin_cnt;
  72
  73	/**
  74	 * If the buffer has been imported from a dmabuf the OMAP_DB_DMABUF flag
  75	 * is set and the sgt field is valid.
  76	 */
  77	struct sg_table *sgt;
  78
  79	/**
  80	 * tiler block used when buffer is remapped in DMM/TILER.
  81	 */
  82	struct tiler_block *block;
  83
  84	/**
  85	 * Array of backing pages, if allocated.  Note that pages are never
  86	 * allocated for buffers originally allocated from contiguous memory
  87	 */
  88	struct page **pages;
  89
  90	/** addresses corresponding to pages in above array */
  91	dma_addr_t *dma_addrs;
  92
  93	/**
  94	 * Virtual address, if mapped.
  95	 */
  96	void *vaddr;
 
 
 
 
 
 
 
 
 
 
 
 
 
  97};
  98
  99#define to_omap_bo(x) container_of(x, struct omap_gem_object, base)
 100
 101/* To deal with userspace mmap'ings of 2d tiled buffers, which (a) are
 102 * not necessarily pinned in TILER all the time, and (b) when they are
 103 * they are not necessarily page aligned, we reserve one or more small
 104 * regions in each of the 2d containers to use as a user-GART where we
 105 * can create a second page-aligned mapping of parts of the buffer
 106 * being accessed from userspace.
 107 *
 108 * Note that we could optimize slightly when we know that multiple
 109 * tiler containers are backed by the same PAT.. but I'll leave that
 110 * for later..
 111 */
 112#define NUM_USERGART_ENTRIES 2
 113struct omap_drm_usergart_entry {
 114	struct tiler_block *block;	/* the reserved tiler block */
 115	dma_addr_t dma_addr;
 116	struct drm_gem_object *obj;	/* the current pinned obj */
 117	pgoff_t obj_pgoff;		/* page offset of obj currently
 118					   mapped in */
 119};
 120
 121struct omap_drm_usergart {
 122	struct omap_drm_usergart_entry entry[NUM_USERGART_ENTRIES];
 123	int height;				/* height in rows */
 124	int height_shift;		/* ilog2(height in rows) */
 125	int slot_shift;			/* ilog2(width per slot) */
 126	int stride_pfn;			/* stride in pages */
 127	int last;				/* index of last used entry */
 128};
 129
 130/* -----------------------------------------------------------------------------
 131 * Helpers
 132 */
 133
 134/** get mmap offset */
 135u64 omap_gem_mmap_offset(struct drm_gem_object *obj)
 136{
 137	struct drm_device *dev = obj->dev;
 138	int ret;
 139	size_t size;
 140
 
 
 141	/* Make it mmapable */
 142	size = omap_gem_mmap_size(obj);
 143	ret = drm_gem_create_mmap_offset_size(obj, size);
 144	if (ret) {
 145		dev_err(dev->dev, "could not allocate mmap offset\n");
 146		return 0;
 147	}
 148
 149	return drm_vma_node_offset_addr(&obj->vma_node);
 150}
 151
 152static bool omap_gem_sgt_is_contiguous(struct sg_table *sgt, size_t size)
 153{
 154	return !(drm_prime_get_contiguous_size(sgt) < size);
 155}
 156
 157static bool omap_gem_is_contiguous(struct omap_gem_object *omap_obj)
 158{
 159	if (omap_obj->flags & OMAP_BO_MEM_DMA_API)
 160		return true;
 161
 162	if ((omap_obj->flags & OMAP_BO_MEM_DMABUF) &&
 163	    omap_gem_sgt_is_contiguous(omap_obj->sgt, omap_obj->base.size))
 164		return true;
 165
 166	return false;
 167}
 168
 169/* -----------------------------------------------------------------------------
 170 * Eviction
 171 */
 172
 173static void omap_gem_evict_entry(struct drm_gem_object *obj,
 174		enum tiler_fmt fmt, struct omap_drm_usergart_entry *entry)
 175{
 176	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 177	struct omap_drm_private *priv = obj->dev->dev_private;
 178	int n = priv->usergart[fmt].height;
 179	size_t size = PAGE_SIZE * n;
 180	loff_t off = omap_gem_mmap_offset(obj) +
 181			(entry->obj_pgoff << PAGE_SHIFT);
 182	const int m = DIV_ROUND_UP(omap_obj->width << fmt, PAGE_SIZE);
 183
 184	if (m > 1) {
 185		int i;
 186		/* if stride > than PAGE_SIZE then sparse mapping: */
 187		for (i = n; i > 0; i--) {
 188			unmap_mapping_range(obj->dev->anon_inode->i_mapping,
 189					    off, PAGE_SIZE, 1);
 190			off += PAGE_SIZE * m;
 191		}
 192	} else {
 193		unmap_mapping_range(obj->dev->anon_inode->i_mapping,
 194				    off, size, 1);
 195	}
 196
 197	entry->obj = NULL;
 198}
 199
 200/* Evict a buffer from usergart, if it is mapped there */
 201static void omap_gem_evict(struct drm_gem_object *obj)
 202{
 203	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 204	struct omap_drm_private *priv = obj->dev->dev_private;
 205
 206	if (omap_obj->flags & OMAP_BO_TILED_MASK) {
 207		enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 208		int i;
 209
 210		for (i = 0; i < NUM_USERGART_ENTRIES; i++) {
 211			struct omap_drm_usergart_entry *entry =
 212				&priv->usergart[fmt].entry[i];
 213
 214			if (entry->obj == obj)
 215				omap_gem_evict_entry(obj, fmt, entry);
 216		}
 217	}
 218}
 219
 220/* -----------------------------------------------------------------------------
 221 * Page Management
 222 */
 223
 224/*
 225 * Ensure backing pages are allocated. Must be called with the omap_obj.lock
 226 * held.
 227 */
 228static int omap_gem_attach_pages(struct drm_gem_object *obj)
 229{
 230	struct drm_device *dev = obj->dev;
 231	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 232	struct page **pages;
 233	int npages = obj->size >> PAGE_SHIFT;
 234	int i, ret;
 235	dma_addr_t *addrs;
 236
 237	lockdep_assert_held(&omap_obj->lock);
 238
 239	/*
 240	 * If not using shmem (in which case backing pages don't need to be
 241	 * allocated) or if pages are already allocated we're done.
 242	 */
 243	if (!(omap_obj->flags & OMAP_BO_MEM_SHMEM) || omap_obj->pages)
 244		return 0;
 245
 246	pages = drm_gem_get_pages(obj);
 247	if (IS_ERR(pages)) {
 248		dev_err(obj->dev->dev, "could not get pages: %ld\n", PTR_ERR(pages));
 249		return PTR_ERR(pages);
 250	}
 251
 252	/* for non-cached buffers, ensure the new pages are clean because
 253	 * DSS, GPU, etc. are not cache coherent:
 254	 */
 255	if (omap_obj->flags & (OMAP_BO_WC|OMAP_BO_UNCACHED)) {
 256		addrs = kmalloc_array(npages, sizeof(*addrs), GFP_KERNEL);
 257		if (!addrs) {
 258			ret = -ENOMEM;
 259			goto free_pages;
 260		}
 261
 262		for (i = 0; i < npages; i++) {
 263			addrs[i] = dma_map_page(dev->dev, pages[i],
 264					0, PAGE_SIZE, DMA_TO_DEVICE);
 265
 266			if (dma_mapping_error(dev->dev, addrs[i])) {
 267				dev_warn(dev->dev,
 268					"%s: failed to map page\n", __func__);
 269
 270				for (i = i - 1; i >= 0; --i) {
 271					dma_unmap_page(dev->dev, addrs[i],
 272						PAGE_SIZE, DMA_TO_DEVICE);
 273				}
 274
 275				ret = -ENOMEM;
 276				goto free_addrs;
 277			}
 278		}
 279	} else {
 280		addrs = kcalloc(npages, sizeof(*addrs), GFP_KERNEL);
 281		if (!addrs) {
 282			ret = -ENOMEM;
 283			goto free_pages;
 284		}
 285	}
 286
 287	omap_obj->dma_addrs = addrs;
 288	omap_obj->pages = pages;
 289
 290	return 0;
 291
 292free_addrs:
 293	kfree(addrs);
 294free_pages:
 295	drm_gem_put_pages(obj, pages, true, false);
 296
 297	return ret;
 298}
 299
 300/* Release backing pages. Must be called with the omap_obj.lock held. */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 301static void omap_gem_detach_pages(struct drm_gem_object *obj)
 302{
 303	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 304	unsigned int npages = obj->size >> PAGE_SHIFT;
 305	unsigned int i;
 306
 307	lockdep_assert_held(&omap_obj->lock);
 308
 309	for (i = 0; i < npages; i++) {
 310		if (omap_obj->dma_addrs[i])
 311			dma_unmap_page(obj->dev->dev, omap_obj->dma_addrs[i],
 312				       PAGE_SIZE, DMA_TO_DEVICE);
 
 
 
 313	}
 314
 315	kfree(omap_obj->dma_addrs);
 316	omap_obj->dma_addrs = NULL;
 317
 318	drm_gem_put_pages(obj, omap_obj->pages, true, false);
 319	omap_obj->pages = NULL;
 320}
 321
 322/* get buffer flags */
 323u32 omap_gem_flags(struct drm_gem_object *obj)
 324{
 325	return to_omap_bo(obj)->flags;
 326}
 327
 
 
 
 
 
 
 
 
 
 328/** get mmap size */
 329size_t omap_gem_mmap_size(struct drm_gem_object *obj)
 330{
 331	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 332	size_t size = obj->size;
 333
 334	if (omap_obj->flags & OMAP_BO_TILED_MASK) {
 335		/* for tiled buffers, the virtual size has stride rounded up
 336		 * to 4kb.. (to hide the fact that row n+1 might start 16kb or
 337		 * 32kb later!).  But we don't back the entire buffer with
 338		 * pages, only the valid picture part.. so need to adjust for
 339		 * this in the size used to mmap and generate mmap offset
 340		 */
 341		size = tiler_vsize(gem2fmt(omap_obj->flags),
 342				omap_obj->width, omap_obj->height);
 343	}
 344
 345	return size;
 346}
 347
 
 
 
 
 
 
 
 
 
 
 
 
 348/* -----------------------------------------------------------------------------
 349 * Fault Handling
 350 */
 351
 352/* Normal handling for the case of faulting in non-tiled buffers */
 353static vm_fault_t omap_gem_fault_1d(struct drm_gem_object *obj,
 354		struct vm_area_struct *vma, struct vm_fault *vmf)
 355{
 356	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 357	unsigned long pfn;
 358	pgoff_t pgoff;
 359
 360	/* We don't use vmf->pgoff since that has the fake offset: */
 361	pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
 
 362
 363	if (omap_obj->pages) {
 364		omap_gem_cpu_sync_page(obj, pgoff);
 365		pfn = page_to_pfn(omap_obj->pages[pgoff]);
 366	} else {
 367		BUG_ON(!omap_gem_is_contiguous(omap_obj));
 368		pfn = (omap_obj->dma_addr >> PAGE_SHIFT) + pgoff;
 369	}
 370
 371	VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
 372			pfn, pfn << PAGE_SHIFT);
 373
 374	return vmf_insert_mixed(vma, vmf->address,
 375			__pfn_to_pfn_t(pfn, PFN_DEV));
 376}
 377
 378/* Special handling for the case of faulting in 2d tiled buffers */
 379static vm_fault_t omap_gem_fault_2d(struct drm_gem_object *obj,
 380		struct vm_area_struct *vma, struct vm_fault *vmf)
 381{
 382	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 383	struct omap_drm_private *priv = obj->dev->dev_private;
 384	struct omap_drm_usergart_entry *entry;
 385	enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 386	struct page *pages[64];  /* XXX is this too much to have on stack? */
 387	unsigned long pfn;
 388	pgoff_t pgoff, base_pgoff;
 389	unsigned long vaddr;
 390	int i, err, slots;
 391	vm_fault_t ret = VM_FAULT_NOPAGE;
 392
 393	/*
 394	 * Note the height of the slot is also equal to the number of pages
 395	 * that need to be mapped in to fill 4kb wide CPU page.  If the slot
 396	 * height is 64, then 64 pages fill a 4kb wide by 64 row region.
 397	 */
 398	const int n = priv->usergart[fmt].height;
 399	const int n_shift = priv->usergart[fmt].height_shift;
 400
 401	/*
 402	 * If buffer width in bytes > PAGE_SIZE then the virtual stride is
 403	 * rounded up to next multiple of PAGE_SIZE.. this need to be taken
 404	 * into account in some of the math, so figure out virtual stride
 405	 * in pages
 406	 */
 407	const int m = DIV_ROUND_UP(omap_obj->width << fmt, PAGE_SIZE);
 408
 409	/* We don't use vmf->pgoff since that has the fake offset: */
 410	pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
 
 411
 412	/*
 413	 * Actual address we start mapping at is rounded down to previous slot
 414	 * boundary in the y direction:
 415	 */
 416	base_pgoff = round_down(pgoff, m << n_shift);
 417
 418	/* figure out buffer width in slots */
 419	slots = omap_obj->width >> priv->usergart[fmt].slot_shift;
 420
 421	vaddr = vmf->address - ((pgoff - base_pgoff) << PAGE_SHIFT);
 422
 423	entry = &priv->usergart[fmt].entry[priv->usergart[fmt].last];
 424
 425	/* evict previous buffer using this usergart entry, if any: */
 426	if (entry->obj)
 427		omap_gem_evict_entry(entry->obj, fmt, entry);
 428
 429	entry->obj = obj;
 430	entry->obj_pgoff = base_pgoff;
 431
 432	/* now convert base_pgoff to phys offset from virt offset: */
 433	base_pgoff = (base_pgoff >> n_shift) * slots;
 434
 435	/* for wider-than 4k.. figure out which part of the slot-row we want: */
 436	if (m > 1) {
 437		int off = pgoff % m;
 438		entry->obj_pgoff += off;
 439		base_pgoff /= m;
 440		slots = min(slots - (off << n_shift), n);
 441		base_pgoff += off << n_shift;
 442		vaddr += off << PAGE_SHIFT;
 443	}
 444
 445	/*
 446	 * Map in pages. Beyond the valid pixel part of the buffer, we set
 447	 * pages[i] to NULL to get a dummy page mapped in.. if someone
 448	 * reads/writes it they will get random/undefined content, but at
 449	 * least it won't be corrupting whatever other random page used to
 450	 * be mapped in, or other undefined behavior.
 451	 */
 452	memcpy(pages, &omap_obj->pages[base_pgoff],
 453			sizeof(struct page *) * slots);
 454	memset(pages + slots, 0,
 455			sizeof(struct page *) * (n - slots));
 456
 457	err = tiler_pin(entry->block, pages, ARRAY_SIZE(pages), 0, true);
 458	if (err) {
 459		ret = vmf_error(err);
 460		dev_err(obj->dev->dev, "failed to pin: %d\n", err);
 461		return ret;
 462	}
 463
 464	pfn = entry->dma_addr >> PAGE_SHIFT;
 465
 466	VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
 467			pfn, pfn << PAGE_SHIFT);
 468
 469	for (i = n; i > 0; i--) {
 470		ret = vmf_insert_mixed(vma,
 471			vaddr, __pfn_to_pfn_t(pfn, PFN_DEV));
 472		if (ret & VM_FAULT_ERROR)
 473			break;
 474		pfn += priv->usergart[fmt].stride_pfn;
 475		vaddr += PAGE_SIZE * m;
 476	}
 477
 478	/* simple round-robin: */
 479	priv->usergart[fmt].last = (priv->usergart[fmt].last + 1)
 480				 % NUM_USERGART_ENTRIES;
 481
 482	return ret;
 483}
 484
 485/**
 486 * omap_gem_fault		-	pagefault handler for GEM objects
 
 487 * @vmf: fault detail
 488 *
 489 * Invoked when a fault occurs on an mmap of a GEM managed area. GEM
 490 * does most of the work for us including the actual map/unmap calls
 491 * but we need to do the actual page work.
 492 *
 493 * The VMA was set up by GEM. In doing so it also ensured that the
 494 * vma->vm_private_data points to the GEM object that is backing this
 495 * mapping.
 496 */
 497static vm_fault_t omap_gem_fault(struct vm_fault *vmf)
 498{
 499	struct vm_area_struct *vma = vmf->vma;
 500	struct drm_gem_object *obj = vma->vm_private_data;
 501	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 502	int err;
 503	vm_fault_t ret;
 
 504
 505	/* Make sure we don't parallel update on a fault, nor move or remove
 506	 * something from beneath our feet
 507	 */
 508	mutex_lock(&omap_obj->lock);
 509
 510	/* if a shmem backed object, make sure we have pages attached now */
 511	err = omap_gem_attach_pages(obj);
 512	if (err) {
 513		ret = vmf_error(err);
 514		goto fail;
 515	}
 516
 517	/* where should we do corresponding put_pages().. we are mapping
 518	 * the original page, rather than thru a GART, so we can't rely
 519	 * on eviction to trigger this.  But munmap() or all mappings should
 520	 * probably trigger put_pages()?
 521	 */
 522
 523	if (omap_obj->flags & OMAP_BO_TILED_MASK)
 524		ret = omap_gem_fault_2d(obj, vma, vmf);
 525	else
 526		ret = omap_gem_fault_1d(obj, vma, vmf);
 527
 528
 529fail:
 530	mutex_unlock(&omap_obj->lock);
 531	return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 532}
 533
 534static int omap_gem_object_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma)
 
 535{
 536	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 537
 538	vm_flags_set(vma, VM_DONTEXPAND | VM_DONTDUMP | VM_IO | VM_MIXEDMAP);
 
 539
 540	if (omap_obj->flags & OMAP_BO_WC) {
 541		vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
 542	} else if (omap_obj->flags & OMAP_BO_UNCACHED) {
 543		vma->vm_page_prot = pgprot_noncached(vm_get_page_prot(vma->vm_flags));
 544	} else {
 545		/*
 546		 * We do have some private objects, at least for scanout buffers
 547		 * on hardware without DMM/TILER.  But these are allocated write-
 548		 * combine
 549		 */
 550		if (WARN_ON(!obj->filp))
 551			return -EINVAL;
 552
 553		/*
 554		 * Shunt off cached objs to shmem file so they have their own
 555		 * address_space (so unmap_mapping_range does what we want,
 556		 * in particular in the case of mmap'd dmabufs)
 557		 */
 558		vma->vm_pgoff -= drm_vma_node_start(&obj->vma_node);
 559		vma_set_file(vma, obj->filp);
 
 560
 561		vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
 562	}
 563
 564	vma->vm_page_prot = pgprot_decrypted(vma->vm_page_prot);
 565
 566	return 0;
 567}
 568
 569/* -----------------------------------------------------------------------------
 570 * Dumb Buffers
 571 */
 572
 573/**
 574 * omap_gem_dumb_create	-	create a dumb buffer
 575 * @file: our client file
 576 * @dev: our device
 577 * @args: the requested arguments copied from userspace
 578 *
 579 * Allocate a buffer suitable for use for a frame buffer of the
 580 * form described by user space. Give userspace a handle by which
 581 * to reference it.
 582 */
 583int omap_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
 584		struct drm_mode_create_dumb *args)
 585{
 586	union omap_gem_size gsize;
 587
 588	args->pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
 589
 590	args->size = PAGE_ALIGN(args->pitch * args->height);
 591
 592	gsize = (union omap_gem_size){
 593		.bytes = args->size,
 594	};
 595
 596	return omap_gem_new_handle(dev, file, gsize,
 597			OMAP_BO_SCANOUT | OMAP_BO_WC, &args->handle);
 598}
 599
 600/**
 601 * omap_gem_dumb_map_offset - create an offset for a dumb buffer
 602 * @file: our drm client file
 603 * @dev: drm device
 604 * @handle: GEM handle to the object (from dumb_create)
 605 * @offset: memory map offset placeholder
 606 *
 607 * Do the necessary setup to allow the mapping of the frame buffer
 608 * into user memory. We don't have to do much here at the moment.
 609 */
 610int omap_gem_dumb_map_offset(struct drm_file *file, struct drm_device *dev,
 611		u32 handle, u64 *offset)
 612{
 613	struct drm_gem_object *obj;
 614	int ret = 0;
 615
 616	/* GEM does all our handle to object mapping */
 617	obj = drm_gem_object_lookup(file, handle);
 618	if (obj == NULL) {
 619		ret = -ENOENT;
 620		goto fail;
 621	}
 622
 623	*offset = omap_gem_mmap_offset(obj);
 624
 625	drm_gem_object_put(obj);
 626
 627fail:
 628	return ret;
 629}
 630
 631#ifdef CONFIG_DRM_FBDEV_EMULATION
 632/* Set scrolling position.  This allows us to implement fast scrolling
 633 * for console.
 634 *
 635 * Call only from non-atomic contexts.
 636 */
 637int omap_gem_roll(struct drm_gem_object *obj, u32 roll)
 638{
 639	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 640	u32 npages = obj->size >> PAGE_SHIFT;
 641	int ret = 0;
 642
 643	if (roll > npages) {
 644		dev_err(obj->dev->dev, "invalid roll: %d\n", roll);
 645		return -EINVAL;
 646	}
 647
 648	omap_obj->roll = roll;
 649
 650	mutex_lock(&omap_obj->lock);
 651
 652	/* if we aren't mapped yet, we don't need to do anything */
 653	if (omap_obj->block) {
 654		ret = omap_gem_attach_pages(obj);
 
 655		if (ret)
 656			goto fail;
 657
 658		ret = tiler_pin(omap_obj->block, omap_obj->pages, npages,
 659				roll, true);
 660		if (ret)
 661			dev_err(obj->dev->dev, "could not repin: %d\n", ret);
 662	}
 663
 664fail:
 665	mutex_unlock(&omap_obj->lock);
 666
 667	return ret;
 668}
 669#endif
 670
 671/* -----------------------------------------------------------------------------
 672 * Memory Management & DMA Sync
 673 */
 674
 675/*
 676 * shmem buffers that are mapped cached are not coherent.
 677 *
 678 * We keep track of dirty pages using page faulting to perform cache management.
 679 * When a page is mapped to the CPU in read/write mode the device can't access
 680 * it and omap_obj->dma_addrs[i] is NULL. When a page is mapped to the device
 681 * the omap_obj->dma_addrs[i] is set to the DMA address, and the page is
 682 * unmapped from the CPU.
 683 */
 684static inline bool omap_gem_is_cached_coherent(struct drm_gem_object *obj)
 685{
 686	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 687
 688	return !((omap_obj->flags & OMAP_BO_MEM_SHMEM) &&
 689		((omap_obj->flags & OMAP_BO_CACHE_MASK) == OMAP_BO_CACHED));
 690}
 691
 692/* Sync the buffer for CPU access.. note pages should already be
 693 * attached, ie. omap_gem_get_pages()
 694 */
 695void omap_gem_cpu_sync_page(struct drm_gem_object *obj, int pgoff)
 696{
 697	struct drm_device *dev = obj->dev;
 698	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 699
 700	if (omap_gem_is_cached_coherent(obj))
 701		return;
 702
 703	if (omap_obj->dma_addrs[pgoff]) {
 704		dma_unmap_page(dev->dev, omap_obj->dma_addrs[pgoff],
 705				PAGE_SIZE, DMA_TO_DEVICE);
 706		omap_obj->dma_addrs[pgoff] = 0;
 707	}
 708}
 709
 710/* sync the buffer for DMA access */
 711void omap_gem_dma_sync_buffer(struct drm_gem_object *obj,
 712		enum dma_data_direction dir)
 713{
 714	struct drm_device *dev = obj->dev;
 715	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 716	int i, npages = obj->size >> PAGE_SHIFT;
 717	struct page **pages = omap_obj->pages;
 718	bool dirty = false;
 719
 720	if (omap_gem_is_cached_coherent(obj))
 721		return;
 
 
 722
 723	for (i = 0; i < npages; i++) {
 724		if (!omap_obj->dma_addrs[i]) {
 725			dma_addr_t addr;
 726
 727			addr = dma_map_page(dev->dev, pages[i], 0,
 728					    PAGE_SIZE, dir);
 729			if (dma_mapping_error(dev->dev, addr)) {
 730				dev_warn(dev->dev, "%s: failed to map page\n",
 731					__func__);
 732				break;
 733			}
 734
 735			dirty = true;
 736			omap_obj->dma_addrs[i] = addr;
 737		}
 738	}
 739
 740	if (dirty) {
 741		unmap_mapping_range(obj->filp->f_mapping, 0,
 742				    omap_gem_mmap_size(obj), 1);
 743	}
 744}
 
 745
 746static int omap_gem_pin_tiler(struct drm_gem_object *obj)
 747{
 748	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 749	u32 npages = obj->size >> PAGE_SHIFT;
 750	enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
 751	struct tiler_block *block;
 752	int ret;
 753
 754	BUG_ON(omap_obj->block);
 755
 756	if (omap_obj->flags & OMAP_BO_TILED_MASK) {
 757		block = tiler_reserve_2d(fmt, omap_obj->width, omap_obj->height,
 758					 PAGE_SIZE);
 759	} else {
 760		block = tiler_reserve_1d(obj->size);
 761	}
 762
 763	if (IS_ERR(block)) {
 764		ret = PTR_ERR(block);
 765		dev_err(obj->dev->dev, "could not remap: %d (%d)\n", ret, fmt);
 766		goto fail;
 767	}
 768
 769	/* TODO: enable async refill.. */
 770	ret = tiler_pin(block, omap_obj->pages, npages, omap_obj->roll, true);
 771	if (ret) {
 772		tiler_release(block);
 773		dev_err(obj->dev->dev, "could not pin: %d\n", ret);
 774		goto fail;
 775	}
 776
 777	omap_obj->dma_addr = tiler_ssptr(block);
 778	omap_obj->block = block;
 779
 780	DBG("got dma address: %pad", &omap_obj->dma_addr);
 781
 782fail:
 783	return ret;
 784}
 785
 786/**
 787 * omap_gem_pin() - Pin a GEM object in memory
 788 * @obj: the GEM object
 789 * @dma_addr: the DMA address
 790 *
 791 * Pin the given GEM object in memory and fill the dma_addr pointer with the
 792 * object's DMA address. If the buffer is not physically contiguous it will be
 793 * remapped through the TILER to provide a contiguous view.
 794 *
 795 * Pins are reference-counted, calling this function multiple times is allowed
 796 * as long the corresponding omap_gem_unpin() calls are balanced.
 797 *
 798 * Return 0 on success or a negative error code otherwise.
 799 */
 800int omap_gem_pin(struct drm_gem_object *obj, dma_addr_t *dma_addr)
 
 801{
 802	struct omap_drm_private *priv = obj->dev->dev_private;
 803	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 804	int ret = 0;
 805
 806	mutex_lock(&omap_obj->lock);
 807
 808	if (!omap_gem_is_contiguous(omap_obj)) {
 809		if (refcount_read(&omap_obj->pin_cnt) == 0) {
 
 
 
 
 810
 811			refcount_set(&omap_obj->pin_cnt, 1);
 812
 813			ret = omap_gem_attach_pages(obj);
 814			if (ret)
 815				goto fail;
 816
 817			if (omap_obj->flags & OMAP_BO_SCANOUT) {
 818				if (priv->has_dmm) {
 819					ret = omap_gem_pin_tiler(obj);
 820					if (ret)
 821						goto fail;
 822				}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 823			}
 824		} else {
 825			refcount_inc(&omap_obj->pin_cnt);
 
 
 
 826		}
 
 
 
 
 
 
 
 
 
 827	}
 828
 829	if (dma_addr)
 830		*dma_addr = omap_obj->dma_addr;
 831
 832fail:
 833	mutex_unlock(&omap_obj->lock);
 834
 835	return ret;
 836}
 837
 838/**
 839 * omap_gem_unpin_locked() - Unpin a GEM object from memory
 840 * @obj: the GEM object
 841 *
 842 * omap_gem_unpin() without locking.
 843 */
 844static void omap_gem_unpin_locked(struct drm_gem_object *obj)
 845{
 846	struct omap_drm_private *priv = obj->dev->dev_private;
 847	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 848	int ret;
 849
 850	if (omap_gem_is_contiguous(omap_obj))
 851		return;
 852
 853	if (refcount_dec_and_test(&omap_obj->pin_cnt)) {
 854		if (omap_obj->sgt) {
 855			sg_free_table(omap_obj->sgt);
 856			kfree(omap_obj->sgt);
 857			omap_obj->sgt = NULL;
 858		}
 859		if (!(omap_obj->flags & OMAP_BO_SCANOUT))
 860			return;
 861		if (priv->has_dmm) {
 862			ret = tiler_unpin(omap_obj->block);
 863			if (ret) {
 864				dev_err(obj->dev->dev,
 865					"could not unpin pages: %d\n", ret);
 866			}
 867			ret = tiler_release(omap_obj->block);
 868			if (ret) {
 869				dev_err(obj->dev->dev,
 870					"could not release unmap: %d\n", ret);
 871			}
 872			omap_obj->dma_addr = 0;
 873			omap_obj->block = NULL;
 874		}
 875	}
 876}
 877
 878/**
 879 * omap_gem_unpin() - Unpin a GEM object from memory
 880 * @obj: the GEM object
 881 *
 882 * Unpin the given GEM object previously pinned with omap_gem_pin(). Pins are
 883 * reference-counted, the actual unpin will only be performed when the number
 884 * of calls to this function matches the number of calls to omap_gem_pin().
 885 */
 886void omap_gem_unpin(struct drm_gem_object *obj)
 887{
 888	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 889
 890	mutex_lock(&omap_obj->lock);
 891	omap_gem_unpin_locked(obj);
 892	mutex_unlock(&omap_obj->lock);
 893}
 894
 895/* Get rotated scanout address (only valid if already pinned), at the
 896 * specified orientation and x,y offset from top-left corner of buffer
 897 * (only valid for tiled 2d buffers)
 898 */
 899int omap_gem_rotated_dma_addr(struct drm_gem_object *obj, u32 orient,
 900		int x, int y, dma_addr_t *dma_addr)
 901{
 902	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 903	int ret = -EINVAL;
 904
 905	mutex_lock(&omap_obj->lock);
 906
 907	if ((refcount_read(&omap_obj->pin_cnt) > 0) && omap_obj->block &&
 908			(omap_obj->flags & OMAP_BO_TILED_MASK)) {
 909		*dma_addr = tiler_tsptr(omap_obj->block, orient, x, y);
 910		ret = 0;
 911	}
 912
 913	mutex_unlock(&omap_obj->lock);
 914
 915	return ret;
 916}
 917
 918/* Get tiler stride for the buffer (only valid for 2d tiled buffers) */
 919int omap_gem_tiled_stride(struct drm_gem_object *obj, u32 orient)
 920{
 921	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 922	int ret = -EINVAL;
 923	if (omap_obj->flags & OMAP_BO_TILED_MASK)
 924		ret = tiler_stride(gem2fmt(omap_obj->flags), orient);
 925	return ret;
 926}
 927
 928/* if !remap, and we don't have pages backing, then fail, rather than
 929 * increasing the pin count (which we don't really do yet anyways,
 930 * because we don't support swapping pages back out).  And 'remap'
 931 * might not be quite the right name, but I wanted to keep it working
 932 * similarly to omap_gem_pin().  Note though that mutex is not
 933 * aquired if !remap (because this can be called in atomic ctxt),
 934 * but probably omap_gem_unpin() should be changed to work in the
 935 * same way.  If !remap, a matching omap_gem_put_pages() call is not
 936 * required (and should not be made).
 937 */
 938int omap_gem_get_pages(struct drm_gem_object *obj, struct page ***pages,
 939		bool remap)
 940{
 941	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 942	int ret = 0;
 943
 944	mutex_lock(&omap_obj->lock);
 945
 946	if (remap) {
 947		ret = omap_gem_attach_pages(obj);
 948		if (ret)
 949			goto unlock;
 950	}
 951
 952	if (!omap_obj->pages) {
 953		ret = -ENOMEM;
 954		goto unlock;
 955	}
 956
 957	*pages = omap_obj->pages;
 958
 959unlock:
 960	mutex_unlock(&omap_obj->lock);
 961
 962	return ret;
 963}
 964
 965/* release pages when DMA no longer being performed */
 966int omap_gem_put_pages(struct drm_gem_object *obj)
 967{
 968	/* do something here if we dynamically attach/detach pages.. at
 969	 * least they would no longer need to be pinned if everyone has
 970	 * released the pages..
 971	 */
 972	return 0;
 973}
 974
 975struct sg_table *omap_gem_get_sg(struct drm_gem_object *obj,
 976		enum dma_data_direction dir)
 977{
 978	struct omap_gem_object *omap_obj = to_omap_bo(obj);
 979	dma_addr_t addr;
 980	struct sg_table *sgt;
 981	struct scatterlist *sg;
 982	unsigned int count, len, stride, i;
 983	int ret;
 984
 985	ret = omap_gem_pin(obj, &addr);
 986	if (ret)
 987		return ERR_PTR(ret);
 988
 989	mutex_lock(&omap_obj->lock);
 990
 991	sgt = omap_obj->sgt;
 992	if (sgt)
 993		goto out;
 994
 995	sgt = kzalloc(sizeof(*sgt), GFP_KERNEL);
 996	if (!sgt) {
 997		ret = -ENOMEM;
 998		goto err_unpin;
 999	}
1000
1001	if (addr) {
1002		if (omap_obj->flags & OMAP_BO_TILED_MASK) {
1003			enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
1004
1005			len = omap_obj->width << (int)fmt;
1006			count = omap_obj->height;
1007			stride = tiler_stride(fmt, 0);
1008		} else {
1009			len = obj->size;
1010			count = 1;
1011			stride = 0;
1012		}
1013	} else {
1014		count = obj->size >> PAGE_SHIFT;
1015	}
1016
1017	ret = sg_alloc_table(sgt, count, GFP_KERNEL);
1018	if (ret)
1019		goto err_free;
1020
1021	/* this must be after omap_gem_pin() to ensure we have pages attached */
1022	omap_gem_dma_sync_buffer(obj, dir);
1023
1024	if (addr) {
1025		for_each_sg(sgt->sgl, sg, count, i) {
1026			sg_set_page(sg, pfn_to_page(__phys_to_pfn(addr)),
1027				    len, offset_in_page(addr));
1028			sg_dma_address(sg) = addr;
1029			sg_dma_len(sg) = len;
1030
1031			addr += stride;
1032		}
1033	} else {
1034		for_each_sg(sgt->sgl, sg, count, i) {
1035			sg_set_page(sg, omap_obj->pages[i], PAGE_SIZE, 0);
1036			sg_dma_address(sg) = omap_obj->dma_addrs[i];
1037			sg_dma_len(sg) =  PAGE_SIZE;
1038		}
1039	}
1040
1041	omap_obj->sgt = sgt;
1042out:
1043	mutex_unlock(&omap_obj->lock);
1044	return sgt;
1045
1046err_free:
1047	kfree(sgt);
1048err_unpin:
1049	mutex_unlock(&omap_obj->lock);
1050	omap_gem_unpin(obj);
1051	return ERR_PTR(ret);
1052}
1053
1054void omap_gem_put_sg(struct drm_gem_object *obj, struct sg_table *sgt)
1055{
1056	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1057
1058	if (WARN_ON(omap_obj->sgt != sgt))
1059		return;
1060
1061	omap_gem_unpin(obj);
1062}
1063
1064#ifdef CONFIG_DRM_FBDEV_EMULATION
1065/*
1066 * Get kernel virtual address for CPU access.. this more or less only
1067 * exists for omap_fbdev.
1068 */
1069void *omap_gem_vaddr(struct drm_gem_object *obj)
1070{
1071	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1072	void *vaddr;
1073	int ret;
1074
1075	mutex_lock(&omap_obj->lock);
1076
1077	if (!omap_obj->vaddr) {
1078		ret = omap_gem_attach_pages(obj);
1079		if (ret) {
1080			vaddr = ERR_PTR(ret);
1081			goto unlock;
1082		}
1083
1084		omap_obj->vaddr = vmap(omap_obj->pages, obj->size >> PAGE_SHIFT,
1085				VM_MAP, pgprot_writecombine(PAGE_KERNEL));
1086	}
1087
1088	vaddr = omap_obj->vaddr;
1089
1090unlock:
1091	mutex_unlock(&omap_obj->lock);
1092	return vaddr;
1093}
1094#endif
1095
1096/* -----------------------------------------------------------------------------
1097 * Power Management
1098 */
1099
1100#ifdef CONFIG_PM
1101/* re-pin objects in DMM in resume path: */
1102int omap_gem_resume(struct drm_device *dev)
1103{
1104	struct omap_drm_private *priv = dev->dev_private;
 
1105	struct omap_gem_object *omap_obj;
1106	int ret = 0;
1107
1108	mutex_lock(&priv->list_lock);
1109	list_for_each_entry(omap_obj, &priv->obj_list, mm_list) {
1110		if (omap_obj->block) {
1111			struct drm_gem_object *obj = &omap_obj->base;
1112			u32 npages = obj->size >> PAGE_SHIFT;
1113
1114			WARN_ON(!omap_obj->pages);  /* this can't happen */
1115			ret = tiler_pin(omap_obj->block,
1116					omap_obj->pages, npages,
1117					omap_obj->roll, true);
1118			if (ret) {
1119				dev_err(dev->dev, "could not repin: %d\n", ret);
1120				goto done;
1121			}
1122		}
1123	}
1124
1125done:
1126	mutex_unlock(&priv->list_lock);
1127	return ret;
1128}
1129#endif
1130
1131/* -----------------------------------------------------------------------------
1132 * DebugFS
1133 */
1134
1135#ifdef CONFIG_DEBUG_FS
1136void omap_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
1137{
1138	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1139	u64 off;
1140
1141	off = drm_vma_node_start(&obj->vma_node);
1142
1143	mutex_lock(&omap_obj->lock);
1144
1145	seq_printf(m, "%08x: %2d (%2d) %08llx %pad (%2d) %p %4d",
1146			omap_obj->flags, obj->name, kref_read(&obj->refcount),
1147			off, &omap_obj->dma_addr,
1148			refcount_read(&omap_obj->pin_cnt),
1149			omap_obj->vaddr, omap_obj->roll);
1150
1151	if (omap_obj->flags & OMAP_BO_TILED_MASK) {
1152		seq_printf(m, " %dx%d", omap_obj->width, omap_obj->height);
1153		if (omap_obj->block) {
1154			struct tcm_area *area = &omap_obj->block->area;
1155			seq_printf(m, " (%dx%d, %dx%d)",
1156					area->p0.x, area->p0.y,
1157					area->p1.x, area->p1.y);
1158		}
1159	} else {
1160		seq_printf(m, " %zu", obj->size);
1161	}
1162
1163	mutex_unlock(&omap_obj->lock);
1164
1165	seq_printf(m, "\n");
1166}
1167
1168void omap_gem_describe_objects(struct list_head *list, struct seq_file *m)
1169{
1170	struct omap_gem_object *omap_obj;
1171	int count = 0;
1172	size_t size = 0;
1173
1174	list_for_each_entry(omap_obj, list, mm_list) {
1175		struct drm_gem_object *obj = &omap_obj->base;
1176		seq_printf(m, "   ");
1177		omap_gem_describe(obj, m);
1178		count++;
1179		size += obj->size;
1180	}
1181
1182	seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
1183}
1184#endif
1185
1186/* -----------------------------------------------------------------------------
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1187 * Constructor & Destructor
1188 */
1189
1190static void omap_gem_free_object(struct drm_gem_object *obj)
1191{
1192	struct drm_device *dev = obj->dev;
1193	struct omap_drm_private *priv = dev->dev_private;
1194	struct omap_gem_object *omap_obj = to_omap_bo(obj);
1195
1196	omap_gem_evict(obj);
 
 
1197
1198	mutex_lock(&priv->list_lock);
1199	list_del(&omap_obj->mm_list);
1200	mutex_unlock(&priv->list_lock);
1201
1202	/*
1203	 * We own the sole reference to the object at this point, but to keep
1204	 * lockdep happy, we must still take the omap_obj_lock to call
1205	 * omap_gem_detach_pages(). This should hardly make any difference as
1206	 * there can't be any lock contention.
1207	 */
1208	mutex_lock(&omap_obj->lock);
1209
1210	/* The object should not be pinned. */
1211	WARN_ON(refcount_read(&omap_obj->pin_cnt) > 0);
1212
1213	if (omap_obj->pages) {
1214		if (omap_obj->flags & OMAP_BO_MEM_DMABUF)
1215			kfree(omap_obj->pages);
1216		else
1217			omap_gem_detach_pages(obj);
1218	}
1219
1220	if (omap_obj->flags & OMAP_BO_MEM_DMA_API) {
1221		dma_free_wc(dev->dev, obj->size, omap_obj->vaddr,
1222			    omap_obj->dma_addr);
1223	} else if (omap_obj->vaddr) {
1224		vunmap(omap_obj->vaddr);
1225	} else if (obj->import_attach) {
1226		drm_prime_gem_destroy(obj, omap_obj->sgt);
1227	}
1228
1229	mutex_unlock(&omap_obj->lock);
1230
1231	drm_gem_object_release(obj);
1232
1233	mutex_destroy(&omap_obj->lock);
1234
1235	kfree(omap_obj);
1236}
1237
1238static bool omap_gem_validate_flags(struct drm_device *dev, u32 flags)
1239{
1240	struct omap_drm_private *priv = dev->dev_private;
1241
1242	switch (flags & OMAP_BO_CACHE_MASK) {
1243	case OMAP_BO_CACHED:
1244	case OMAP_BO_WC:
1245	case OMAP_BO_CACHE_MASK:
1246		break;
1247
1248	default:
1249		return false;
1250	}
1251
1252	if (flags & OMAP_BO_TILED_MASK) {
1253		if (!priv->usergart)
1254			return false;
1255
1256		switch (flags & OMAP_BO_TILED_MASK) {
1257		case OMAP_BO_TILED_8:
1258		case OMAP_BO_TILED_16:
1259		case OMAP_BO_TILED_32:
1260			break;
1261
1262		default:
1263			return false;
1264		}
1265	}
1266
1267	return true;
1268}
1269
1270static const struct vm_operations_struct omap_gem_vm_ops = {
1271	.fault = omap_gem_fault,
1272	.open = drm_gem_vm_open,
1273	.close = drm_gem_vm_close,
1274};
1275
1276static const struct drm_gem_object_funcs omap_gem_object_funcs = {
1277	.free = omap_gem_free_object,
1278	.export = omap_gem_prime_export,
1279	.mmap = omap_gem_object_mmap,
1280	.vm_ops = &omap_gem_vm_ops,
1281};
1282
1283/* GEM buffer object constructor */
1284struct drm_gem_object *omap_gem_new(struct drm_device *dev,
1285		union omap_gem_size gsize, u32 flags)
1286{
1287	struct omap_drm_private *priv = dev->dev_private;
1288	struct omap_gem_object *omap_obj;
1289	struct drm_gem_object *obj;
1290	struct address_space *mapping;
1291	size_t size;
1292	int ret;
1293
1294	if (!omap_gem_validate_flags(dev, flags))
1295		return NULL;
 
 
 
 
1296
1297	/* Validate the flags and compute the memory and cache flags. */
1298	if (flags & OMAP_BO_TILED_MASK) {
1299		/*
1300		 * Tiled buffers are always shmem paged backed. When they are
1301		 * scanned out, they are remapped into DMM/TILER.
1302		 */
 
1303		flags |= OMAP_BO_MEM_SHMEM;
1304
1305		/*
1306		 * Currently don't allow cached buffers. There is some caching
1307		 * stuff that needs to be handled better.
1308		 */
1309		flags &= ~(OMAP_BO_CACHED|OMAP_BO_WC|OMAP_BO_UNCACHED);
1310		flags |= tiler_get_cpu_cache_flags();
1311	} else if ((flags & OMAP_BO_SCANOUT) && !priv->has_dmm) {
1312		/*
1313		 * If we don't have DMM, we must allocate scanout buffers
1314		 * from contiguous DMA memory.
 
1315		 */
1316		flags |= OMAP_BO_MEM_DMA_API;
1317	} else if (!(flags & OMAP_BO_MEM_DMABUF)) {
1318		/*
1319		 * All other buffers not backed by dma_buf are shmem-backed.
1320		 */
1321		flags |= OMAP_BO_MEM_SHMEM;
1322	}
1323
1324	/* Allocate the initialize the OMAP GEM object. */
1325	omap_obj = kzalloc(sizeof(*omap_obj), GFP_KERNEL);
1326	if (!omap_obj)
1327		return NULL;
1328
1329	obj = &omap_obj->base;
1330	omap_obj->flags = flags;
1331	mutex_init(&omap_obj->lock);
1332
1333	if (flags & OMAP_BO_TILED_MASK) {
1334		/*
1335		 * For tiled buffers align dimensions to slot boundaries and
1336		 * calculate size based on aligned dimensions.
1337		 */
1338		tiler_align(gem2fmt(flags), &gsize.tiled.width,
1339			    &gsize.tiled.height);
1340
1341		size = tiler_size(gem2fmt(flags), gsize.tiled.width,
1342				  gsize.tiled.height);
1343
1344		omap_obj->width = gsize.tiled.width;
1345		omap_obj->height = gsize.tiled.height;
1346	} else {
1347		size = PAGE_ALIGN(gsize.bytes);
1348	}
1349
1350	obj->funcs = &omap_gem_object_funcs;
1351
1352	/* Initialize the GEM object. */
1353	if (!(flags & OMAP_BO_MEM_SHMEM)) {
1354		drm_gem_private_object_init(dev, obj, size);
1355	} else {
1356		ret = drm_gem_object_init(dev, obj, size);
1357		if (ret)
1358			goto err_free;
1359
1360		mapping = obj->filp->f_mapping;
1361		mapping_set_gfp_mask(mapping, GFP_USER | __GFP_DMA32);
1362	}
1363
1364	/* Allocate memory if needed. */
1365	if (flags & OMAP_BO_MEM_DMA_API) {
1366		omap_obj->vaddr = dma_alloc_wc(dev->dev, size,
1367					       &omap_obj->dma_addr,
1368					       GFP_KERNEL);
1369		if (!omap_obj->vaddr)
1370			goto err_release;
1371	}
1372
1373	mutex_lock(&priv->list_lock);
1374	list_add(&omap_obj->mm_list, &priv->obj_list);
1375	mutex_unlock(&priv->list_lock);
1376
1377	return obj;
1378
1379err_release:
1380	drm_gem_object_release(obj);
1381err_free:
1382	kfree(omap_obj);
1383	return NULL;
1384}
1385
1386struct drm_gem_object *omap_gem_new_dmabuf(struct drm_device *dev, size_t size,
1387					   struct sg_table *sgt)
1388{
1389	struct omap_drm_private *priv = dev->dev_private;
1390	struct omap_gem_object *omap_obj;
1391	struct drm_gem_object *obj;
1392	union omap_gem_size gsize;
1393
1394	/* Without a DMM only physically contiguous buffers can be supported. */
1395	if (!omap_gem_sgt_is_contiguous(sgt, size) && !priv->has_dmm)
1396		return ERR_PTR(-EINVAL);
1397
 
 
1398	gsize.bytes = PAGE_ALIGN(size);
1399	obj = omap_gem_new(dev, gsize, OMAP_BO_MEM_DMABUF | OMAP_BO_WC);
1400	if (!obj)
1401		return ERR_PTR(-ENOMEM);
 
 
1402
1403	omap_obj = to_omap_bo(obj);
1404
1405	omap_obj->sgt = sgt;
1406
1407	if (omap_gem_sgt_is_contiguous(sgt, size)) {
1408		omap_obj->dma_addr = sg_dma_address(sgt->sgl);
1409	} else {
1410		/* Create pages list from sgt */
 
1411		struct page **pages;
1412		unsigned int npages;
1413		unsigned int ret;
1414
1415		npages = DIV_ROUND_UP(size, PAGE_SIZE);
1416		pages = kcalloc(npages, sizeof(*pages), GFP_KERNEL);
1417		if (!pages) {
1418			omap_gem_free_object(obj);
1419			return ERR_PTR(-ENOMEM);
 
1420		}
1421
1422		omap_obj->pages = pages;
1423		ret = drm_prime_sg_to_page_array(sgt, pages, npages);
1424		if (ret) {
 
 
 
 
 
 
1425			omap_gem_free_object(obj);
1426			return ERR_PTR(-ENOMEM);
 
1427		}
1428	}
1429
 
 
1430	return obj;
1431}
1432
1433/* convenience method to construct a GEM buffer object, and userspace handle */
1434int omap_gem_new_handle(struct drm_device *dev, struct drm_file *file,
1435		union omap_gem_size gsize, u32 flags, u32 *handle)
1436{
1437	struct drm_gem_object *obj;
1438	int ret;
1439
1440	obj = omap_gem_new(dev, gsize, flags);
1441	if (!obj)
1442		return -ENOMEM;
1443
1444	ret = drm_gem_handle_create(file, obj, handle);
1445	if (ret) {
1446		omap_gem_free_object(obj);
1447		return ret;
1448	}
1449
1450	/* drop reference from allocate - handle holds it now */
1451	drm_gem_object_put(obj);
1452
1453	return 0;
1454}
1455
1456/* -----------------------------------------------------------------------------
1457 * Init & Cleanup
1458 */
1459
1460/* If DMM is used, we need to set some stuff up.. */
1461void omap_gem_init(struct drm_device *dev)
1462{
1463	struct omap_drm_private *priv = dev->dev_private;
1464	struct omap_drm_usergart *usergart;
1465	const enum tiler_fmt fmts[] = {
1466			TILFMT_8BIT, TILFMT_16BIT, TILFMT_32BIT
1467	};
1468	int i, j;
1469
1470	if (!dmm_is_available()) {
1471		/* DMM only supported on OMAP4 and later, so this isn't fatal */
1472		dev_warn(dev->dev, "DMM not available, disable DMM support\n");
1473		return;
1474	}
1475
1476	usergart = kcalloc(3, sizeof(*usergart), GFP_KERNEL);
1477	if (!usergart)
1478		return;
1479
1480	/* reserve 4k aligned/wide regions for userspace mappings: */
1481	for (i = 0; i < ARRAY_SIZE(fmts); i++) {
1482		u16 h = 1, w = PAGE_SIZE >> i;
1483
1484		tiler_align(fmts[i], &w, &h);
1485		/* note: since each region is 1 4kb page wide, and minimum
1486		 * number of rows, the height ends up being the same as the
1487		 * # of pages in the region
1488		 */
1489		usergart[i].height = h;
1490		usergart[i].height_shift = ilog2(h);
1491		usergart[i].stride_pfn = tiler_stride(fmts[i], 0) >> PAGE_SHIFT;
1492		usergart[i].slot_shift = ilog2((PAGE_SIZE / h) >> i);
1493		for (j = 0; j < NUM_USERGART_ENTRIES; j++) {
1494			struct omap_drm_usergart_entry *entry;
1495			struct tiler_block *block;
1496
1497			entry = &usergart[i].entry[j];
1498			block = tiler_reserve_2d(fmts[i], w, h, PAGE_SIZE);
1499			if (IS_ERR(block)) {
1500				dev_err(dev->dev,
1501						"reserve failed: %d, %d, %ld\n",
1502						i, j, PTR_ERR(block));
1503				return;
1504			}
1505			entry->dma_addr = tiler_ssptr(block);
1506			entry->block = block;
1507
1508			DBG("%d:%d: %dx%d: dma_addr=%pad stride=%d", i, j, w, h,
1509					&entry->dma_addr,
1510					usergart[i].stride_pfn << PAGE_SHIFT);
1511		}
1512	}
1513
1514	priv->usergart = usergart;
1515	priv->has_dmm = true;
1516}
1517
1518void omap_gem_deinit(struct drm_device *dev)
1519{
1520	struct omap_drm_private *priv = dev->dev_private;
1521
1522	/* I believe we can rely on there being no more outstanding GEM
1523	 * objects which could depend on usergart/dmm at this point.
1524	 */
1525	kfree(priv->usergart);
1526}