M7350/kernel/drivers/gpu/msm/kgsl_drm.c

1576 lines
37 KiB
C
Raw Normal View History

2024-09-09 08:52:07 +00:00
/* Copyright (c) 2009-2013, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that 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.
*/
/* Implements an interface between KGSL and the DRM subsystem. For now this
* is pretty simple, but it will take on more of the workload as time goes
* on
*/
#include "drmP.h"
#include "drm.h"
#include <linux/msm_ion.h>
#include <linux/genlock.h>
#include "kgsl.h"
#include "kgsl_device.h"
#include "kgsl_drm.h"
#include "kgsl_mmu.h"
#include "kgsl_sharedmem.h"
#define DRIVER_AUTHOR "Qualcomm"
#define DRIVER_NAME "kgsl"
#define DRIVER_DESC "KGSL DRM"
#define DRIVER_DATE "20121107"
#define DRIVER_MAJOR 2
#define DRIVER_MINOR 1
#define DRIVER_PATCHLEVEL 1
#define DRM_KGSL_GEM_FLAG_MAPPED (1 << 0)
#define ENTRY_EMPTY -1
#define ENTRY_NEEDS_CLEANUP -2
#define DRM_KGSL_NOT_INITED -1
#define DRM_KGSL_INITED 1
#define DRM_KGSL_NUM_FENCE_ENTRIES (DRM_KGSL_HANDLE_WAIT_ENTRIES << 2)
#define DRM_KGSL_HANDLE_WAIT_ENTRIES 5
/* Returns true if the memory type is in PMEM */
#ifdef CONFIG_KERNEL_PMEM_SMI_REGION
#define TYPE_IS_PMEM(_t) \
(((_t & DRM_KGSL_GEM_TYPE_MEM_MASK) == DRM_KGSL_GEM_TYPE_EBI) || \
((_t & DRM_KGSL_GEM_TYPE_MEM_MASK) == DRM_KGSL_GEM_TYPE_SMI) || \
((_t) & DRM_KGSL_GEM_TYPE_PMEM))
#else
#define TYPE_IS_PMEM(_t) \
(((_t & DRM_KGSL_GEM_TYPE_MEM_MASK) == DRM_KGSL_GEM_TYPE_EBI) || \
((_t) & (DRM_KGSL_GEM_TYPE_PMEM | DRM_KGSL_GEM_PMEM_EBI)))
#endif
/* Returns true if the memory type is regular */
#define TYPE_IS_MEM(_t) \
(((_t & DRM_KGSL_GEM_TYPE_MEM_MASK) == DRM_KGSL_GEM_TYPE_KMEM) || \
((_t & DRM_KGSL_GEM_TYPE_MEM_MASK) == DRM_KGSL_GEM_TYPE_KMEM_NOCACHE) || \
((_t) & DRM_KGSL_GEM_TYPE_MEM))
#define TYPE_IS_FD(_t) ((_t) & DRM_KGSL_GEM_TYPE_FD_MASK)
/* Returns true if KMEM region is uncached */
#define IS_MEM_UNCACHED(_t) \
((_t == DRM_KGSL_GEM_TYPE_KMEM_NOCACHE) || \
(_t == DRM_KGSL_GEM_TYPE_KMEM) || \
(TYPE_IS_MEM(_t) && (_t & DRM_KGSL_GEM_CACHE_WCOMBINE)))
struct drm_kgsl_gem_object_wait_list_entry {
struct list_head list;
int pid;
int in_use;
wait_queue_head_t process_wait_q;
};
struct drm_kgsl_gem_object_fence {
int32_t fence_id;
unsigned int num_buffers;
int ts_valid;
unsigned int timestamp;
int ts_device;
int lockpid;
struct list_head buffers_in_fence;
};
struct drm_kgsl_gem_object_fence_list_entry {
struct list_head list;
int in_use;
struct drm_gem_object *gem_obj;
};
static int32_t fence_id = 0x1;
static struct drm_kgsl_gem_object_fence
gem_buf_fence[DRM_KGSL_NUM_FENCE_ENTRIES];
struct drm_kgsl_gem_object {
struct drm_gem_object *obj;
uint32_t type;
struct kgsl_memdesc memdesc;
struct kgsl_pagetable *pagetable;
struct ion_handle *ion_handle;
uint64_t mmap_offset;
int bufcount;
int flags;
struct list_head list;
int active;
struct {
uint32_t offset;
uint32_t gpuaddr;
} bufs[DRM_KGSL_GEM_MAX_BUFFERS];
struct genlock_handle *glock_handle[DRM_KGSL_GEM_MAX_BUFFERS];
int bound;
int lockpid;
/* Put these here to avoid allocing all the time */
struct drm_kgsl_gem_object_wait_list_entry
wait_entries[DRM_KGSL_HANDLE_WAIT_ENTRIES];
/* Each object can only appear in a single fence */
struct drm_kgsl_gem_object_fence_list_entry
fence_entries[DRM_KGSL_NUM_FENCE_ENTRIES];
struct list_head wait_list;
};
static struct ion_client *kgsl_drm_ion_client;
static int kgsl_drm_inited = DRM_KGSL_NOT_INITED;
/* This is a global list of all the memory currently mapped in the MMU */
static struct list_head kgsl_mem_list;
struct kgsl_drm_device_priv {
struct kgsl_device *device[KGSL_DEVICE_MAX];
struct kgsl_device_private *devpriv[KGSL_DEVICE_MAX];
};
static int
kgsl_gem_memory_allocated(struct drm_gem_object *obj)
{
struct drm_kgsl_gem_object *priv = obj->driver_private;
return priv->memdesc.size ? 1 : 0;
}
static int
kgsl_gem_alloc_memory(struct drm_gem_object *obj)
{
struct drm_kgsl_gem_object *priv = obj->driver_private;
struct kgsl_mmu *mmu;
struct sg_table *sg_table;
struct scatterlist *s;
int index;
int result = 0;
/* Return if the memory is already allocated */
if (kgsl_gem_memory_allocated(obj) || TYPE_IS_FD(priv->type))
return 0;
if (priv->pagetable == NULL) {
/* Hard coded to use A2X device for MSM7X27 and MSM8625
* Others to use A3X device
*/
#if defined(CONFIG_ARCH_MSM7X27) || defined(CONFIG_ARCH_MSM8625)
mmu = &kgsl_get_device(KGSL_DEVICE_2D0)->mmu;
#else
mmu = &kgsl_get_device(KGSL_DEVICE_3D0)->mmu;
#endif
priv->pagetable = kgsl_mmu_getpagetable(mmu,
KGSL_MMU_GLOBAL_PT);
if (priv->pagetable == NULL) {
DRM_ERROR("Unable to get the GPU MMU pagetable\n");
return -EINVAL;
}
}
if (TYPE_IS_PMEM(priv->type)) {
if (priv->type == DRM_KGSL_GEM_TYPE_EBI ||
priv->type & DRM_KGSL_GEM_PMEM_EBI) {
priv->ion_handle = ion_alloc(kgsl_drm_ion_client,
obj->size * priv->bufcount, PAGE_SIZE,
ION_HEAP(ION_SF_HEAP_ID), 0);
if (IS_ERR_OR_NULL(priv->ion_handle)) {
DRM_ERROR(
"Unable to allocate ION Phys memory handle\n");
return -ENOMEM;
}
priv->memdesc.pagetable = priv->pagetable;
result = ion_phys(kgsl_drm_ion_client,
priv->ion_handle, (ion_phys_addr_t *)
&priv->memdesc.physaddr, &priv->memdesc.size);
if (result) {
DRM_ERROR(
"Unable to get ION Physical memory address\n");
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
return result;
}
result = memdesc_sg_phys(&priv->memdesc,
priv->memdesc.physaddr, priv->memdesc.size);
if (result) {
DRM_ERROR(
"Unable to get sg list\n");
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
return result;
}
result = kgsl_mmu_map(priv->pagetable, &priv->memdesc);
if (result) {
DRM_ERROR(
"kgsl_mmu_map failed. result = %d\n", result);
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
return result;
}
}
else
return -EINVAL;
} else if (TYPE_IS_MEM(priv->type)) {
if (priv->type == DRM_KGSL_GEM_TYPE_KMEM ||
priv->type & DRM_KGSL_GEM_CACHE_MASK)
list_add(&priv->list, &kgsl_mem_list);
priv->memdesc.pagetable = priv->pagetable;
priv->ion_handle = ion_alloc(kgsl_drm_ion_client,
obj->size * priv->bufcount, PAGE_SIZE,
ION_HEAP(ION_IOMMU_HEAP_ID), 0);
if (IS_ERR_OR_NULL(priv->ion_handle)) {
DRM_ERROR(
"Unable to allocate ION IOMMU memory handle\n");
return -ENOMEM;
}
sg_table = ion_sg_table(kgsl_drm_ion_client,
priv->ion_handle);
if (IS_ERR_OR_NULL(priv->ion_handle)) {
DRM_ERROR(
"Unable to get ION sg table\n");
goto memerr;
}
priv->memdesc.sg = sg_table->sgl;
/* Calculate the size of the memdesc from the sglist */
priv->memdesc.sglen = 0;
for (s = priv->memdesc.sg; s != NULL; s = sg_next(s)) {
priv->memdesc.size += s->length;
priv->memdesc.sglen++;
}
result = kgsl_mmu_map(priv->pagetable, &priv->memdesc);
if (result) {
DRM_ERROR(
"kgsl_mmu_map failed. result = %d\n", result);
goto memerr;
}
} else
return -EINVAL;
for (index = 0; index < priv->bufcount; index++) {
priv->bufs[index].offset = index * obj->size;
priv->bufs[index].gpuaddr =
priv->memdesc.gpuaddr +
priv->bufs[index].offset;
}
priv->flags |= DRM_KGSL_GEM_FLAG_MAPPED;
return 0;
memerr:
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
return -ENOMEM;
}
static void
kgsl_gem_free_memory(struct drm_gem_object *obj)
{
struct drm_kgsl_gem_object *priv = obj->driver_private;
int index;
if (!kgsl_gem_memory_allocated(obj) || TYPE_IS_FD(priv->type))
return;
if (priv->memdesc.gpuaddr)
kgsl_mmu_unmap(priv->memdesc.pagetable, &priv->memdesc);
/* ION will take care of freeing the sg table. */
priv->memdesc.sg = NULL;
priv->memdesc.sglen = 0;
if (priv->ion_handle)
ion_free(kgsl_drm_ion_client, priv->ion_handle);
priv->ion_handle = NULL;
memset(&priv->memdesc, 0, sizeof(priv->memdesc));
for (index = 0; index < priv->bufcount; index++) {
if (priv->glock_handle[index])
genlock_put_handle(priv->glock_handle[index]);
}
kgsl_mmu_putpagetable(priv->pagetable);
priv->pagetable = NULL;
if ((priv->type == DRM_KGSL_GEM_TYPE_KMEM) ||
(priv->type & DRM_KGSL_GEM_CACHE_MASK))
list_del(&priv->list);
priv->flags &= ~DRM_KGSL_GEM_FLAG_MAPPED;
}
int
kgsl_gem_init_object(struct drm_gem_object *obj)
{
struct drm_kgsl_gem_object *priv;
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
if (priv == NULL) {
DRM_ERROR("Unable to create GEM object\n");
return -ENOMEM;
}
obj->driver_private = priv;
priv->obj = obj;
return 0;
}
void
kgsl_gem_free_object(struct drm_gem_object *obj)
{
kgsl_gem_free_memory(obj);
drm_gem_object_release(obj);
kfree(obj->driver_private);
}
int
kgsl_gem_obj_addr(int drm_fd, int handle, unsigned long *start,
unsigned long *len)
{
struct file *filp;
struct drm_device *dev;
struct drm_file *file_priv;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = 0;
filp = fget(drm_fd);
if (unlikely(filp == NULL)) {
DRM_ERROR("Unable to get the DRM file descriptor\n");
return -EINVAL;
}
file_priv = filp->private_data;
if (unlikely(file_priv == NULL)) {
DRM_ERROR("Unable to get the file private data\n");
fput(filp);
return -EINVAL;
}
dev = file_priv->minor->dev;
if (unlikely(dev == NULL)) {
DRM_ERROR("Unable to get the minor device\n");
fput(filp);
return -EINVAL;
}
obj = drm_gem_object_lookup(dev, file_priv, handle);
if (unlikely(obj == NULL)) {
DRM_ERROR("Invalid GEM handle %x\n", handle);
fput(filp);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
/* We can only use the MDP for PMEM regions */
if (TYPE_IS_PMEM(priv->type)) {
*start = priv->memdesc.physaddr +
priv->bufs[priv->active].offset;
*len = priv->memdesc.size;
} else {
*start = 0;
*len = 0;
ret = -EINVAL;
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
fput(filp);
return ret;
}
static int
kgsl_gem_init_obj(struct drm_device *dev,
struct drm_file *file_priv,
struct drm_gem_object *obj,
int *handle)
{
struct drm_kgsl_gem_object *priv;
int ret, i;
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
memset(&priv->memdesc, 0, sizeof(priv->memdesc));
priv->bufcount = 1;
priv->active = 0;
priv->bound = 0;
priv->type = DRM_KGSL_GEM_TYPE_KMEM;
ret = drm_gem_handle_create(file_priv, obj, handle);
drm_gem_object_unreference(obj);
INIT_LIST_HEAD(&priv->wait_list);
for (i = 0; i < DRM_KGSL_HANDLE_WAIT_ENTRIES; i++) {
INIT_LIST_HEAD((struct list_head *) &priv->wait_entries[i]);
priv->wait_entries[i].pid = 0;
init_waitqueue_head(&priv->wait_entries[i].process_wait_q);
}
for (i = 0; i < DRM_KGSL_NUM_FENCE_ENTRIES; i++) {
INIT_LIST_HEAD((struct list_head *) &priv->fence_entries[i]);
priv->fence_entries[i].in_use = 0;
priv->fence_entries[i].gem_obj = obj;
}
mutex_unlock(&dev->struct_mutex);
return ret;
}
int
kgsl_gem_create_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_create *create = data;
struct drm_gem_object *obj;
int ret, handle;
/* Page align the size so we can allocate multiple buffers */
create->size = ALIGN(create->size, 4096);
obj = drm_gem_object_alloc(dev, create->size);
if (obj == NULL) {
DRM_ERROR("Unable to allocate the GEM object\n");
return -ENOMEM;
}
ret = kgsl_gem_init_obj(dev, file_priv, obj, &handle);
if (ret) {
drm_gem_object_release(obj);
DRM_ERROR("Unable to initialize GEM object ret = %d\n", ret);
return ret;
}
create->handle = handle;
return 0;
}
int
kgsl_gem_create_fd_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_create_fd *args = data;
struct file *file;
dev_t rdev;
struct fb_info *info;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret, put_needed, handle;
file = fget_light(args->fd, &put_needed);
if (file == NULL) {
DRM_ERROR("Unable to get the file object\n");
return -EBADF;
}
rdev = file->f_dentry->d_inode->i_rdev;
/* Only framebuffer objects are supported ATM */
if (MAJOR(rdev) != FB_MAJOR) {
DRM_ERROR("File descriptor is not a framebuffer\n");
ret = -EBADF;
goto error_fput;
}
info = registered_fb[MINOR(rdev)];
if (info == NULL) {
DRM_ERROR("Framebuffer minor %d is not registered\n",
MINOR(rdev));
ret = -EBADF;
goto error_fput;
}
obj = drm_gem_object_alloc(dev, info->fix.smem_len);
if (obj == NULL) {
DRM_ERROR("Unable to allocate GEM object\n");
ret = -ENOMEM;
goto error_fput;
}
ret = kgsl_gem_init_obj(dev, file_priv, obj, &handle);
if (ret)
goto error_fput;
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
priv->memdesc.physaddr = info->fix.smem_start;
priv->type = DRM_KGSL_GEM_TYPE_FD_FBMEM;
mutex_unlock(&dev->struct_mutex);
args->handle = handle;
error_fput:
fput_light(file, put_needed);
return ret;
}
int
kgsl_gem_create_from_ion_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_create_from_ion *args = data;
struct drm_gem_object *obj;
struct ion_handle *ion_handle;
struct drm_kgsl_gem_object *priv;
struct sg_table *sg_table;
struct scatterlist *s;
int ret, handle;
unsigned long size;
struct kgsl_mmu *mmu;
ion_handle = ion_import_dma_buf(kgsl_drm_ion_client, args->ion_fd);
if (IS_ERR_OR_NULL(ion_handle)) {
DRM_ERROR("Unable to import dmabuf. Error number = %d\n",
(int)PTR_ERR(ion_handle));
return -EINVAL;
}
ion_handle_get_size(kgsl_drm_ion_client, ion_handle, &size);
if (size == 0) {
ion_free(kgsl_drm_ion_client, ion_handle);
DRM_ERROR(
"cannot create GEM object from zero size ION buffer\n");
return -EINVAL;
}
obj = drm_gem_object_alloc(dev, size);
if (obj == NULL) {
ion_free(kgsl_drm_ion_client, ion_handle);
DRM_ERROR("Unable to allocate the GEM object\n");
return -ENOMEM;
}
ret = kgsl_gem_init_obj(dev, file_priv, obj, &handle);
if (ret) {
ion_free(kgsl_drm_ion_client, ion_handle);
drm_gem_object_release(obj);
DRM_ERROR("Unable to initialize GEM object ret = %d\n", ret);
return ret;
}
priv = obj->driver_private;
priv->ion_handle = ion_handle;
priv->type = DRM_KGSL_GEM_TYPE_KMEM;
list_add(&priv->list, &kgsl_mem_list);
#if defined(CONFIG_ARCH_MSM7X27) || defined(CONFIG_ARCH_MSM8625)
mmu = &kgsl_get_device(KGSL_DEVICE_2D0)->mmu;
#else
mmu = &kgsl_get_device(KGSL_DEVICE_3D0)->mmu;
#endif
priv->pagetable = kgsl_mmu_getpagetable(mmu, KGSL_MMU_GLOBAL_PT);
priv->memdesc.pagetable = priv->pagetable;
sg_table = ion_sg_table(kgsl_drm_ion_client,
priv->ion_handle);
if (IS_ERR_OR_NULL(priv->ion_handle)) {
DRM_ERROR("Unable to get ION sg table\n");
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
kgsl_mmu_putpagetable(priv->pagetable);
drm_gem_object_release(obj);
kfree(priv);
return -ENOMEM;
}
priv->memdesc.sg = sg_table->sgl;
/* Calculate the size of the memdesc from the sglist */
priv->memdesc.sglen = 0;
for (s = priv->memdesc.sg; s != NULL; s = sg_next(s)) {
priv->memdesc.size += s->length;
priv->memdesc.sglen++;
}
ret = kgsl_mmu_map(priv->pagetable, &priv->memdesc);
if (ret) {
DRM_ERROR("kgsl_mmu_map failed. ret = %d\n", ret);
ion_free(kgsl_drm_ion_client,
priv->ion_handle);
priv->ion_handle = NULL;
kgsl_mmu_putpagetable(priv->pagetable);
drm_gem_object_release(obj);
kfree(priv);
return -ENOMEM;
}
priv->bufs[0].offset = 0;
priv->bufs[0].gpuaddr = priv->memdesc.gpuaddr;
priv->flags |= DRM_KGSL_GEM_FLAG_MAPPED;
args->handle = handle;
return 0;
}
int
kgsl_gem_get_ion_fd_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_get_ion_fd *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = 0;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
if (TYPE_IS_FD(priv->type))
ret = -EINVAL;
else if (TYPE_IS_PMEM(priv->type) || TYPE_IS_MEM(priv->type)) {
if (priv->ion_handle) {
args->ion_fd = ion_share_dma_buf(
kgsl_drm_ion_client, priv->ion_handle);
if (args->ion_fd < 0) {
DRM_ERROR(
"Could not share ion buffer. Error = %d\n",
args->ion_fd);
ret = -EINVAL;
}
} else {
DRM_ERROR("GEM object has no ion memory allocated.\n");
ret = -EINVAL;
}
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
int
kgsl_gem_setmemtype_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_memtype *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = 0;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
if (TYPE_IS_FD(priv->type))
ret = -EINVAL;
else {
if (TYPE_IS_PMEM(args->type) || TYPE_IS_MEM(args->type))
priv->type = args->type;
else
ret = -EINVAL;
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
int
kgsl_gem_getmemtype_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_memtype *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
args->type = priv->type;
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return 0;
}
int
kgsl_gem_unbind_gpu_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
return 0;
}
int
kgsl_gem_bind_gpu_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
return 0;
}
/* Allocate the memory and prepare it for CPU mapping */
int
kgsl_gem_alloc_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_alloc *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
ret = kgsl_gem_alloc_memory(obj);
if (ret) {
DRM_ERROR("Unable to allocate object memory\n");
}
args->offset = 0;
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
int
kgsl_gem_mmap_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
/* Ion is used for mmap at this time */
return 0;
}
/* This function is deprecated */
int
kgsl_gem_prep_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_prep *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
ret = kgsl_gem_alloc_memory(obj);
if (ret) {
DRM_ERROR("Unable to allocate object memory\n");
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return 0;
}
int
kgsl_gem_get_bufinfo_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_bufinfo *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = -EINVAL;
int index;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
if (!kgsl_gem_memory_allocated(obj)) {
DRM_ERROR("Memory not allocated for this object\n");
goto out;
}
for (index = 0; index < priv->bufcount; index++) {
args->offset[index] = priv->bufs[index].offset;
args->gpuaddr[index] = priv->bufs[index].gpuaddr;
}
args->count = priv->bufcount;
args->active = priv->active;
ret = 0;
out:
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
/* Get the genlock handles base off the GEM handle
*/
int
kgsl_gem_get_glock_handles_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_glockinfo *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int index;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
for (index = 0; index < priv->bufcount; index++) {
args->glockhandle[index] = genlock_get_fd_handle(
priv->glock_handle[index]);
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return 0;
}
int
kgsl_gem_set_glock_handles_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_glockinfo *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int index;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
for (index = 0; index < priv->bufcount; index++) {
priv->glock_handle[index] = genlock_get_handle_fd(
args->glockhandle[index]);
}
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return 0;
}
int
kgsl_gem_set_bufcount_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_bufcount *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = -EINVAL;
if (args->bufcount < 1 || args->bufcount > DRM_KGSL_GEM_MAX_BUFFERS)
return -EINVAL;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
/* It is too much math to worry about what happens if we are already
allocated, so just bail if we are */
if (kgsl_gem_memory_allocated(obj)) {
DRM_ERROR("Memory already allocated - cannot change"
"number of buffers\n");
goto out;
}
priv->bufcount = args->bufcount;
ret = 0;
out:
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
int
kgsl_gem_get_bufcount_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_bufcount *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
args->bufcount = priv->bufcount;
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return 0;
}
int
kgsl_gem_set_active_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_active *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
int ret = -EINVAL;
obj = drm_gem_object_lookup(dev, file_priv, args->handle);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", args->handle);
return -EBADF;
}
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
if (args->active < 0 || args->active >= priv->bufcount) {
DRM_ERROR("Invalid active buffer %d\n", args->active);
goto out;
}
priv->active = args->active;
ret = 0;
out:
drm_gem_object_unreference(obj);
mutex_unlock(&dev->struct_mutex);
return ret;
}
int kgsl_gem_kmem_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
{
struct drm_gem_object *obj = vma->vm_private_data;
struct drm_device *dev = obj->dev;
struct drm_kgsl_gem_object *priv;
unsigned long offset;
struct page *page;
int i;
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
offset = (unsigned long) vmf->virtual_address - vma->vm_start;
i = offset >> PAGE_SHIFT;
page = sg_page(&(priv->memdesc.sg[i]));
if (!page) {
mutex_unlock(&dev->struct_mutex);
return VM_FAULT_SIGBUS;
}
get_page(page);
vmf->page = page;
mutex_unlock(&dev->struct_mutex);
return 0;
}
int kgsl_gem_phys_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
{
struct drm_gem_object *obj = vma->vm_private_data;
struct drm_device *dev = obj->dev;
struct drm_kgsl_gem_object *priv;
unsigned long offset, pfn;
int ret = 0;
offset = ((unsigned long) vmf->virtual_address - vma->vm_start) >>
PAGE_SHIFT;
mutex_lock(&dev->struct_mutex);
priv = obj->driver_private;
pfn = (priv->memdesc.physaddr >> PAGE_SHIFT) + offset;
ret = vm_insert_pfn(vma,
(unsigned long) vmf->virtual_address, pfn);
mutex_unlock(&dev->struct_mutex);
switch (ret) {
case -ENOMEM:
case -EAGAIN:
return VM_FAULT_OOM;
case -EFAULT:
return VM_FAULT_SIGBUS;
default:
return VM_FAULT_NOPAGE;
}
}
void
cleanup_fence(struct drm_kgsl_gem_object_fence *fence, int check_waiting)
{
int j;
struct drm_kgsl_gem_object_fence_list_entry *this_fence_entry = NULL;
struct drm_kgsl_gem_object *unlock_obj;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object_wait_list_entry *lock_next;
fence->ts_valid = 0;
fence->timestamp = -1;
fence->ts_device = -1;
/* Walk the list of buffers in this fence and clean up the */
/* references. Note that this can cause memory allocations */
/* to be freed */
for (j = fence->num_buffers; j > 0; j--) {
this_fence_entry =
(struct drm_kgsl_gem_object_fence_list_entry *)
fence->buffers_in_fence.prev;
this_fence_entry->in_use = 0;
obj = this_fence_entry->gem_obj;
unlock_obj = obj->driver_private;
/* Delete it from the list */
list_del(&this_fence_entry->list);
/* we are unlocking - see if there are other pids waiting */
if (check_waiting) {
if (!list_empty(&unlock_obj->wait_list)) {
lock_next =
(struct drm_kgsl_gem_object_wait_list_entry *)
unlock_obj->wait_list.prev;
list_del((struct list_head *)&lock_next->list);
unlock_obj->lockpid = 0;
wake_up_interruptible(
&lock_next->process_wait_q);
lock_next->pid = 0;
} else {
/* List is empty so set pid to 0 */
unlock_obj->lockpid = 0;
}
}
drm_gem_object_unreference(obj);
}
/* here all the buffers in the fence are released */
/* clear the fence entry */
fence->fence_id = ENTRY_EMPTY;
}
int
find_empty_fence(void)
{
int i;
for (i = 0; i < DRM_KGSL_NUM_FENCE_ENTRIES; i++) {
if (gem_buf_fence[i].fence_id == ENTRY_EMPTY) {
gem_buf_fence[i].fence_id = fence_id++;
gem_buf_fence[i].ts_valid = 0;
INIT_LIST_HEAD(&(gem_buf_fence[i].buffers_in_fence));
if (fence_id == 0xFFFFFFF0)
fence_id = 1;
return i;
} else {
/* Look for entries to be cleaned up */
if (gem_buf_fence[i].fence_id == ENTRY_NEEDS_CLEANUP)
cleanup_fence(&gem_buf_fence[i], 0);
}
}
return ENTRY_EMPTY;
}
int
find_fence(int index)
{
int i;
for (i = 0; i < DRM_KGSL_NUM_FENCE_ENTRIES; i++) {
if (gem_buf_fence[i].fence_id == index)
return i;
}
return ENTRY_EMPTY;
}
void
wakeup_fence_entries(struct drm_kgsl_gem_object_fence *fence)
{
struct drm_kgsl_gem_object_fence_list_entry *this_fence_entry = NULL;
struct drm_kgsl_gem_object_wait_list_entry *lock_next;
struct drm_kgsl_gem_object *unlock_obj;
struct drm_gem_object *obj;
/* TS has expired when we get here */
fence->ts_valid = 0;
fence->timestamp = -1;
fence->ts_device = -1;
list_for_each_entry(this_fence_entry, &fence->buffers_in_fence, list) {
obj = this_fence_entry->gem_obj;
unlock_obj = obj->driver_private;
if (!list_empty(&unlock_obj->wait_list)) {
lock_next =
(struct drm_kgsl_gem_object_wait_list_entry *)
unlock_obj->wait_list.prev;
/* Unblock the pid */
lock_next->pid = 0;
/* Delete it from the list */
list_del((struct list_head *)&lock_next->list);
unlock_obj->lockpid = 0;
wake_up_interruptible(&lock_next->process_wait_q);
} else {
/* List is empty so set pid to 0 */
unlock_obj->lockpid = 0;
}
}
fence->fence_id = ENTRY_NEEDS_CLEANUP; /* Mark it as needing cleanup */
}
int
kgsl_gem_lock_handle_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
/* The purpose of this function is to lock a given set of handles. */
/* The driver will maintain a list of locked handles. */
/* If a request comes in for a handle that's locked the thread will */
/* block until it's no longer in use. */
struct drm_kgsl_gem_lock_handles *args = data;
struct drm_gem_object *obj;
struct drm_kgsl_gem_object *priv;
struct drm_kgsl_gem_object_fence_list_entry *this_fence_entry = NULL;
struct drm_kgsl_gem_object_fence *fence;
struct drm_kgsl_gem_object_wait_list_entry *lock_item;
int i, j;
int result = 0;
uint32_t *lock_list;
uint32_t *work_list = NULL;
int32_t fence_index;
/* copy in the data from user space */
lock_list = kzalloc(sizeof(uint32_t) * args->num_handles, GFP_KERNEL);
if (!lock_list) {
DRM_ERROR("Unable allocate memory for lock list\n");
result = -ENOMEM;
goto error;
}
if (copy_from_user(lock_list, args->handle_list,
sizeof(uint32_t) * args->num_handles)) {
DRM_ERROR("Unable to copy the lock list from the user\n");
result = -EFAULT;
goto free_handle_list;
}
work_list = lock_list;
mutex_lock(&dev->struct_mutex);
/* build the fence for this group of handles */
fence_index = find_empty_fence();
if (fence_index == ENTRY_EMPTY) {
DRM_ERROR("Unable to find a empty fence\n");
args->lock_id = 0xDEADBEEF;
result = -EFAULT;
goto out_unlock;
}
fence = &gem_buf_fence[fence_index];
gem_buf_fence[fence_index].num_buffers = args->num_handles;
args->lock_id = gem_buf_fence[fence_index].fence_id;
for (j = args->num_handles; j > 0; j--, lock_list++) {
obj = drm_gem_object_lookup(dev, file_priv, *lock_list);
if (obj == NULL) {
DRM_ERROR("Invalid GEM handle %x\n", *lock_list);
result = -EBADF;
goto out_unlock;
}
priv = obj->driver_private;
this_fence_entry = NULL;
/* get a fence entry to hook into the fence */
for (i = 0; i < DRM_KGSL_NUM_FENCE_ENTRIES; i++) {
if (!priv->fence_entries[i].in_use) {
this_fence_entry = &priv->fence_entries[i];
this_fence_entry->in_use = 1;
break;
}
}
if (this_fence_entry == NULL) {
fence->num_buffers = 0;
fence->fence_id = ENTRY_EMPTY;
args->lock_id = 0xDEADBEAD;
result = -EFAULT;
drm_gem_object_unreference(obj);
goto out_unlock;
}
/* We're trying to lock - add to a fence */
list_add((struct list_head *)this_fence_entry,
&gem_buf_fence[fence_index].buffers_in_fence);
if (priv->lockpid) {
if (priv->lockpid == args->pid) {
/* now that things are running async this */
/* happens when an op isn't done */
/* so it's already locked by the calling pid */
continue;
}
/* if a pid already had it locked */
/* create and add to wait list */
for (i = 0; i < DRM_KGSL_HANDLE_WAIT_ENTRIES; i++) {
if (priv->wait_entries[i].in_use == 0) {
/* this one is empty */
lock_item = &priv->wait_entries[i];
lock_item->in_use = 1;
lock_item->pid = args->pid;
INIT_LIST_HEAD((struct list_head *)
&priv->wait_entries[i]);
break;
}
}
if (i == DRM_KGSL_HANDLE_WAIT_ENTRIES) {
result = -EFAULT;
drm_gem_object_unreference(obj);
goto out_unlock;
}
list_add_tail((struct list_head *)&lock_item->list,
&priv->wait_list);
mutex_unlock(&dev->struct_mutex);
/* here we need to block */
wait_event_interruptible_timeout(
priv->wait_entries[i].process_wait_q,
(priv->lockpid == 0),
msecs_to_jiffies(64));
mutex_lock(&dev->struct_mutex);
lock_item->in_use = 0;
}
/* Getting here means no one currently holds the lock */
priv->lockpid = args->pid;
args->lock_id = gem_buf_fence[fence_index].fence_id;
}
fence->lockpid = args->pid;
out_unlock:
mutex_unlock(&dev->struct_mutex);
free_handle_list:
kfree(work_list);
error:
return result;
}
int
kgsl_gem_unlock_handle_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_unlock_handles *args = data;
int result = 0;
int32_t fence_index;
mutex_lock(&dev->struct_mutex);
fence_index = find_fence(args->lock_id);
if (fence_index == ENTRY_EMPTY) {
DRM_ERROR("Invalid lock ID: %x\n", args->lock_id);
result = -EFAULT;
goto out_unlock;
}
cleanup_fence(&gem_buf_fence[fence_index], 1);
out_unlock:
mutex_unlock(&dev->struct_mutex);
return result;
}
int
kgsl_gem_unlock_on_ts_ioctl(struct drm_device *dev, void *data,
struct drm_file *file_priv)
{
struct drm_kgsl_gem_unlock_on_ts *args = data;
int result = 0;
int ts_done = 0;
int32_t fence_index, ts_device;
struct drm_kgsl_gem_object_fence *fence;
struct kgsl_device *device;
if (args->type == DRM_KGSL_GEM_TS_3D)
ts_device = KGSL_DEVICE_3D0;
else if (args->type == DRM_KGSL_GEM_TS_2D)
ts_device = KGSL_DEVICE_2D0;
else {
result = -EINVAL;
goto error;
}
device = kgsl_get_device(ts_device);
ts_done = kgsl_check_timestamp(device, NULL, args->timestamp);
mutex_lock(&dev->struct_mutex);
fence_index = find_fence(args->lock_id);
if (fence_index == ENTRY_EMPTY) {
DRM_ERROR("Invalid lock ID: %x\n", args->lock_id);
result = -EFAULT;
goto out_unlock;
}
fence = &gem_buf_fence[fence_index];
fence->ts_device = ts_device;
if (!ts_done)
fence->ts_valid = 1;
else
cleanup_fence(fence, 1);
out_unlock:
mutex_unlock(&dev->struct_mutex);
error:
return result;
}
struct drm_ioctl_desc kgsl_drm_ioctls[] = {
DRM_IOCTL_DEF_DRV(KGSL_GEM_CREATE, kgsl_gem_create_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_PREP, kgsl_gem_prep_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_SETMEMTYPE, kgsl_gem_setmemtype_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_GETMEMTYPE, kgsl_gem_getmemtype_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_BIND_GPU, kgsl_gem_bind_gpu_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_UNBIND_GPU, kgsl_gem_unbind_gpu_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_ALLOC, kgsl_gem_alloc_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_MMAP, kgsl_gem_mmap_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_GET_BUFINFO, kgsl_gem_get_bufinfo_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_GET_ION_FD, kgsl_gem_get_ion_fd_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_CREATE_FROM_ION,
kgsl_gem_create_from_ion_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_SET_BUFCOUNT,
kgsl_gem_set_bufcount_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_GET_BUFCOUNT,
kgsl_gem_get_bufcount_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_SET_GLOCK_HANDLES_INFO,
kgsl_gem_set_glock_handles_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_GET_GLOCK_HANDLES_INFO,
kgsl_gem_get_glock_handles_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_SET_ACTIVE, kgsl_gem_set_active_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_LOCK_HANDLE,
kgsl_gem_lock_handle_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_UNLOCK_HANDLE,
kgsl_gem_unlock_handle_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_UNLOCK_ON_TS,
kgsl_gem_unlock_on_ts_ioctl, 0),
DRM_IOCTL_DEF_DRV(KGSL_GEM_CREATE_FD, kgsl_gem_create_fd_ioctl,
DRM_MASTER),
};
static const struct file_operations kgsl_drm_driver_fops = {
.owner = THIS_MODULE,
.open = drm_open,
.release = drm_release,
.unlocked_ioctl = drm_ioctl,
.mmap = drm_gem_mmap,
.poll = drm_poll,
.fasync = drm_fasync,
};
static struct drm_driver driver = {
.driver_features = DRIVER_GEM,
.gem_init_object = kgsl_gem_init_object,
.gem_free_object = kgsl_gem_free_object,
.ioctls = kgsl_drm_ioctls,
.fops = &kgsl_drm_driver_fops,
.name = DRIVER_NAME,
.desc = DRIVER_DESC,
.date = DRIVER_DATE,
.major = DRIVER_MAJOR,
.minor = DRIVER_MINOR,
.patchlevel = DRIVER_PATCHLEVEL,
};
int kgsl_drm_init(struct platform_device *dev)
{
int i;
/* Only initialize once */
if (kgsl_drm_inited == DRM_KGSL_INITED)
return 0;
kgsl_drm_inited = DRM_KGSL_INITED;
driver.num_ioctls = DRM_ARRAY_SIZE(kgsl_drm_ioctls);
INIT_LIST_HEAD(&kgsl_mem_list);
for (i = 0; i < DRM_KGSL_NUM_FENCE_ENTRIES; i++) {
gem_buf_fence[i].num_buffers = 0;
gem_buf_fence[i].ts_valid = 0;
gem_buf_fence[i].fence_id = ENTRY_EMPTY;
}
/* Create ION Client */
kgsl_drm_ion_client = msm_ion_client_create(
0xffffffff, "kgsl_drm");
if (!kgsl_drm_ion_client) {
DRM_ERROR("Unable to create ION client\n");
return -ENOMEM;
}
return drm_platform_init(&driver, dev);
}
void kgsl_drm_exit(void)
{
kgsl_drm_inited = DRM_KGSL_NOT_INITED;
if (kgsl_drm_ion_client)
ion_client_destroy(kgsl_drm_ion_client);
kgsl_drm_ion_client = NULL;
drm_platform_exit(&driver, driver.kdriver.platform_device);
}