[mirror_ubuntu-artful-kernel.git] / drivers / staging / gma500 / gem.c

/*
 *  psb GEM interface
 *
 * Copyright (c) 2011, Intel Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * Authors: Alan Cox
 *
 * TODO:
 *	-	we need to work out if the MMU is relevant (eg for
 *		accelerated operations on a GEM object)
 */

#include <drm/drmP.h>
#include <drm/drm.h>
#include "psb_drm.h"
#include "psb_drv.h"

int psb_gem_init_object(struct drm_gem_object *obj)
{
	return -EINVAL;
}

void psb_gem_free_object(struct drm_gem_object *obj)
{
	struct gtt_range *gtt = container_of(obj, struct gtt_range, gem);
	drm_gem_object_release_wrap(obj);
	/* This must occur last as it frees up the memory of the GEM object */
	psb_gtt_free_range(obj->dev, gtt);
}

int psb_gem_get_aperture(struct drm_device *dev, void *data,
				struct drm_file *file)
{
	return -EINVAL;
}

/**
 *	psb_gem_dumb_map_gtt	-	buffer mapping for dumb interface
 *	@file: our drm client file
 *	@dev: drm device
 *	@handle: GEM handle to the object (from dumb_create)
 *
 *	Do the necessary setup to allow the mapping of the frame buffer
 *	into user memory. We don't have to do much here at the moment.
 */
int psb_gem_dumb_map_gtt(struct drm_file *file, struct drm_device *dev,
			 uint32_t handle, uint64_t *offset)
{
	int ret = 0;
	struct drm_gem_object *obj;

	if (!(dev->driver->driver_features & DRIVER_GEM))
		return -ENODEV;

	mutex_lock(&dev->struct_mutex);

	/* GEM does all our handle to object mapping */
	obj = drm_gem_object_lookup(dev, file, handle);
	if (obj == NULL) {
		ret = -ENOENT;
		goto unlock;
	}
	/* What validation is needed here ? */

	/* Make it mmapable */
	if (!obj->map_list.map) {
		ret = gem_create_mmap_offset(obj);
		if (ret)
			goto out;
	}
	/* GEM should really work out the hash offsets for us */
	*offset = (u64)obj->map_list.hash.key << PAGE_SHIFT;
out:
	drm_gem_object_unreference(obj);
unlock:
	mutex_unlock(&dev->struct_mutex);
	return ret;
}

/**
 *	psb_gem_create		-	create a mappable object
 *	@file: the DRM file of the client
 *	@dev: our device
 *	@size: the size requested
 *	@handlep: returned handle (opaque number)
 *
 *	Create a GEM object, fill in the boilerplate and attach a handle to
 *	it so that userspace can speak about it. This does the core work
 *	for the various methods that do/will create GEM objects for things
 */
static int psb_gem_create(struct drm_file *file,
	struct drm_device *dev, uint64_t size, uint32_t *handlep)
{
	struct gtt_range *r;
	int ret;
	u32 handle;

	size = roundup(size, PAGE_SIZE);

	/* Allocate our object - for now a direct gtt range which is not
	   stolen memory backed */
	r = psb_gtt_alloc_range(dev, size, "gem", 0);
	if (r == NULL) {
		dev_err(dev->dev, "no memory for %lld byte GEM object\n", size);
		return -ENOSPC;
	}
	/* Initialize the extra goodies GEM needs to do all the hard work */
	if (drm_gem_object_init(dev, &r->gem, size) != 0) {
		psb_gtt_free_range(dev, r);
		/* GEM doesn't give an error code so use -ENOMEM */
		dev_err(dev->dev, "GEM init failed for %lld\n", size);
		return -ENOMEM;
	}
	/* Give the object a handle so we can carry it more easily */
	ret = drm_gem_handle_create(file, &r->gem, &handle);
	if (ret) {
		dev_err(dev->dev, "GEM handle failed for %p, %lld\n",
							&r->gem, size);
		drm_gem_object_release(&r->gem);
		psb_gtt_free_range(dev, r);
		return ret;
	}
	/* We have the initial and handle reference but need only one now */
	drm_gem_object_unreference(&r->gem);
	*handlep = handle;
	return 0;
}

/**
 *	psb_gem_dumb_create	-	create a dumb buffer
 *	@drm_file: our client file
 *	@dev: our device
 *	@args: the requested arguments copied from userspace
 *
 *	Allocate a buffer suitable for use for a frame buffer of the
 *	form described by user space. Give userspace a handle by which
 *	to reference it.
 */
