gralloc960/gralloc_module.cpp - device/linaro/hikey - Git at Google

 /*
  * Copyright (C) 2010 ARM Limited. All rights reserved.
  *
  * Copyright (C) 2008 The Android Open Source Project
  *
  * Licensed under the Apache License, Version 2.0 (the "License");
  * You may not use this file except in compliance with the License.
  * You may obtain a copy of the License at
  *
  *      http://www.apache.org/licenses/LICENSE-2.0
  *
  * Unless required by applicable law or agreed to in writing, software
  * distributed under the License is distributed on an "AS IS" BASIS,
  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  * See the License for the specific language governing permissions and
  * limitations under the License.
  */

 #include <errno.h>
 #include <pthread.h>
 #include <inttypes.h>

 #include <cutils/log.h>
 #include <cutils/atomic.h>
 #include <hardware/hardware.h>
 #include <hardware/gralloc.h>

 #include "gralloc_priv.h"
 #include "gralloc_helper.h"
 #include "alloc_device.h"
 #include "framebuffer_device.h"

 #include "gralloc_module_allocator_specific.h"
 #include "gralloc_buffer_priv.h"

 #include "mali_gralloc_formats.h"

 static pthread_mutex_t s_map_lock = PTHREAD_MUTEX_INITIALIZER;

 static int gralloc_device_open(const hw_module_t* module, const char* name, hw_device_t** device)
 {
 	int status = -EINVAL;

 	if (!strncmp(name, GRALLOC_HARDWARE_GPU0, MALI_GRALLOC_HARDWARE_MAX_STR_LEN))
 	{
 		status = alloc_device_open(module, name, device);
 	}
 	else if (!strncmp(name, GRALLOC_HARDWARE_FB0, MALI_GRALLOC_HARDWARE_MAX_STR_LEN))
 	{
 		status = framebuffer_device_open(module, name, device);
 	}

 	return status;
 }

 static int gralloc_register_buffer(gralloc_module_t const* module, buffer_handle_t handle)
 {
 	GRALLOC_UNUSED(module);

 	if (private_handle_t::validate(handle) < 0)
 	{
 		AERR("Registering invalid buffer %p, returning error", handle);
 		return -EINVAL;
 	}

 	// if this handle was created in this process, then we keep it as is.
 	private_handle_t* hnd = (private_handle_t*)handle;

 	int retval = -EINVAL;

 	pthread_mutex_lock(&s_map_lock);

 	if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)
 	{
 		AINF("Register framebuffer 0x%p is no-op", handle);
 		retval = 0;
 	}
 	else if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
 	{
 		retval = gralloc_backend_register(hnd);
 	}
 	else
 	{
 		AERR("unknown buffer flags not supported. flags = %d", hnd->flags );
 	}

 	pthread_mutex_unlock(&s_map_lock);
 	return retval;
 }

 static int gralloc_unregister_buffer(gralloc_module_t const* module, buffer_handle_t handle)
 {
 	GRALLOC_UNUSED(module);

 	if (private_handle_t::validate(handle) < 0)
 	{
 		AERR("unregistering invalid buffer %p, returning error", handle);
 		return -EINVAL;
 	}

 	private_handle_t* hnd = (private_handle_t*)handle;

 	AERR_IF(hnd->lockState & private_handle_t::LOCK_STATE_READ_MASK, "[unregister] handle %p still locked (state=%08x)", hnd, hnd->lockState);

 	if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)
 	{
 		AERR( "Can't unregister buffer %p as it is a framebuffer", handle );
 	}
 	else
 	{
 		pthread_mutex_lock(&s_map_lock);

 		if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
 		{
 			gralloc_backend_unregister(hnd);
 		}
 		else
 		{
 			AERR("Unregistering unknown buffer is not supported. Flags = %d", hnd->flags);
 		}

 		/*
 		 * Close shared attribute region file descriptor. It might seem strange to "free"
 		 * this here since this can happen in a client process, but free here is nothing
 		 * but unmapping and closing the duplicated file descriptor. The original ashmem
 		 * fd instance is still open until alloc_device_free() is called. Even sharing
 		 * of gralloc buffers within the same process should have fds dup:ed.
 		 */
 		gralloc_buffer_attr_free( hnd );

 		hnd->base = 0;
 		hnd->lockState  = 0;
 		hnd->writeOwner = 0;

 		pthread_mutex_unlock(&s_map_lock);
 	}

 	return 0;
 }

 static int gralloc_lock(gralloc_module_t const* module, buffer_handle_t handle, int usage, int l, int t, int w, int h, void** vaddr)
 {
 	GRALLOC_UNUSED(module);
 	GRALLOC_UNUSED(l);
 	GRALLOC_UNUSED(t);
 	GRALLOC_UNUSED(w);
 	GRALLOC_UNUSED(h);

 	if (private_handle_t::validate(handle) < 0)
 	{
 		AERR("Locking invalid buffer %p, returning error", handle );
 		return -EINVAL;
 	}

 	private_handle_t* hnd = (private_handle_t*)handle;

 	if (hnd->req_format == HAL_PIXEL_FORMAT_YCbCr_420_888)
 	{
 		AERR("Buffers with format YCbCr_420_888 must be locked using (*lock_ycbcr)" );
 		return -EINVAL;
 	}

 	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
 	{
 		hnd->writeOwner = usage & GRALLOC_USAGE_SW_WRITE_MASK;
 	}
 	if (usage & (GRALLOC_USAGE_SW_READ_MASK | GRALLOC_USAGE_SW_WRITE_MASK))
 	{
 		*vaddr = (void*)hnd->base;
 	}
 	return 0;
 }

 static int gralloc_lock_ycbcr(gralloc_module_t const* module, buffer_handle_t handle, int usage,
                               int l, int t, int w, int h,
                               android_ycbcr *ycbcr)
 {
 	GRALLOC_UNUSED(module);
 	GRALLOC_UNUSED(l);
 	GRALLOC_UNUSED(t);
 	GRALLOC_UNUSED(w);
 	GRALLOC_UNUSED(h);

 	if (private_handle_t::validate(handle) < 0)
 	{
 		AERR("Locking invalid buffer %p, returning error", handle );
 		return -EINVAL;
 	}

 	private_handle_t* hnd = (private_handle_t*)handle;

 	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
 	{
 		hnd->writeOwner = usage & GRALLOC_USAGE_SW_WRITE_MASK;
 	}
 	if (usage & (GRALLOC_USAGE_SW_READ_MASK | GRALLOC_USAGE_SW_WRITE_MASK) &&
 		!(hnd->internal_format & MALI_GRALLOC_INTFMT_EXT_MASK))
 	{
 		char* base = (char*)hnd->base;
 		int y_stride = hnd->byte_stride;
 		/* Ensure height is aligned for subsampled chroma before calculating buffer parameters */
 		int adjusted_height = GRALLOC_ALIGN(hnd->height, 2);
 		int y_size =  y_stride * adjusted_height;

 		int u_offset = 0;
 		int v_offset = 0;
 		int c_stride = 0;
 		int step = 0;

 		uint64_t base_format = hnd->internal_format & MALI_GRALLOC_INTFMT_FMT_MASK;

 		switch (base_format)
 		{
 			case MALI_GRALLOC_FORMAT_INTERNAL_NV12:
 				c_stride = y_stride;
 				/* Y plane, UV plane */
 				u_offset = y_size;
 				v_offset = y_size + 1;
 				step = 2;
 				break;

 			case MALI_GRALLOC_FORMAT_INTERNAL_NV21:
 				c_stride = y_stride;
 				/* Y plane, UV plane */
 				v_offset = y_size;
 				u_offset = y_size + 1;
 				step = 2;
 				break;

 			case MALI_GRALLOC_FORMAT_INTERNAL_YV12:
 			{
 				int c_size;

 				/* Stride alignment set to 16 as the SW access flags were set */
 				c_stride = GRALLOC_ALIGN(hnd->byte_stride / 2, 16);
 				c_size = c_stride * (adjusted_height / 2);
 				/* Y plane, V plane, U plane */
 				v_offset = y_size;
 				u_offset = y_size + c_size;
 				step = 1;
 				break;
 			}

 			default:
 				AERR("Can't lock buffer %p: wrong format %" PRIx64, hnd, hnd->internal_format);
 				return -EINVAL;
 		}

 		ycbcr->y = base;
 		ycbcr->cb = base + u_offset;
 		ycbcr->cr = base + v_offset;
 		ycbcr->ystride = y_stride;
 		ycbcr->cstride = c_stride;
 		ycbcr->chroma_step = step;
 	}
 	return 0;
 }

 static int gralloc_unlock(gralloc_module_t const* module, buffer_handle_t handle)
 {
 	GRALLOC_UNUSED(module);

 	if (private_handle_t::validate(handle) < 0)
 	{
 		AERR( "Unlocking invalid buffer %p, returning error", handle );
 		return -EINVAL;
 	}

 	private_handle_t* hnd = (private_handle_t*)handle;

 	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION && hnd->writeOwner)
 	{
 		gralloc_backend_sync(hnd);
 	}

 	return 0;
 }

 // There is one global instance of the module

 static struct hw_module_methods_t gralloc_module_methods =
 {
 	gralloc_device_open
 };

 private_module_t::private_module_t()
 {
 #define INIT_ZERO(obj) (memset(&(obj),0,sizeof((obj))))

 	base.common.tag = HARDWARE_MODULE_TAG;
 	base.common.version_major = 1;
 	base.common.version_minor = 0;
 	base.common.id = GRALLOC_HARDWARE_MODULE_ID;
 	base.common.name = "Graphics Memory Allocator Module";
 	base.common.author = "ARM Ltd.";
 	base.common.methods = &gralloc_module_methods;
 	base.common.dso = NULL;
 	INIT_ZERO(base.common.reserved);

 	base.registerBuffer = gralloc_register_buffer;
 	base.unregisterBuffer = gralloc_unregister_buffer;
 	base.lock = gralloc_lock;
 	base.lock_ycbcr = gralloc_lock_ycbcr;
 	base.unlock = gralloc_unlock;
 	base.perform = NULL;
 	INIT_ZERO(base.reserved_proc);

 	framebuffer = NULL;
 	flags = 0;
 	numBuffers = 0;
 	bufferMask = 0;
 	pthread_mutex_init(&(lock), NULL);
 	currentBuffer = NULL;
 	INIT_ZERO(info);
 	INIT_ZERO(finfo);
 	xdpi = 0.0f;
 	ydpi = 0.0f;
 	fps = 0.0f;
 	swapInterval = 1;

 #undef INIT_ZERO
 };

 /*
  * HAL_MODULE_INFO_SYM will be initialized using the default constructor
  * implemented above
  */
 struct private_module_t HAL_MODULE_INFO_SYM;
	/*
	* Copyright (C) 2010 ARM Limited. All rights reserved.
	*
	* Copyright (C) 2008 The Android Open Source Project
	*
	* Licensed under the Apache License, Version 2.0 (the "License");
	* You may not use this file except in compliance with the License.
	* You may obtain a copy of the License at
	*
	* http://www.apache.org/licenses/LICENSE-2.0
	*
	* Unless required by applicable law or agreed to in writing, software
	* distributed under the License is distributed on an "AS IS" BASIS,
	* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
	* See the License for the specific language governing permissions and
	* limitations under the License.
	*/

	#include <errno.h>
	#include <pthread.h>
	#include <inttypes.h>

	#include <cutils/log.h>
	#include <cutils/atomic.h>
	#include <hardware/hardware.h>
	#include <hardware/gralloc.h>

	#include "gralloc_priv.h"
	#include "gralloc_helper.h"
	#include "alloc_device.h"
	#include "framebuffer_device.h"

	#include "gralloc_module_allocator_specific.h"
	#include "gralloc_buffer_priv.h"

	#include "mali_gralloc_formats.h"

	static pthread_mutex_t s_map_lock = PTHREAD_MUTEX_INITIALIZER;

	static int gralloc_device_open(const hw_module_t* module, const char* name, hw_device_t** device)
	{
	int status = -EINVAL;

	if (!strncmp(name, GRALLOC_HARDWARE_GPU0, MALI_GRALLOC_HARDWARE_MAX_STR_LEN))
	{
	status = alloc_device_open(module, name, device);
	}
	else if (!strncmp(name, GRALLOC_HARDWARE_FB0, MALI_GRALLOC_HARDWARE_MAX_STR_LEN))
	{
	status = framebuffer_device_open(module, name, device);
	}

	return status;
	}

	static int gralloc_register_buffer(gralloc_module_t const* module, buffer_handle_t handle)
	{
	GRALLOC_UNUSED(module);

	if (private_handle_t::validate(handle) < 0)
	{
	AERR("Registering invalid buffer %p, returning error", handle);
	return -EINVAL;
	}

	// if this handle was created in this process, then we keep it as is.
	private_handle_t* hnd = (private_handle_t*)handle;

	int retval = -EINVAL;

	pthread_mutex_lock(&s_map_lock);

	if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)
	{
	AINF("Register framebuffer 0x%p is no-op", handle);
	retval = 0;
	}
	else if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
	{
	retval = gralloc_backend_register(hnd);
	}
	else
	{
	AERR("unknown buffer flags not supported. flags = %d", hnd->flags );
	}

	pthread_mutex_unlock(&s_map_lock);
	return retval;
	}

	static int gralloc_unregister_buffer(gralloc_module_t const* module, buffer_handle_t handle)
	{
	GRALLOC_UNUSED(module);

	if (private_handle_t::validate(handle) < 0)
	{
	AERR("unregistering invalid buffer %p, returning error", handle);
	return -EINVAL;
	}

	private_handle_t* hnd = (private_handle_t*)handle;

	AERR_IF(hnd->lockState & private_handle_t::LOCK_STATE_READ_MASK, "[unregister] handle %p still locked (state=%08x)", hnd, hnd->lockState);

	if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)
	{
	AERR( "Can't unregister buffer %p as it is a framebuffer", handle );
	}
	else
	{
	pthread_mutex_lock(&s_map_lock);

	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
	{
	gralloc_backend_unregister(hnd);
	}
	else
	{
	AERR("Unregistering unknown buffer is not supported. Flags = %d", hnd->flags);
	}

	/*
	* Close shared attribute region file descriptor. It might seem strange to "free"
	* this here since this can happen in a client process, but free here is nothing
	* but unmapping and closing the duplicated file descriptor. The original ashmem
	* fd instance is still open until alloc_device_free() is called. Even sharing
	* of gralloc buffers within the same process should have fds dup:ed.
	*/
	gralloc_buffer_attr_free( hnd );

	hnd->base = 0;
	hnd->lockState = 0;
	hnd->writeOwner = 0;

	pthread_mutex_unlock(&s_map_lock);
	}

	return 0;
	}

	static int gralloc_lock(gralloc_module_t const* module, buffer_handle_t handle, int usage, int l, int t, int w, int h, void** vaddr)
	{
	GRALLOC_UNUSED(module);
	GRALLOC_UNUSED(l);
	GRALLOC_UNUSED(t);
	GRALLOC_UNUSED(w);
	GRALLOC_UNUSED(h);

	if (private_handle_t::validate(handle) < 0)
	{
	AERR("Locking invalid buffer %p, returning error", handle );
	return -EINVAL;
	}

	private_handle_t* hnd = (private_handle_t*)handle;

	if (hnd->req_format == HAL_PIXEL_FORMAT_YCbCr_420_888)
	{
	AERR("Buffers with format YCbCr_420_888 must be locked using (*lock_ycbcr)" );
	return -EINVAL;
	}

	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
	{
	hnd->writeOwner = usage & GRALLOC_USAGE_SW_WRITE_MASK;
	}
	if (usage & (GRALLOC_USAGE_SW_READ_MASK \| GRALLOC_USAGE_SW_WRITE_MASK))
	{
	vaddr = (void)hnd->base;
	}
	return 0;
	}

	static int gralloc_lock_ycbcr(gralloc_module_t const* module, buffer_handle_t handle, int usage,
	int l, int t, int w, int h,
	android_ycbcr *ycbcr)
	{
	GRALLOC_UNUSED(module);
	GRALLOC_UNUSED(l);
	GRALLOC_UNUSED(t);
	GRALLOC_UNUSED(w);
	GRALLOC_UNUSED(h);

	if (private_handle_t::validate(handle) < 0)
	{
	AERR("Locking invalid buffer %p, returning error", handle );
	return -EINVAL;
	}

	private_handle_t* hnd = (private_handle_t*)handle;

	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION)
	{
	hnd->writeOwner = usage & GRALLOC_USAGE_SW_WRITE_MASK;
	}
	if (usage & (GRALLOC_USAGE_SW_READ_MASK \| GRALLOC_USAGE_SW_WRITE_MASK) &&
	!(hnd->internal_format & MALI_GRALLOC_INTFMT_EXT_MASK))
	{
	char* base = (char*)hnd->base;
	int y_stride = hnd->byte_stride;
	/* Ensure height is aligned for subsampled chroma before calculating buffer parameters */
	int adjusted_height = GRALLOC_ALIGN(hnd->height, 2);
	int y_size = y_stride * adjusted_height;

	int u_offset = 0;
	int v_offset = 0;
	int c_stride = 0;
	int step = 0;

	uint64_t base_format = hnd->internal_format & MALI_GRALLOC_INTFMT_FMT_MASK;

	switch (base_format)
	{
	case MALI_GRALLOC_FORMAT_INTERNAL_NV12:
	c_stride = y_stride;
	/* Y plane, UV plane */
	u_offset = y_size;
	v_offset = y_size + 1;
	step = 2;
	break;

	case MALI_GRALLOC_FORMAT_INTERNAL_NV21:
	c_stride = y_stride;
	/* Y plane, UV plane */
	v_offset = y_size;
	u_offset = y_size + 1;
	step = 2;
	break;

	case MALI_GRALLOC_FORMAT_INTERNAL_YV12:
	{
	int c_size;

	/* Stride alignment set to 16 as the SW access flags were set */
	c_stride = GRALLOC_ALIGN(hnd->byte_stride / 2, 16);
	c_size = c_stride * (adjusted_height / 2);
	/* Y plane, V plane, U plane */
	v_offset = y_size;
	u_offset = y_size + c_size;
	step = 1;
	break;
	}

	default:
	AERR("Can't lock buffer %p: wrong format %" PRIx64, hnd, hnd->internal_format);
	return -EINVAL;
	}

	ycbcr->y = base;
	ycbcr->cb = base + u_offset;
	ycbcr->cr = base + v_offset;
	ycbcr->ystride = y_stride;
	ycbcr->cstride = c_stride;
	ycbcr->chroma_step = step;
	}
	return 0;
	}

	static int gralloc_unlock(gralloc_module_t const* module, buffer_handle_t handle)
	{
	GRALLOC_UNUSED(module);

	if (private_handle_t::validate(handle) < 0)
	{
	AERR( "Unlocking invalid buffer %p, returning error", handle );
	return -EINVAL;
	}

	private_handle_t* hnd = (private_handle_t*)handle;

	if (hnd->flags & private_handle_t::PRIV_FLAGS_USES_ION && hnd->writeOwner)
	{
	gralloc_backend_sync(hnd);
	}

	return 0;
	}

	// There is one global instance of the module

	static struct hw_module_methods_t gralloc_module_methods =
	{
	gralloc_device_open
	};

	private_module_t::private_module_t()
	{
	#define INIT_ZERO(obj) (memset(&(obj),0,sizeof((obj))))

	base.common.tag = HARDWARE_MODULE_TAG;
	base.common.version_major = 1;
	base.common.version_minor = 0;
	base.common.id = GRALLOC_HARDWARE_MODULE_ID;
	base.common.name = "Graphics Memory Allocator Module";
	base.common.author = "ARM Ltd.";
	base.common.methods = &gralloc_module_methods;
	base.common.dso = NULL;
	INIT_ZERO(base.common.reserved);

	base.registerBuffer = gralloc_register_buffer;
	base.unregisterBuffer = gralloc_unregister_buffer;
	base.lock = gralloc_lock;
	base.lock_ycbcr = gralloc_lock_ycbcr;
	base.unlock = gralloc_unlock;
	base.perform = NULL;
	INIT_ZERO(base.reserved_proc);

	framebuffer = NULL;
	flags = 0;
	numBuffers = 0;
	bufferMask = 0;
	pthread_mutex_init(&(lock), NULL);
	currentBuffer = NULL;
	INIT_ZERO(info);
	INIT_ZERO(finfo);
	xdpi = 0.0f;
	ydpi = 0.0f;
	fps = 0.0f;
	swapInterval = 1;

	#undef INIT_ZERO
	};

	/*
	* HAL_MODULE_INFO_SYM will be initialized using the default constructor
	* implemented above
	*/
	struct private_module_t HAL_MODULE_INFO_SYM;