drivers/gpu/drm/i915/i915_gem_stolen.c - kernel/msm-4.9 - Gitiles

 /*
  * Copyright © 2008-2012 Intel Corporation
  *
  * Permission is hereby granted, free of charge, to any person obtaining a
  * copy of this software and associated documentation files (the "Software"),
  * to deal in the Software without restriction, including without limitation
  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  * and/or sell copies of the Software, and to permit persons to whom the
  * Software is furnished to do so, subject to the following conditions:
  *
  * The above copyright notice and this permission notice (including the next
  * paragraph) shall be included in all copies or substantial portions of the
  * Software.
  *
  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
  * IN THE SOFTWARE.
  *
  * Authors:
  *    Eric Anholt <eric@anholt.net>
  *    Chris Wilson <chris@chris-wilson.co.uk>
  *
  */

 #include <drm/drmP.h>
 #include <drm/i915_drm.h>
 #include "i915_drv.h"

 #define KB(x) ((x) * 1024)
 #define MB(x) (KB(x) * 1024)

 /*
  * The BIOS typically reserves some of the system's memory for the exclusive
  * use of the integrated graphics. This memory is no longer available for
  * use by the OS and so the user finds that his system has less memory
  * available than he put in. We refer to this memory as stolen.
  *
  * The BIOS will allocate its framebuffer from the stolen memory. Our
  * goal is try to reuse that object for our own fbcon which must always
  * be available for panics. Anything else we can reuse the stolen memory
  * for is a boon.
  */

 int i915_gem_stolen_insert_node_in_range(struct drm_i915_private *dev_priv,
 					 struct drm_mm_node *node, u64 size,
 					 unsigned alignment, u64 start, u64 end)
 {
 	int ret;

 	if (!drm_mm_initialized(&dev_priv->mm.stolen))
 		return -ENODEV;

 	/* See the comment at the drm_mm_init() call for more about this check.
 	 * WaSkipStolenMemoryFirstPage:bdw,chv (incomplete) */
 	if (INTEL_INFO(dev_priv)->gen == 8 && start < 4096)
 		start = 4096;

 	mutex_lock(&dev_priv->mm.stolen_lock);
 	ret = drm_mm_insert_node_in_range(&dev_priv->mm.stolen, node, size,
 					  alignment, start, end,
 					  DRM_MM_SEARCH_DEFAULT);
 	mutex_unlock(&dev_priv->mm.stolen_lock);

 	return ret;
 }

 int i915_gem_stolen_insert_node(struct drm_i915_private *dev_priv,
 				struct drm_mm_node *node, u64 size,
 				unsigned alignment)
 {
 	return i915_gem_stolen_insert_node_in_range(dev_priv, node, size,
 					alignment, 0,
 					dev_priv->gtt.stolen_usable_size);
 }

 void i915_gem_stolen_remove_node(struct drm_i915_private *dev_priv,
 				 struct drm_mm_node *node)
 {
 	mutex_lock(&dev_priv->mm.stolen_lock);
 	drm_mm_remove_node(node);
 	mutex_unlock(&dev_priv->mm.stolen_lock);
 }

 static unsigned long i915_stolen_to_physical(struct drm_device *dev)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;
 	struct resource *r;
 	u32 base;

 	/* Almost universally we can find the Graphics Base of Stolen Memory
 	 * at offset 0x5c in the igfx configuration space. On a few (desktop)
 	 * machines this is also mirrored in the bridge device at different
 	 * locations, or in the MCHBAR.
 	 *
 	 * On 865 we just check the TOUD register.
 	 *
 	 * On 830/845/85x the stolen memory base isn't available in any
 	 * register. We need to calculate it as TOM-TSEG_SIZE-stolen_size.
 	 *
 	 */
 	base = 0;
 	if (INTEL_INFO(dev)->gen >= 3) {
 		/* Read Graphics Base of Stolen Memory directly */
 		pci_read_config_dword(dev->pdev, 0x5c, &base);
 		base &= ~((1<<20) - 1);
 	} else if (IS_I865G(dev)) {
 		u16 toud = 0;

 		/*
 		 * FIXME is the graphics stolen memory region
 		 * always at TOUD? Ie. is it always the last
 		 * one to be allocated by the BIOS?
 		 */
 		pci_bus_read_config_word(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I865_TOUD, &toud);

 		base = toud << 16;
 	} else if (IS_I85X(dev)) {
 		u32 tseg_size = 0;
 		u32 tom;
 		u8 tmp;

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I85X_ESMRAMC, &tmp);

 		if (tmp & TSEG_ENABLE)
 			tseg_size = MB(1);

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 1),
 					 I85X_DRB3, &tmp);
 		tom = tmp * MB(32);

 		base = tom - tseg_size - dev_priv->gtt.stolen_size;
 	} else if (IS_845G(dev)) {
 		u32 tseg_size = 0;
 		u32 tom;
 		u8 tmp;

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I845_ESMRAMC, &tmp);

 		if (tmp & TSEG_ENABLE) {
 			switch (tmp & I845_TSEG_SIZE_MASK) {
 			case I845_TSEG_SIZE_512K:
 				tseg_size = KB(512);
 				break;
 			case I845_TSEG_SIZE_1M:
 				tseg_size = MB(1);
 				break;
 			}
 		}

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I830_DRB3, &tmp);
 		tom = tmp * MB(32);

 		base = tom - tseg_size - dev_priv->gtt.stolen_size;
 	} else if (IS_I830(dev)) {
 		u32 tseg_size = 0;
 		u32 tom;
 		u8 tmp;

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I830_ESMRAMC, &tmp);

 		if (tmp & TSEG_ENABLE) {
 			if (tmp & I830_TSEG_SIZE_1M)
 				tseg_size = MB(1);
 			else
 				tseg_size = KB(512);
 		}

 		pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
 					 I830_DRB3, &tmp);
 		tom = tmp * MB(32);

 		base = tom - tseg_size - dev_priv->gtt.stolen_size;
 	}

 	if (base == 0)
 		return 0;

 	/* make sure we don't clobber the GTT if it's within stolen memory */
 	if (INTEL_INFO(dev)->gen <= 4 && !IS_G33(dev) && !IS_G4X(dev)) {
 		struct {
 			u32 start, end;
 		} stolen[2] = {
 			{ .start = base, .end = base + dev_priv->gtt.stolen_size, },
 			{ .start = base, .end = base + dev_priv->gtt.stolen_size, },
 		};
 		u64 gtt_start, gtt_end;

 		gtt_start = I915_READ(PGTBL_CTL);
 		if (IS_GEN4(dev))
 			gtt_start = (gtt_start & PGTBL_ADDRESS_LO_MASK) |
 				(gtt_start & PGTBL_ADDRESS_HI_MASK) << 28;
 		else
 			gtt_start &= PGTBL_ADDRESS_LO_MASK;
 		gtt_end = gtt_start + gtt_total_entries(dev_priv->gtt) * 4;

 		if (gtt_start >= stolen[0].start && gtt_start < stolen[0].end)
 			stolen[0].end = gtt_start;
 		if (gtt_end > stolen[1].start && gtt_end <= stolen[1].end)
 			stolen[1].start = gtt_end;

 		/* pick the larger of the two chunks */
 		if (stolen[0].end - stolen[0].start >
 		    stolen[1].end - stolen[1].start) {
 			base = stolen[0].start;
 			dev_priv->gtt.stolen_size = stolen[0].end - stolen[0].start;
 		} else {
 			base = stolen[1].start;
 			dev_priv->gtt.stolen_size = stolen[1].end - stolen[1].start;
 		}

 		if (stolen[0].start != stolen[1].start ||
 		    stolen[0].end != stolen[1].end) {
 			DRM_DEBUG_KMS("GTT within stolen memory at 0x%llx-0x%llx\n",
 				      (unsigned long long) gtt_start,
 				      (unsigned long long) gtt_end - 1);
 			DRM_DEBUG_KMS("Stolen memory adjusted to 0x%x-0x%x\n",
 				      base, base + (u32) dev_priv->gtt.stolen_size - 1);
 		}
 	}


 	/* Verify that nothing else uses this physical address. Stolen
 	 * memory should be reserved by the BIOS and hidden from the
 	 * kernel. So if the region is already marked as busy, something
 	 * is seriously wrong.
 	 */
 	r = devm_request_mem_region(dev->dev, base, dev_priv->gtt.stolen_size,
 				    "Graphics Stolen Memory");
 	if (r == NULL) {
 		/*
 		 * One more attempt but this time requesting region from
 		 * base + 1, as we have seen that this resolves the region
 		 * conflict with the PCI Bus.
 		 * This is a BIOS w/a: Some BIOS wrap stolen in the root
 		 * PCI bus, but have an off-by-one error. Hence retry the
 		 * reservation starting from 1 instead of 0.
 		 */
 		r = devm_request_mem_region(dev->dev, base + 1,
 					    dev_priv->gtt.stolen_size - 1,
 					    "Graphics Stolen Memory");
 		/*
 		 * GEN3 firmware likes to smash pci bridges into the stolen
 		 * range. Apparently this works.
 		 */
 		if (r == NULL && !IS_GEN3(dev)) {
 			DRM_ERROR("conflict detected with stolen region: [0x%08x - 0x%08x]\n",
 				  base, base + (uint32_t)dev_priv->gtt.stolen_size);
 			base = 0;
 		}
 	}

 	return base;
 }

 void i915_gem_cleanup_stolen(struct drm_device *dev)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;

 	if (!drm_mm_initialized(&dev_priv->mm.stolen))
 		return;

 	drm_mm_takedown(&dev_priv->mm.stolen);
 }

 static void g4x_get_stolen_reserved(struct drm_i915_private *dev_priv,
 				    unsigned long *base, unsigned long *size)
 {
 	uint32_t reg_val = I915_READ(IS_GM45(dev_priv) ?
 				     CTG_STOLEN_RESERVED :
 				     ELK_STOLEN_RESERVED);
 	unsigned long stolen_top = dev_priv->mm.stolen_base +
 		dev_priv->gtt.stolen_size;

 	*base = (reg_val & G4X_STOLEN_RESERVED_ADDR2_MASK) << 16;

 	WARN_ON((reg_val & G4X_STOLEN_RESERVED_ADDR1_MASK) < *base);

 	/* On these platforms, the register doesn't have a size field, so the
 	 * size is the distance between the base and the top of the stolen
 	 * memory. We also have the genuine case where base is zero and there's
 	 * nothing reserved. */
 	if (*base == 0)
 		*size = 0;
 	else
 		*size = stolen_top - *base;
 }

 static void gen6_get_stolen_reserved(struct drm_i915_private *dev_priv,
 				     unsigned long *base, unsigned long *size)
 {
 	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

 	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

 	switch (reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK) {
 	case GEN6_STOLEN_RESERVED_1M:
 		*size = 1024 * 1024;
 		break;
 	case GEN6_STOLEN_RESERVED_512K:
 		*size = 512 * 1024;
 		break;
 	case GEN6_STOLEN_RESERVED_256K:
 		*size = 256 * 1024;
 		break;
 	case GEN6_STOLEN_RESERVED_128K:
 		*size = 128 * 1024;
 		break;
 	default:
 		*size = 1024 * 1024;
 		MISSING_CASE(reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK);
 	}
 }

 static void gen7_get_stolen_reserved(struct drm_i915_private *dev_priv,
 				     unsigned long *base, unsigned long *size)
 {
 	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

 	*base = reg_val & GEN7_STOLEN_RESERVED_ADDR_MASK;

 	switch (reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK) {
 	case GEN7_STOLEN_RESERVED_1M:
 		*size = 1024 * 1024;
 		break;
 	case GEN7_STOLEN_RESERVED_256K:
 		*size = 256 * 1024;
 		break;
 	default:
 		*size = 1024 * 1024;
 		MISSING_CASE(reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK);
 	}
 }

 static void gen8_get_stolen_reserved(struct drm_i915_private *dev_priv,
 				     unsigned long *base, unsigned long *size)
 {
 	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

 	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

 	switch (reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK) {
 	case GEN8_STOLEN_RESERVED_1M:
 		*size = 1024 * 1024;
 		break;
 	case GEN8_STOLEN_RESERVED_2M:
 		*size = 2 * 1024 * 1024;
 		break;
 	case GEN8_STOLEN_RESERVED_4M:
 		*size = 4 * 1024 * 1024;
 		break;
 	case GEN8_STOLEN_RESERVED_8M:
 		*size = 8 * 1024 * 1024;
 		break;
 	default:
 		*size = 8 * 1024 * 1024;
 		MISSING_CASE(reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK);
 	}
 }

 static void bdw_get_stolen_reserved(struct drm_i915_private *dev_priv,
 				    unsigned long *base, unsigned long *size)
 {
 	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
 	unsigned long stolen_top;

 	stolen_top = dev_priv->mm.stolen_base + dev_priv->gtt.stolen_size;

 	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

 	/* On these platforms, the register doesn't have a size field, so the
 	 * size is the distance between the base and the top of the stolen
 	 * memory. We also have the genuine case where base is zero and there's
 	 * nothing reserved. */
 	if (*base == 0)
 		*size = 0;
 	else
 		*size = stolen_top - *base;
 }

 int i915_gem_init_stolen(struct drm_device *dev)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;
 	unsigned long reserved_total, reserved_base = 0, reserved_size;
 	unsigned long stolen_top;

 	mutex_init(&dev_priv->mm.stolen_lock);

 #ifdef CONFIG_INTEL_IOMMU
 	if (intel_iommu_gfx_mapped && INTEL_INFO(dev)->gen < 8) {
 		DRM_INFO("DMAR active, disabling use of stolen memory\n");
 		return 0;
 	}
 #endif

 	if (dev_priv->gtt.stolen_size == 0)
 		return 0;

 	dev_priv->mm.stolen_base = i915_stolen_to_physical(dev);
 	if (dev_priv->mm.stolen_base == 0)
 		return 0;

 	stolen_top = dev_priv->mm.stolen_base + dev_priv->gtt.stolen_size;

 	switch (INTEL_INFO(dev_priv)->gen) {
 	case 2:
 	case 3:
 		break;
 	case 4:
 		if (IS_G4X(dev))
 			g4x_get_stolen_reserved(dev_priv, &reserved_base,
 						&reserved_size);
 		break;
 	case 5:
 		/* Assume the gen6 maximum for the older platforms. */
 		reserved_size = 1024 * 1024;
 		reserved_base = stolen_top - reserved_size;
 		break;
 	case 6:
 		gen6_get_stolen_reserved(dev_priv, &reserved_base,
 					 &reserved_size);
 		break;
 	case 7:
 		gen7_get_stolen_reserved(dev_priv, &reserved_base,
 					 &reserved_size);
 		break;
 	default:
 		if (IS_BROADWELL(dev_priv) || IS_SKYLAKE(dev_priv))
 			bdw_get_stolen_reserved(dev_priv, &reserved_base,
 						&reserved_size);
 		else
 			gen8_get_stolen_reserved(dev_priv, &reserved_base,
 						 &reserved_size);
 		break;
 	}

 	/* It is possible for the reserved base to be zero, but the register
 	 * field for size doesn't have a zero option. */
 	if (reserved_base == 0) {
 		reserved_size = 0;
 		reserved_base = stolen_top;
 	}

 	if (reserved_base < dev_priv->mm.stolen_base ||
 	    reserved_base + reserved_size > stolen_top) {
 		DRM_DEBUG_KMS("Stolen reserved area [0x%08lx - 0x%08lx] outside stolen memory [0x%08lx - 0x%08lx]\n",
 			      reserved_base, reserved_base + reserved_size,
 			      dev_priv->mm.stolen_base, stolen_top);
 		return 0;
 	}

 	/* It is possible for the reserved area to end before the end of stolen
 	 * memory, so just consider the start. */
 	reserved_total = stolen_top - reserved_base;

 	DRM_DEBUG_KMS("Memory reserved for graphics device: %zuK, usable: %luK\n",
 		      dev_priv->gtt.stolen_size >> 10,
 		      (dev_priv->gtt.stolen_size - reserved_total) >> 10);

 	dev_priv->gtt.stolen_usable_size = dev_priv->gtt.stolen_size -
 					   reserved_total;

 	/*
 	 * Basic memrange allocator for stolen space.
 	 *
 	 * TODO: Notice that some platforms require us to not use the first page
 	 * of the stolen memory but their BIOSes may still put the framebuffer
 	 * on the first page. So we don't reserve this page for now because of
 	 * that. Our current solution is to just prevent new nodes from being
 	 * inserted on the first page - see the check we have at
 	 * i915_gem_stolen_insert_node_in_range(). We may want to fix the fbcon
 	 * problem later.
 	 */
 	drm_mm_init(&dev_priv->mm.stolen, 0, dev_priv->gtt.stolen_usable_size);

 	return 0;
 }

 static struct sg_table *
 i915_pages_create_for_stolen(struct drm_device *dev,
 			     u32 offset, u32 size)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;
 	struct sg_table *st;
 	struct scatterlist *sg;

 	DRM_DEBUG_DRIVER("offset=0x%x, size=%d\n", offset, size);
 	BUG_ON(offset > dev_priv->gtt.stolen_size - size);

 	/* We hide that we have no struct page backing our stolen object
 	 * by wrapping the contiguous physical allocation with a fake
 	 * dma mapping in a single scatterlist.
 	 */

 	st = kmalloc(sizeof(*st), GFP_KERNEL);
 	if (st == NULL)
 		return NULL;

 	if (sg_alloc_table(st, 1, GFP_KERNEL)) {
 		kfree(st);
 		return NULL;
 	}

 	sg = st->sgl;
 	sg->offset = 0;
 	sg->length = size;

 	sg_dma_address(sg) = (dma_addr_t)dev_priv->mm.stolen_base + offset;
 	sg_dma_len(sg) = size;

 	return st;
 }

 static int i915_gem_object_get_pages_stolen(struct drm_i915_gem_object *obj)
 {
 	BUG();
 	return -EINVAL;
 }

 static void i915_gem_object_put_pages_stolen(struct drm_i915_gem_object *obj)
 {
 	/* Should only be called during free */
 	sg_free_table(obj->pages);
 	kfree(obj->pages);
 }


 static void
 i915_gem_object_release_stolen(struct drm_i915_gem_object *obj)
 {
 	struct drm_i915_private *dev_priv = obj->base.dev->dev_private;

 	if (obj->stolen) {
 		i915_gem_stolen_remove_node(dev_priv, obj->stolen);
 		kfree(obj->stolen);
 		obj->stolen = NULL;
 	}
 }
 static const struct drm_i915_gem_object_ops i915_gem_object_stolen_ops = {
 	.get_pages = i915_gem_object_get_pages_stolen,
 	.put_pages = i915_gem_object_put_pages_stolen,
 	.release = i915_gem_object_release_stolen,
 };

 static struct drm_i915_gem_object *
 _i915_gem_object_create_stolen(struct drm_device *dev,
 			       struct drm_mm_node *stolen)
 {
 	struct drm_i915_gem_object *obj;

 	obj = i915_gem_object_alloc(dev);
 	if (obj == NULL)
 		return NULL;

 	drm_gem_private_object_init(dev, &obj->base, stolen->size);
 	i915_gem_object_init(obj, &i915_gem_object_stolen_ops);

 	obj->pages = i915_pages_create_for_stolen(dev,
 						  stolen->start, stolen->size);
 	if (obj->pages == NULL)
 		goto cleanup;

 	i915_gem_object_pin_pages(obj);
 	obj->stolen = stolen;

 	obj->base.read_domains = I915_GEM_DOMAIN_CPU | I915_GEM_DOMAIN_GTT;
 	obj->cache_level = HAS_LLC(dev) ? I915_CACHE_LLC : I915_CACHE_NONE;

 	return obj;

 cleanup:
 	i915_gem_object_free(obj);
 	return NULL;
 }

 struct drm_i915_gem_object *
 i915_gem_object_create_stolen(struct drm_device *dev, u32 size)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;
 	struct drm_i915_gem_object *obj;
 	struct drm_mm_node *stolen;
 	int ret;

 	if (!drm_mm_initialized(&dev_priv->mm.stolen))
 		return NULL;

 	DRM_DEBUG_KMS("creating stolen object: size=%x\n", size);
 	if (size == 0)
 		return NULL;

 	stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
 	if (!stolen)
 		return NULL;

 	ret = i915_gem_stolen_insert_node(dev_priv, stolen, size, 4096);
 	if (ret) {
 		kfree(stolen);
 		return NULL;
 	}

 	obj = _i915_gem_object_create_stolen(dev, stolen);
 	if (obj)
 		return obj;

 	i915_gem_stolen_remove_node(dev_priv, stolen);
 	kfree(stolen);
 	return NULL;
 }

 struct drm_i915_gem_object *
 i915_gem_object_create_stolen_for_preallocated(struct drm_device *dev,
 					       u32 stolen_offset,
 					       u32 gtt_offset,
 					       u32 size)
 {
 	struct drm_i915_private *dev_priv = dev->dev_private;
 	struct i915_address_space *ggtt = &dev_priv->gtt.base;
 	struct drm_i915_gem_object *obj;
 	struct drm_mm_node *stolen;
 	struct i915_vma *vma;
 	int ret;

 	if (!drm_mm_initialized(&dev_priv->mm.stolen))
 		return NULL;

 	DRM_DEBUG_KMS("creating preallocated stolen object: stolen_offset=%x, gtt_offset=%x, size=%x\n",
 			stolen_offset, gtt_offset, size);

 	/* KISS and expect everything to be page-aligned */
 	if (WARN_ON(size == 0) || WARN_ON(size & 4095) ||
 	    WARN_ON(stolen_offset & 4095))
 		return NULL;

 	stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
 	if (!stolen)
 		return NULL;

 	stolen->start = stolen_offset;
 	stolen->size = size;
 	mutex_lock(&dev_priv->mm.stolen_lock);
 	ret = drm_mm_reserve_node(&dev_priv->mm.stolen, stolen);
 	mutex_unlock(&dev_priv->mm.stolen_lock);
 	if (ret) {
 		DRM_DEBUG_KMS("failed to allocate stolen space\n");
 		kfree(stolen);
 		return NULL;
 	}

 	obj = _i915_gem_object_create_stolen(dev, stolen);
 	if (obj == NULL) {
 		DRM_DEBUG_KMS("failed to allocate stolen object\n");
 		i915_gem_stolen_remove_node(dev_priv, stolen);
 		kfree(stolen);
 		return NULL;
 	}

 	/* Some objects just need physical mem from stolen space */
 	if (gtt_offset == I915_GTT_OFFSET_NONE)
 		return obj;

 	vma = i915_gem_obj_lookup_or_create_vma(obj, ggtt);
 	if (IS_ERR(vma)) {
 		ret = PTR_ERR(vma);
 		goto err;
 	}

 	/* To simplify the initialisation sequence between KMS and GTT,
 	 * we allow construction of the stolen object prior to
 	 * setting up the GTT space. The actual reservation will occur
 	 * later.
 	 */
 	vma->node.start = gtt_offset;
 	vma->node.size = size;
 	if (drm_mm_initialized(&ggtt->mm)) {
 		ret = drm_mm_reserve_node(&ggtt->mm, &vma->node);
 		if (ret) {
 			DRM_DEBUG_KMS("failed to allocate stolen GTT space\n");
 			goto err;
 		}

 		vma->bound |= GLOBAL_BIND;
 		list_add_tail(&vma->mm_list, &ggtt->inactive_list);
 	}

 	list_add_tail(&obj->global_list, &dev_priv->mm.bound_list);
 	i915_gem_object_pin_pages(obj);

 	return obj;

 err:
 	drm_gem_object_unreference(&obj->base);
 	return NULL;
 }
	/*
	* Copyright © 2008-2012 Intel Corporation
	*
	* Permission is hereby granted, free of charge, to any person obtaining a
	* copy of this software and associated documentation files (the "Software"),
	* to deal in the Software without restriction, including without limitation
	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	* and/or sell copies of the Software, and to permit persons to whom the
	* Software is furnished to do so, subject to the following conditions:
	*
	* The above copyright notice and this permission notice (including the next
	* paragraph) shall be included in all copies or substantial portions of the
	* Software.
	*
	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
	* IN THE SOFTWARE.
	*
	* Authors:
	* Eric Anholt <eric@anholt.net>
	* Chris Wilson <chris@chris-wilson.co.uk>
	*
	*/

	#include <drm/drmP.h>
	#include <drm/i915_drm.h>
	#include "i915_drv.h"

	#define KB(x) ((x) * 1024)
	#define MB(x) (KB(x) * 1024)

	/*
	* The BIOS typically reserves some of the system's memory for the exclusive
	* use of the integrated graphics. This memory is no longer available for
	* use by the OS and so the user finds that his system has less memory
	* available than he put in. We refer to this memory as stolen.
	*
	* The BIOS will allocate its framebuffer from the stolen memory. Our
	* goal is try to reuse that object for our own fbcon which must always
	* be available for panics. Anything else we can reuse the stolen memory
	* for is a boon.
	*/

	int i915_gem_stolen_insert_node_in_range(struct drm_i915_private *dev_priv,
	struct drm_mm_node *node, u64 size,
	unsigned alignment, u64 start, u64 end)
	{
	int ret;

	if (!drm_mm_initialized(&dev_priv->mm.stolen))
	return -ENODEV;

	/* See the comment at the drm_mm_init() call for more about this check.
	* WaSkipStolenMemoryFirstPage:bdw,chv (incomplete) */
	if (INTEL_INFO(dev_priv)->gen == 8 && start < 4096)
	start = 4096;

	mutex_lock(&dev_priv->mm.stolen_lock);
	ret = drm_mm_insert_node_in_range(&dev_priv->mm.stolen, node, size,
	alignment, start, end,
	DRM_MM_SEARCH_DEFAULT);
	mutex_unlock(&dev_priv->mm.stolen_lock);

	return ret;
	}

	int i915_gem_stolen_insert_node(struct drm_i915_private *dev_priv,
	struct drm_mm_node *node, u64 size,
	unsigned alignment)
	{
	return i915_gem_stolen_insert_node_in_range(dev_priv, node, size,
	alignment, 0,
	dev_priv->gtt.stolen_usable_size);
	}

	void i915_gem_stolen_remove_node(struct drm_i915_private *dev_priv,
	struct drm_mm_node *node)
	{
	mutex_lock(&dev_priv->mm.stolen_lock);
	drm_mm_remove_node(node);
	mutex_unlock(&dev_priv->mm.stolen_lock);
	}

	static unsigned long i915_stolen_to_physical(struct drm_device *dev)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct resource *r;
	u32 base;

	/* Almost universally we can find the Graphics Base of Stolen Memory
	* at offset 0x5c in the igfx configuration space. On a few (desktop)
	* machines this is also mirrored in the bridge device at different
	* locations, or in the MCHBAR.
	*
	* On 865 we just check the TOUD register.
	*
	* On 830/845/85x the stolen memory base isn't available in any
	* register. We need to calculate it as TOM-TSEG_SIZE-stolen_size.
	*
	*/
	base = 0;
	if (INTEL_INFO(dev)->gen >= 3) {
	/* Read Graphics Base of Stolen Memory directly */
	pci_read_config_dword(dev->pdev, 0x5c, &base);
	base &= ~((1<<20) - 1);
	} else if (IS_I865G(dev)) {
	u16 toud = 0;

	/*
	* FIXME is the graphics stolen memory region
	* always at TOUD? Ie. is it always the last
	* one to be allocated by the BIOS?
	*/
	pci_bus_read_config_word(dev->pdev->bus, PCI_DEVFN(0, 0),
	I865_TOUD, &toud);

	base = toud << 16;
	} else if (IS_I85X(dev)) {
	u32 tseg_size = 0;
	u32 tom;
	u8 tmp;

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
	I85X_ESMRAMC, &tmp);

	if (tmp & TSEG_ENABLE)
	tseg_size = MB(1);

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 1),
	I85X_DRB3, &tmp);
	tom = tmp * MB(32);

	base = tom - tseg_size - dev_priv->gtt.stolen_size;
	} else if (IS_845G(dev)) {
	u32 tseg_size = 0;
	u32 tom;
	u8 tmp;

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
	I845_ESMRAMC, &tmp);

	if (tmp & TSEG_ENABLE) {
	switch (tmp & I845_TSEG_SIZE_MASK) {
	case I845_TSEG_SIZE_512K:
	tseg_size = KB(512);
	break;
	case I845_TSEG_SIZE_1M:
	tseg_size = MB(1);
	break;
	}
	}

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
	I830_DRB3, &tmp);
	tom = tmp * MB(32);

	base = tom - tseg_size - dev_priv->gtt.stolen_size;
	} else if (IS_I830(dev)) {
	u32 tseg_size = 0;
	u32 tom;
	u8 tmp;

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
	I830_ESMRAMC, &tmp);

	if (tmp & TSEG_ENABLE) {
	if (tmp & I830_TSEG_SIZE_1M)
	tseg_size = MB(1);
	else
	tseg_size = KB(512);
	}

	pci_bus_read_config_byte(dev->pdev->bus, PCI_DEVFN(0, 0),
	I830_DRB3, &tmp);
	tom = tmp * MB(32);

	base = tom - tseg_size - dev_priv->gtt.stolen_size;
	}

	if (base == 0)
	return 0;

	/* make sure we don't clobber the GTT if it's within stolen memory */
	if (INTEL_INFO(dev)->gen <= 4 && !IS_G33(dev) && !IS_G4X(dev)) {
	struct {
	u32 start, end;
	} stolen[2] = {
	{ .start = base, .end = base + dev_priv->gtt.stolen_size, },
	{ .start = base, .end = base + dev_priv->gtt.stolen_size, },
	};
	u64 gtt_start, gtt_end;

	gtt_start = I915_READ(PGTBL_CTL);
	if (IS_GEN4(dev))
	gtt_start = (gtt_start & PGTBL_ADDRESS_LO_MASK) \|
	(gtt_start & PGTBL_ADDRESS_HI_MASK) << 28;
	else
	gtt_start &= PGTBL_ADDRESS_LO_MASK;
	gtt_end = gtt_start + gtt_total_entries(dev_priv->gtt) * 4;

	if (gtt_start >= stolen[0].start && gtt_start < stolen[0].end)
	stolen[0].end = gtt_start;
	if (gtt_end > stolen[1].start && gtt_end <= stolen[1].end)
	stolen[1].start = gtt_end;

	/* pick the larger of the two chunks */
	if (stolen[0].end - stolen[0].start >
	stolen[1].end - stolen[1].start) {
	base = stolen[0].start;
	dev_priv->gtt.stolen_size = stolen[0].end - stolen[0].start;
	} else {
	base = stolen[1].start;
	dev_priv->gtt.stolen_size = stolen[1].end - stolen[1].start;
	}

	if (stolen[0].start != stolen[1].start \|\|
	stolen[0].end != stolen[1].end) {
	DRM_DEBUG_KMS("GTT within stolen memory at 0x%llx-0x%llx\n",
	(unsigned long long) gtt_start,
	(unsigned long long) gtt_end - 1);
	DRM_DEBUG_KMS("Stolen memory adjusted to 0x%x-0x%x\n",
	base, base + (u32) dev_priv->gtt.stolen_size - 1);
	}
	}


	/* Verify that nothing else uses this physical address. Stolen
	* memory should be reserved by the BIOS and hidden from the
	* kernel. So if the region is already marked as busy, something
	* is seriously wrong.
	*/
	r = devm_request_mem_region(dev->dev, base, dev_priv->gtt.stolen_size,
	"Graphics Stolen Memory");
	if (r == NULL) {
	/*
	* One more attempt but this time requesting region from
	* base + 1, as we have seen that this resolves the region
	* conflict with the PCI Bus.
	* This is a BIOS w/a: Some BIOS wrap stolen in the root
	* PCI bus, but have an off-by-one error. Hence retry the
	* reservation starting from 1 instead of 0.
	*/
	r = devm_request_mem_region(dev->dev, base + 1,
	dev_priv->gtt.stolen_size - 1,
	"Graphics Stolen Memory");
	/*
	* GEN3 firmware likes to smash pci bridges into the stolen
	* range. Apparently this works.
	*/
	if (r == NULL && !IS_GEN3(dev)) {
	DRM_ERROR("conflict detected with stolen region: [0x%08x - 0x%08x]\n",
	base, base + (uint32_t)dev_priv->gtt.stolen_size);
	base = 0;
	}
	}

	return base;
	}

	void i915_gem_cleanup_stolen(struct drm_device *dev)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;

	if (!drm_mm_initialized(&dev_priv->mm.stolen))
	return;

	drm_mm_takedown(&dev_priv->mm.stolen);
	}

	static void g4x_get_stolen_reserved(struct drm_i915_private *dev_priv,
	unsigned long base, unsigned long size)
	{
	uint32_t reg_val = I915_READ(IS_GM45(dev_priv) ?
	CTG_STOLEN_RESERVED :
	ELK_STOLEN_RESERVED);
	unsigned long stolen_top = dev_priv->mm.stolen_base +
	dev_priv->gtt.stolen_size;

	*base = (reg_val & G4X_STOLEN_RESERVED_ADDR2_MASK) << 16;

	WARN_ON((reg_val & G4X_STOLEN_RESERVED_ADDR1_MASK) < *base);

	/* On these platforms, the register doesn't have a size field, so the
	* size is the distance between the base and the top of the stolen
	* memory. We also have the genuine case where base is zero and there's
	* nothing reserved. */
	if (*base == 0)
	*size = 0;
	else
	size = stolen_top - base;
	}

	static void gen6_get_stolen_reserved(struct drm_i915_private *dev_priv,
	unsigned long base, unsigned long size)
	{
	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

	switch (reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK) {
	case GEN6_STOLEN_RESERVED_1M:
	size = 1024 1024;
	break;
	case GEN6_STOLEN_RESERVED_512K:
	size = 512 1024;
	break;
	case GEN6_STOLEN_RESERVED_256K:
	size = 256 1024;
	break;
	case GEN6_STOLEN_RESERVED_128K:
	size = 128 1024;
	break;
	default:
	size = 1024 1024;
	MISSING_CASE(reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK);
	}
	}

	static void gen7_get_stolen_reserved(struct drm_i915_private *dev_priv,
	unsigned long base, unsigned long size)
	{
	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

	*base = reg_val & GEN7_STOLEN_RESERVED_ADDR_MASK;

	switch (reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK) {
	case GEN7_STOLEN_RESERVED_1M:
	size = 1024 1024;
	break;
	case GEN7_STOLEN_RESERVED_256K:
	size = 256 1024;
	break;
	default:
	size = 1024 1024;
	MISSING_CASE(reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK);
	}
	}

	static void gen8_get_stolen_reserved(struct drm_i915_private *dev_priv,
	unsigned long base, unsigned long size)
	{
	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);

	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

	switch (reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK) {
	case GEN8_STOLEN_RESERVED_1M:
	size = 1024 1024;
	break;
	case GEN8_STOLEN_RESERVED_2M:
	size = 2 1024 * 1024;
	break;
	case GEN8_STOLEN_RESERVED_4M:
	size = 4 1024 * 1024;
	break;
	case GEN8_STOLEN_RESERVED_8M:
	size = 8 1024 * 1024;
	break;
	default:
	size = 8 1024 * 1024;
	MISSING_CASE(reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK);
	}
	}

	static void bdw_get_stolen_reserved(struct drm_i915_private *dev_priv,
	unsigned long base, unsigned long size)
	{
	uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
	unsigned long stolen_top;

	stolen_top = dev_priv->mm.stolen_base + dev_priv->gtt.stolen_size;

	*base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;

	/* On these platforms, the register doesn't have a size field, so the
	* size is the distance between the base and the top of the stolen
	* memory. We also have the genuine case where base is zero and there's
	* nothing reserved. */
	if (*base == 0)
	*size = 0;
	else
	size = stolen_top - base;
	}

	int i915_gem_init_stolen(struct drm_device *dev)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;
	unsigned long reserved_total, reserved_base = 0, reserved_size;
	unsigned long stolen_top;

	mutex_init(&dev_priv->mm.stolen_lock);

	#ifdef CONFIG_INTEL_IOMMU
	if (intel_iommu_gfx_mapped && INTEL_INFO(dev)->gen < 8) {
	DRM_INFO("DMAR active, disabling use of stolen memory\n");
	return 0;
	}
	#endif

	if (dev_priv->gtt.stolen_size == 0)
	return 0;

	dev_priv->mm.stolen_base = i915_stolen_to_physical(dev);
	if (dev_priv->mm.stolen_base == 0)
	return 0;

	stolen_top = dev_priv->mm.stolen_base + dev_priv->gtt.stolen_size;

	switch (INTEL_INFO(dev_priv)->gen) {
	case 2:
	case 3:
	break;
	case 4:
	if (IS_G4X(dev))
	g4x_get_stolen_reserved(dev_priv, &reserved_base,
	&reserved_size);
	break;
	case 5:
	/* Assume the gen6 maximum for the older platforms. */
	reserved_size = 1024 * 1024;
	reserved_base = stolen_top - reserved_size;
	break;
	case 6:
	gen6_get_stolen_reserved(dev_priv, &reserved_base,
	&reserved_size);
	break;
	case 7:
	gen7_get_stolen_reserved(dev_priv, &reserved_base,
	&reserved_size);
	break;
	default:
	if (IS_BROADWELL(dev_priv) \|\| IS_SKYLAKE(dev_priv))
	bdw_get_stolen_reserved(dev_priv, &reserved_base,
	&reserved_size);
	else
	gen8_get_stolen_reserved(dev_priv, &reserved_base,
	&reserved_size);
	break;
	}

	/* It is possible for the reserved base to be zero, but the register
	* field for size doesn't have a zero option. */
	if (reserved_base == 0) {
	reserved_size = 0;
	reserved_base = stolen_top;
	}

	if (reserved_base < dev_priv->mm.stolen_base \|\|
	reserved_base + reserved_size > stolen_top) {
	DRM_DEBUG_KMS("Stolen reserved area [0x%08lx - 0x%08lx] outside stolen memory [0x%08lx - 0x%08lx]\n",
	reserved_base, reserved_base + reserved_size,
	dev_priv->mm.stolen_base, stolen_top);
	return 0;
	}

	/* It is possible for the reserved area to end before the end of stolen
	* memory, so just consider the start. */
	reserved_total = stolen_top - reserved_base;

	DRM_DEBUG_KMS("Memory reserved for graphics device: %zuK, usable: %luK\n",
	dev_priv->gtt.stolen_size >> 10,
	(dev_priv->gtt.stolen_size - reserved_total) >> 10);

	dev_priv->gtt.stolen_usable_size = dev_priv->gtt.stolen_size -
	reserved_total;

	/*
	* Basic memrange allocator for stolen space.
	*
	* TODO: Notice that some platforms require us to not use the first page
	* of the stolen memory but their BIOSes may still put the framebuffer
	* on the first page. So we don't reserve this page for now because of
	* that. Our current solution is to just prevent new nodes from being
	* inserted on the first page - see the check we have at
	* i915_gem_stolen_insert_node_in_range(). We may want to fix the fbcon
	* problem later.
	*/
	drm_mm_init(&dev_priv->mm.stolen, 0, dev_priv->gtt.stolen_usable_size);

	return 0;
	}

	static struct sg_table *
	i915_pages_create_for_stolen(struct drm_device *dev,
	u32 offset, u32 size)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct sg_table *st;
	struct scatterlist *sg;

	DRM_DEBUG_DRIVER("offset=0x%x, size=%d\n", offset, size);
	BUG_ON(offset > dev_priv->gtt.stolen_size - size);

	/* We hide that we have no struct page backing our stolen object
	* by wrapping the contiguous physical allocation with a fake
	* dma mapping in a single scatterlist.
	*/

	st = kmalloc(sizeof(*st), GFP_KERNEL);
	if (st == NULL)
	return NULL;

	if (sg_alloc_table(st, 1, GFP_KERNEL)) {
	kfree(st);
	return NULL;
	}

	sg = st->sgl;
	sg->offset = 0;
	sg->length = size;

	sg_dma_address(sg) = (dma_addr_t)dev_priv->mm.stolen_base + offset;
	sg_dma_len(sg) = size;

	return st;
	}

	static int i915_gem_object_get_pages_stolen(struct drm_i915_gem_object *obj)
	{
	BUG();
	return -EINVAL;
	}

	static void i915_gem_object_put_pages_stolen(struct drm_i915_gem_object *obj)
	{
	/* Should only be called during free */
	sg_free_table(obj->pages);
	kfree(obj->pages);
	}


	static void
	i915_gem_object_release_stolen(struct drm_i915_gem_object *obj)
	{
	struct drm_i915_private *dev_priv = obj->base.dev->dev_private;

	if (obj->stolen) {
	i915_gem_stolen_remove_node(dev_priv, obj->stolen);
	kfree(obj->stolen);
	obj->stolen = NULL;
	}
	}
	static const struct drm_i915_gem_object_ops i915_gem_object_stolen_ops = {
	.get_pages = i915_gem_object_get_pages_stolen,
	.put_pages = i915_gem_object_put_pages_stolen,
	.release = i915_gem_object_release_stolen,
	};

	static struct drm_i915_gem_object *
	_i915_gem_object_create_stolen(struct drm_device *dev,
	struct drm_mm_node *stolen)
	{
	struct drm_i915_gem_object *obj;

	obj = i915_gem_object_alloc(dev);
	if (obj == NULL)
	return NULL;

	drm_gem_private_object_init(dev, &obj->base, stolen->size);
	i915_gem_object_init(obj, &i915_gem_object_stolen_ops);

	obj->pages = i915_pages_create_for_stolen(dev,
	stolen->start, stolen->size);
	if (obj->pages == NULL)
	goto cleanup;

	i915_gem_object_pin_pages(obj);
	obj->stolen = stolen;

	obj->base.read_domains = I915_GEM_DOMAIN_CPU \| I915_GEM_DOMAIN_GTT;
	obj->cache_level = HAS_LLC(dev) ? I915_CACHE_LLC : I915_CACHE_NONE;

	return obj;

	cleanup:
	i915_gem_object_free(obj);
	return NULL;
	}

	struct drm_i915_gem_object *
	i915_gem_object_create_stolen(struct drm_device *dev, u32 size)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct drm_i915_gem_object *obj;
	struct drm_mm_node *stolen;
	int ret;

	if (!drm_mm_initialized(&dev_priv->mm.stolen))
	return NULL;

	DRM_DEBUG_KMS("creating stolen object: size=%x\n", size);
	if (size == 0)
	return NULL;

	stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
	if (!stolen)
	return NULL;

	ret = i915_gem_stolen_insert_node(dev_priv, stolen, size, 4096);
	if (ret) {
	kfree(stolen);
	return NULL;
	}

	obj = _i915_gem_object_create_stolen(dev, stolen);
	if (obj)
	return obj;

	i915_gem_stolen_remove_node(dev_priv, stolen);
	kfree(stolen);
	return NULL;
	}

	struct drm_i915_gem_object *
	i915_gem_object_create_stolen_for_preallocated(struct drm_device *dev,
	u32 stolen_offset,
	u32 gtt_offset,
	u32 size)
	{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct i915_address_space *ggtt = &dev_priv->gtt.base;
	struct drm_i915_gem_object *obj;
	struct drm_mm_node *stolen;
	struct i915_vma *vma;
	int ret;

	if (!drm_mm_initialized(&dev_priv->mm.stolen))
	return NULL;

	DRM_DEBUG_KMS("creating preallocated stolen object: stolen_offset=%x, gtt_offset=%x, size=%x\n",
	stolen_offset, gtt_offset, size);

	/* KISS and expect everything to be page-aligned */
	if (WARN_ON(size == 0) \|\| WARN_ON(size & 4095) \|\|
	WARN_ON(stolen_offset & 4095))
	return NULL;

	stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
	if (!stolen)
	return NULL;

	stolen->start = stolen_offset;
	stolen->size = size;
	mutex_lock(&dev_priv->mm.stolen_lock);
	ret = drm_mm_reserve_node(&dev_priv->mm.stolen, stolen);
	mutex_unlock(&dev_priv->mm.stolen_lock);
	if (ret) {
	DRM_DEBUG_KMS("failed to allocate stolen space\n");
	kfree(stolen);
	return NULL;
	}

	obj = _i915_gem_object_create_stolen(dev, stolen);
	if (obj == NULL) {
	DRM_DEBUG_KMS("failed to allocate stolen object\n");
	i915_gem_stolen_remove_node(dev_priv, stolen);
	kfree(stolen);
	return NULL;
	}

	/* Some objects just need physical mem from stolen space */
	if (gtt_offset == I915_GTT_OFFSET_NONE)
	return obj;

	vma = i915_gem_obj_lookup_or_create_vma(obj, ggtt);
	if (IS_ERR(vma)) {
	ret = PTR_ERR(vma);
	goto err;
	}

	/* To simplify the initialisation sequence between KMS and GTT,
	* we allow construction of the stolen object prior to
	* setting up the GTT space. The actual reservation will occur
	* later.
	*/
	vma->node.start = gtt_offset;
	vma->node.size = size;
	if (drm_mm_initialized(&ggtt->mm)) {
	ret = drm_mm_reserve_node(&ggtt->mm, &vma->node);
	if (ret) {
	DRM_DEBUG_KMS("failed to allocate stolen GTT space\n");
	goto err;
	}

	vma->bound \|= GLOBAL_BIND;
	list_add_tail(&vma->mm_list, &ggtt->inactive_list);
	}

	list_add_tail(&obj->global_list, &dev_priv->mm.bound_list);
	i915_gem_object_pin_pages(obj);

	return obj;

	err:
	drm_gem_object_unreference(&obj->base);
	return NULL;
	}