int psb_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
			struct drm_mode_create_dumb *args)
{
	args->pitch = ALIGN(args->width * ((args->bpp + 7) / 8), 64);
	args->size = args->pitch * args->height;
	return psb_gem_create(file, dev, args->size, &args->handle);
}

/**
 *	psb_gem_dumb_destroy	-	destroy a dumb buffer
 *	@file: client file
 *	@dev: our DRM device
 *	@handle: the object handle
 *
 *	Destroy a handle that was created via psb_gem_dumb_create, at least
 *	we hope it was created that way. i915 seems to assume the caller
 *	does the checking but that might be worth review ! FIXME
 */
int psb_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev,
			uint32_t handle)
{
	/* No special work needed, drop the reference and see what falls out */
	return drm_gem_handle_delete(file, handle);
}

/**
 *	psb_gem_fault		-	pagefault handler for GEM objects
 *	@vma: the VMA of the GEM object
 *	@vmf: fault detail
 *
 *	Invoked when a fault occurs on an mmap of a GEM managed area. GEM
 *	does most of the work for us including the actual map/unmap calls
 *	but we need to do the actual page work.
 *
 *	This code eventually needs to handle faulting objects in and out
 *	of the GTT and repacking it when we run out of space. We can put
 *	that off for now and for our simple uses
 *
 *	The VMA was set up by GEM. In doing so it also ensured that the
 *	vma->vm_private_data points to the GEM object that is backing this
 *	mapping.
 */
int psb_gem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
{
	struct drm_gem_object *obj;
	struct gtt_range *r;
	int ret;
	unsigned long pfn;
	pgoff_t page_offset;
	struct drm_device *dev;
	struct drm_psb_private *dev_priv;

	obj = vma->vm_private_data;	/* GEM object */
	dev = obj->dev;
	dev_priv = dev->dev_private;

	r = container_of(obj, struct gtt_range, gem);	/* Get the gtt range */

	/* Make sure we don't parallel update on a fault, nor move or remove
	   something from beneath our feet */
	mutex_lock(&dev->struct_mutex);

	/* For now the mmap pins the object and it stays pinned. As things
	   stand that will do us no harm */
	if (r->mmapping == 0) {
		ret = psb_gtt_pin(r);
		if (ret < 0) {
			dev_err(dev->dev, "gma500: pin failed: %d\n", ret);
			goto fail;
		}
		r->mmapping = 1;
	}

	/* Page relative to the VMA start - we must calculate this ourselves
	   because vmf->pgoff is the fake GEM offset */
	page_offset = ((unsigned long) vmf->virtual_address - vma->vm_start)
				>> PAGE_SHIFT;

	/* CPU view of the page, don't go via the GART for CPU writes */
	if (r->stolen)
		pfn = (dev_priv->stolen_base + r->offset) >> PAGE_SHIFT;
	else
		pfn = page_to_pfn(r->pages[page_offset]);
	ret = vm_insert_pfn(vma, (unsigned long)vmf->virtual_address, pfn);

fail:
	mutex_unlock(&dev->struct_mutex);
	switch (ret) {
	case 0:
	case -ERESTARTSYS:
	case -EINTR:
		return VM_FAULT_NOPAGE;
	case -ENOMEM:
		return VM_FAULT_OOM;
	default:
		return VM_FAULT_SIGBUS;
	}
}

static int psb_gem_create_stolen(struct drm_file *file, struct drm_device *dev,
						int size, u32 *handle)
{
	struct gtt_range *gtt = psb_gtt_alloc_range(dev, size, "gem", 1);
	if (gtt == NULL)
		return -ENOMEM;
	if (drm_gem_private_object_init(dev, &gtt->gem, size) != 0)
		goto free_gtt;
	if (drm_gem_handle_create(file, &gtt->gem, handle) == 0)
		return 0;
free_gtt:
	psb_gtt_free_range(dev, gtt);
	return -ENOMEM;
}

/*
 *	GEM interfaces for our specific client
 */
int psb_gem_create_ioctl(struct drm_device *dev, void *data,
					struct drm_file *file)
{
	struct drm_psb_gem_create *args = data;
	int ret;
	if (args->flags & PSB_GEM_CREATE_STOLEN) {
		ret = psb_gem_create_stolen(file, dev, args->size,
							&args->handle);
		if (ret == 0)
			return 0;
		/* Fall throguh */
		args->flags &= ~PSB_GEM_CREATE_STOLEN;
	}
	return psb_gem_create(file, dev, args->size, &args->handle);
}

int psb_gem_mmap_ioctl(struct drm_device *dev, void *data,
					struct drm_file *file)
{
	struct drm_psb_gem_mmap *args = data;
	return dev->driver->dumb_map_offset(file, dev,
						args->handle, &args->offset);
}
Commit	Line	Data
f20ee244	1	/*
7ed2911c	2	* psb GEM interface
f20ee244 AC	3	*
	4	* Copyright (c) 2011, Intel Corporation.
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms and conditions of the GNU General Public License,
	8	* version 2, as published by the Free Software Foundation.
	9	*
	10	* This program is distributed in the hope it will be useful, but WITHOUT
	11	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	12	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	13	* more details.
	14	*
	15	* You should have received a copy of the GNU General Public License along with
	16	* this program; if not, write to the Free Software Foundation, Inc.,
	17	* 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
	18	*
	19	* Authors: Alan Cox
	20	*
	21	* TODO:
5338afdf	22	* - we need to work out if the MMU is relevant (eg for
f20ee244	23	* accelerated operations on a GEM object)
f20ee244 AC	24	*/
	25
	26	#include <drm/drmP.h>
	27	#include <drm/drm.h>
	28	#include "psb_drm.h"
	29	#include "psb_drv.h"
	30
	31	int psb_gem_init_object(struct drm_gem_object *obj)
	32	{
	33	return -EINVAL;
	34	}
	35
	36	void psb_gem_free_object(struct drm_gem_object *obj)
	37	{
9886eb59	38	struct gtt_range *gtt = container_of(obj, struct gtt_range, gem);
2cf10d23	39	drm_gem_object_release_wrap(obj);
fb7ff7f6 AC	40	/* This must occur last as it frees up the memory of the GEM object */
fb7ff7f6 AC	41	psb_gtt_free_range(obj->dev, gtt);
f20ee244 AC	42	}
	43
	44	int psb_gem_get_aperture(struct drm_device dev, void data,
	45	struct drm_file *file)
	46	{
	47	return -EINVAL;
	48	}
	49
	50	/**
	51	* psb_gem_dumb_map_gtt - buffer mapping for dumb interface
	52	* @file: our drm client file
	53	* @dev: drm device
	54	* @handle: GEM handle to the object (from dumb_create)
	55	*
	56	* Do the necessary setup to allow the mapping of the frame buffer
	57	* into user memory. We don't have to do much here at the moment.
	58	*/
	59	int psb_gem_dumb_map_gtt(struct drm_file file, struct drm_device dev,
	60	uint32_t handle, uint64_t *offset)
	61	{
0c4ac072	62	int ret = 0;
f20ee244	63	struct drm_gem_object *obj;
0c4ac072	64
f20ee244 AC	65	if (!(dev->driver->driver_features & DRIVER_GEM))
f20ee244 AC	66	return -ENODEV;
e2e88603	67
0c4ac072 AC	68	mutex_lock(&dev->struct_mutex);
0c4ac072 AC	69
f20ee244 AC	70	/* GEM does all our handle to object mapping */
f20ee244 AC	71	obj = drm_gem_object_lookup(dev, file, handle);
0c4ac072 AC	72	if (obj == NULL) {
	73	ret = -ENOENT;
	74	goto unlock;
	75	}
f20ee244	76	/* What validation is needed here ? */
e2e88603	77
0c4ac072 AC	78	/* Make it mmapable */
0c4ac072 AC	79	if (!obj->map_list.map) {
eee9b52e	80	ret = gem_create_mmap_offset(obj);
0c4ac072 AC	81	if (ret)
	82	goto out;
	83	}
	84	/* GEM should really work out the hash offsets for us */
f20ee244	85	*offset = (u64)obj->map_list.hash.key << PAGE_SHIFT;
0c4ac072	86	out:
f20ee244	87	drm_gem_object_unreference(obj);
0c4ac072 AC	88	unlock:
	89	mutex_unlock(&dev->struct_mutex);
	90	return ret;
f20ee244 AC	91	}
	92
	93	/**
	94	* psb_gem_create - create a mappable object
	95	* @file: the DRM file of the client
	96	* @dev: our device
	97	* @size: the size requested
	98	* @handlep: returned handle (opaque number)
	99	*
	100	* Create a GEM object, fill in the boilerplate and attach a handle to
	101	* it so that userspace can speak about it. This does the core work
	102	* for the various methods that do/will create GEM objects for things
	103	*/
	104	static int psb_gem_create(struct drm_file *file,
	105	struct drm_device dev, uint64_t size, uint32_t handlep)
	106	{
	107	struct gtt_range *r;
	108	int ret;
	109	u32 handle;
	110
	111	size = roundup(size, PAGE_SIZE);
	112
e2e88603	113	/* Allocate our object - for now a direct gtt range which is not
f20ee244 AC	114	stolen memory backed */
f20ee244 AC	115	r = psb_gtt_alloc_range(dev, size, "gem", 0);
daab23f1 AC	116	if (r == NULL) {
daab23f1 AC	117	dev_err(dev->dev, "no memory for %lld byte GEM object\n", size);
f92e8834	118	return -ENOSPC;
daab23f1	119	}
f20ee244 AC	120	/* Initialize the extra goodies GEM needs to do all the hard work */
	121	if (drm_gem_object_init(dev, &r->gem, size) != 0) {
	122	psb_gtt_free_range(dev, r);
6b8402b5	123	/* GEM doesn't give an error code so use -ENOMEM */
daab23f1	124	dev_err(dev->dev, "GEM init failed for %lld\n", size);
f20ee244 AC	125	return -ENOMEM;
	126	}
	127	/* Give the object a handle so we can carry it more easily */
	128	ret = drm_gem_handle_create(file, &r->gem, &handle);
	129	if (ret) {
daab23f1 AC	130	dev_err(dev->dev, "GEM handle failed for %p, %lld\n",
daab23f1 AC	131	&r->gem, size);
f20ee244 AC	132	drm_gem_object_release(&r->gem);
	133	psb_gtt_free_range(dev, r);
	134	return ret;
	135	}
	136	/* We have the initial and handle reference but need only one now */
	137	drm_gem_object_unreference(&r->gem);
	138	*handlep = handle;
	139	return 0;
	140	}
	141
	142	/**
	143	* psb_gem_dumb_create - create a dumb buffer
	144	* @drm_file: our client file
	145	* @dev: our device
	146	* @args: the requested arguments copied from userspace
	147	*
	148	* Allocate a buffer suitable for use for a frame buffer of the
	149	* form described by user space. Give userspace a handle by which
	150	* to reference it.
	151	*/
	152	int psb_gem_dumb_create(struct drm_file file, struct drm_device dev,
	153	struct drm_mode_create_dumb *args)
	154	{
f92e8834	155	args->pitch = ALIGN(args->width * ((args->bpp + 7) / 8), 64);
f20ee244 AC	156	args->size = args->pitch * args->height;
	157	return psb_gem_create(file, dev, args->size, &args->handle);
	158	}
	159
	160	/**
	161	* psb_gem_dumb_destroy - destroy a dumb buffer
	162	* @file: client file
	163	* @dev: our DRM device
	164	* @handle: the object handle
	165	*
	166	* Destroy a handle that was created via psb_gem_dumb_create, at least
	167	* we hope it was created that way. i915 seems to assume the caller
	168	* does the checking but that might be worth review ! FIXME
	169	*/
	170	int psb_gem_dumb_destroy(struct drm_file file, struct drm_device dev,
	171	uint32_t handle)
	172	{
	173	/* No special work needed, drop the reference and see what falls out */
	174	return drm_gem_handle_delete(file, handle);
	175	}
	176
	177	/**
	178	* psb_gem_fault - pagefault handler for GEM objects
	179	* @vma: the VMA of the GEM object
	180	* @vmf: fault detail
	181	*
	182	* Invoked when a fault occurs on an mmap of a GEM managed area. GEM
	183	* does most of the work for us including the actual map/unmap calls
	184	* but we need to do the actual page work.
	185	*
	186	* This code eventually needs to handle faulting objects in and out
fb7ff7f6	187	* of the GTT and repacking it when we run out of space. We can put
f20ee244 AC	188	* that off for now and for our simple uses
	189	*
	190	* The VMA was set up by GEM. In doing so it also ensured that the
	191	* vma->vm_private_data points to the GEM object that is backing this
	192	* mapping.
	193	*/
	194	int psb_gem_fault(struct vm_area_struct vma, struct vm_fault vmf)
	195	{
	196	struct drm_gem_object *obj;
	197	struct gtt_range *r;
	198	int ret;
	199	unsigned long pfn;
	200	pgoff_t page_offset;
7ed2911c	201	struct drm_device *dev;
2cf10d23	202	struct drm_psb_private *dev_priv;
f20ee244 AC	203
f20ee244 AC	204	obj = vma->vm_private_data; /* GEM object */
7ed2911c	205	dev = obj->dev;
2cf10d23	206	dev_priv = dev->dev_private;
7ed2911c	207
f20ee244 AC	208	r = container_of(obj, struct gtt_range, gem); /* Get the gtt range */
f20ee244 AC	209
7ed2911c AC	210	/* Make sure we don't parallel update on a fault, nor move or remove
	211	something from beneath our feet */
	212	mutex_lock(&dev->struct_mutex);
	213
	214	/* For now the mmap pins the object and it stays pinned. As things
	215	stand that will do us no harm */
	216	if (r->mmapping == 0) {
	217	ret = psb_gtt_pin(r);
	218	if (ret < 0) {
e2e88603 AC	219	dev_err(dev->dev, "gma500: pin failed: %d\n", ret);
	220	goto fail;
	221	}
7ed2911c AC	222	r->mmapping = 1;
	223	}
	224
fb7ff7f6 AC	225	/* Page relative to the VMA start - we must calculate this ourselves
fb7ff7f6 AC	226	because vmf->pgoff is the fake GEM offset */
f20ee244 AC	227	page_offset = ((unsigned long) vmf->virtual_address - vma->vm_start)
	228	>> PAGE_SHIFT;
	229
2cf10d23 AC	230	/* CPU view of the page, don't go via the GART for CPU writes */
	231	if (r->stolen)
	232	pfn = (dev_priv->stolen_base + r->offset) >> PAGE_SHIFT;
	233	else
	234	pfn = page_to_pfn(r->pages[page_offset]);
f20ee244	235	ret = vm_insert_pfn(vma, (unsigned long)vmf->virtual_address, pfn);
7ed2911c AC	236
7ed2911c AC	237	fail:
e2e88603	238	mutex_unlock(&dev->struct_mutex);
f20ee244 AC	239	switch (ret) {
	240	case 0:
	241	case -ERESTARTSYS:
	242	case -EINTR:
	243	return VM_FAULT_NOPAGE;
	244	case -ENOMEM:
	245	return VM_FAULT_OOM;
	246	default:
	247	return VM_FAULT_SIGBUS;
	248	}
	249	}
c5c44531	250
7d7b7adf AC	251	static int psb_gem_create_stolen(struct drm_file file, struct drm_device dev,
	252	int size, u32 *handle)
	253	{
	254	struct gtt_range *gtt = psb_gtt_alloc_range(dev, size, "gem", 1);
	255	if (gtt == NULL)
	256	return -ENOMEM;
	257	if (drm_gem_private_object_init(dev, &gtt->gem, size) != 0)
	258	goto free_gtt;
	259	if (drm_gem_handle_create(file, &gtt->gem, handle) == 0)
	260	return 0;
	261	free_gtt:
	262	psb_gtt_free_range(dev, gtt);
	263	return -ENOMEM;
	264	}
	265
c5c44531 AC	266	/*
	267	* GEM interfaces for our specific client
	268	*/
	269	int psb_gem_create_ioctl(struct drm_device dev, void data,
	270	struct drm_file *file)
	271	{
	272	struct drm_psb_gem_create *args = data;
7d7b7adf AC	273	int ret;
	274	if (args->flags & PSB_GEM_CREATE_STOLEN) {
	275	ret = psb_gem_create_stolen(file, dev, args->size,
	276	&args->handle);
	277	if (ret == 0)
	278	return 0;
	279	/* Fall throguh */
	280	args->flags &= ~PSB_GEM_CREATE_STOLEN;
	281	}
c5c44531 AC	282	return psb_gem_create(file, dev, args->size, &args->handle);
	283	}
	284
7dfe43c5 AC	285	int psb_gem_mmap_ioctl(struct drm_device dev, void data,
	286	struct drm_file *file)
	287	{
	288	struct drm_psb_gem_mmap *args = data;
	289	return dev->driver->dumb_map_offset(file, dev,
	290	args->handle, &args->offset);
	291	}
	292