312 lines
8.9 KiB
C++
312 lines
8.9 KiB
C++
/*
|
|
* 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 <limits.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <errno.h>
|
|
#include <pthread.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#include <sys/mman.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/types.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
#include <cutils/ashmem.h>
|
|
#include <cutils/log.h>
|
|
#include <cutils/atomic.h>
|
|
|
|
#include <hardware/hardware.h>
|
|
#include <hardware/gralloc.h>
|
|
|
|
#include "gralloc_priv.h"
|
|
#include "gr.h"
|
|
|
|
/*****************************************************************************/
|
|
|
|
struct gralloc_context_t {
|
|
alloc_device_t device;
|
|
/* our private data here */
|
|
};
|
|
|
|
static int gralloc_alloc_buffer(alloc_device_t* dev,
|
|
size_t size, int usage, buffer_handle_t* pHandle);
|
|
|
|
/*****************************************************************************/
|
|
|
|
int fb_device_open(const hw_module_t* module, const char* name,
|
|
hw_device_t** device);
|
|
|
|
static int gralloc_device_open(const hw_module_t* module, const char* name,
|
|
hw_device_t** device);
|
|
|
|
extern int gralloc_lock(gralloc_module_t const* module,
|
|
buffer_handle_t handle, int usage,
|
|
int l, int t, int w, int h,
|
|
void** vaddr);
|
|
|
|
extern int gralloc_unlock(gralloc_module_t const* module,
|
|
buffer_handle_t handle);
|
|
|
|
extern int gralloc_register_buffer(gralloc_module_t const* module,
|
|
buffer_handle_t handle);
|
|
|
|
extern int gralloc_unregister_buffer(gralloc_module_t const* module,
|
|
buffer_handle_t handle);
|
|
|
|
/*****************************************************************************/
|
|
|
|
static struct hw_module_methods_t gralloc_module_methods = {
|
|
open: gralloc_device_open
|
|
};
|
|
|
|
struct private_module_t HAL_MODULE_INFO_SYM = {
|
|
base: {
|
|
common: {
|
|
tag: HARDWARE_MODULE_TAG,
|
|
version_major: 1,
|
|
version_minor: 0,
|
|
id: GRALLOC_HARDWARE_MODULE_ID,
|
|
name: "Graphics Memory Allocator Module",
|
|
author: "The Android Open Source Project",
|
|
methods: &gralloc_module_methods
|
|
},
|
|
registerBuffer: gralloc_register_buffer,
|
|
unregisterBuffer: gralloc_unregister_buffer,
|
|
lock: gralloc_lock,
|
|
unlock: gralloc_unlock,
|
|
},
|
|
framebuffer: 0,
|
|
flags: 0,
|
|
numBuffers: 0,
|
|
bufferMask: 0,
|
|
lock: PTHREAD_MUTEX_INITIALIZER,
|
|
currentBuffer: 0,
|
|
};
|
|
|
|
/*****************************************************************************/
|
|
|
|
static int gralloc_alloc_framebuffer_locked(alloc_device_t* dev,
|
|
size_t size, int usage, buffer_handle_t* pHandle)
|
|
{
|
|
private_module_t* m = reinterpret_cast<private_module_t*>(
|
|
dev->common.module);
|
|
|
|
// allocate the framebuffer
|
|
if (m->framebuffer == NULL) {
|
|
// initialize the framebuffer, the framebuffer is mapped once
|
|
// and forever.
|
|
int err = mapFrameBufferLocked(m);
|
|
if (err < 0) {
|
|
return err;
|
|
}
|
|
}
|
|
|
|
const uint32_t bufferMask = m->bufferMask;
|
|
const uint32_t numBuffers = m->numBuffers;
|
|
const size_t bufferSize = m->finfo.line_length * m->info.yres;
|
|
if (numBuffers == 1) {
|
|
// If we have only one buffer, we never use page-flipping. Instead,
|
|
// we return a regular buffer which will be memcpy'ed to the main
|
|
// screen when post is called.
|
|
int newUsage = (usage & ~GRALLOC_USAGE_HW_FB) | GRALLOC_USAGE_HW_2D;
|
|
return gralloc_alloc_buffer(dev, bufferSize, newUsage, pHandle);
|
|
}
|
|
|
|
if (bufferMask >= ((1LU<<numBuffers)-1)) {
|
|
// We ran out of buffers.
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// create a "fake" handles for it
|
|
intptr_t vaddr = intptr_t(m->framebuffer->base);
|
|
private_handle_t* hnd = new private_handle_t(dup(m->framebuffer->fd), size,
|
|
private_handle_t::PRIV_FLAGS_FRAMEBUFFER);
|
|
|
|
// find a free slot
|
|
for (uint32_t i=0 ; i<numBuffers ; i++) {
|
|
if ((bufferMask & (1LU<<i)) == 0) {
|
|
m->bufferMask |= (1LU<<i);
|
|
break;
|
|
}
|
|
vaddr += bufferSize;
|
|
}
|
|
|
|
hnd->base = vaddr;
|
|
hnd->offset = vaddr - intptr_t(m->framebuffer->base);
|
|
*pHandle = hnd;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gralloc_alloc_framebuffer(alloc_device_t* dev,
|
|
size_t size, int usage, buffer_handle_t* pHandle)
|
|
{
|
|
private_module_t* m = reinterpret_cast<private_module_t*>(
|
|
dev->common.module);
|
|
pthread_mutex_lock(&m->lock);
|
|
int err = gralloc_alloc_framebuffer_locked(dev, size, usage, pHandle);
|
|
pthread_mutex_unlock(&m->lock);
|
|
return err;
|
|
}
|
|
|
|
static int gralloc_alloc_buffer(alloc_device_t* dev,
|
|
size_t size, int usage, buffer_handle_t* pHandle)
|
|
{
|
|
int err = 0;
|
|
int fd = -1;
|
|
|
|
size = roundUpToPageSize(size);
|
|
|
|
fd = ashmem_create_region("gralloc-buffer", size);
|
|
if (fd < 0) {
|
|
ALOGE("couldn't create ashmem (%s)", strerror(-errno));
|
|
err = -errno;
|
|
}
|
|
|
|
if (err == 0) {
|
|
private_handle_t* hnd = new private_handle_t(fd, size, 0);
|
|
gralloc_module_t* module = reinterpret_cast<gralloc_module_t*>(
|
|
dev->common.module);
|
|
err = mapBuffer(module, hnd);
|
|
if (err == 0) {
|
|
*pHandle = hnd;
|
|
}
|
|
}
|
|
|
|
ALOGE_IF(err, "gralloc failed err=%s", strerror(-err));
|
|
|
|
return err;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static int gralloc_alloc(alloc_device_t* dev,
|
|
int w, int h, int format, int usage,
|
|
buffer_handle_t* pHandle, int* pStride)
|
|
{
|
|
if (!pHandle || !pStride)
|
|
return -EINVAL;
|
|
|
|
size_t size, stride;
|
|
|
|
int align = 4;
|
|
int bpp = 0;
|
|
switch (format) {
|
|
case HAL_PIXEL_FORMAT_RGBA_8888:
|
|
case HAL_PIXEL_FORMAT_RGBX_8888:
|
|
case HAL_PIXEL_FORMAT_BGRA_8888:
|
|
bpp = 4;
|
|
break;
|
|
case HAL_PIXEL_FORMAT_RGB_888:
|
|
bpp = 3;
|
|
break;
|
|
case HAL_PIXEL_FORMAT_RGB_565:
|
|
case HAL_PIXEL_FORMAT_RGBA_5551:
|
|
case HAL_PIXEL_FORMAT_RGBA_4444:
|
|
bpp = 2;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
size_t bpr = (w*bpp + (align-1)) & ~(align-1);
|
|
size = bpr * h;
|
|
stride = bpr / bpp;
|
|
|
|
int err;
|
|
if (usage & GRALLOC_USAGE_HW_FB) {
|
|
err = gralloc_alloc_framebuffer(dev, size, usage, pHandle);
|
|
} else {
|
|
err = gralloc_alloc_buffer(dev, size, usage, pHandle);
|
|
}
|
|
|
|
if (err < 0) {
|
|
return err;
|
|
}
|
|
|
|
*pStride = stride;
|
|
return 0;
|
|
}
|
|
|
|
static int gralloc_free(alloc_device_t* dev,
|
|
buffer_handle_t handle)
|
|
{
|
|
if (private_handle_t::validate(handle) < 0)
|
|
return -EINVAL;
|
|
|
|
private_handle_t const* hnd = reinterpret_cast<private_handle_t const*>(handle);
|
|
if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER) {
|
|
// free this buffer
|
|
private_module_t* m = reinterpret_cast<private_module_t*>(
|
|
dev->common.module);
|
|
const size_t bufferSize = m->finfo.line_length * m->info.yres;
|
|
int index = (hnd->base - m->framebuffer->base) / bufferSize;
|
|
m->bufferMask &= ~(1<<index);
|
|
} else {
|
|
gralloc_module_t* module = reinterpret_cast<gralloc_module_t*>(
|
|
dev->common.module);
|
|
terminateBuffer(module, const_cast<private_handle_t*>(hnd));
|
|
}
|
|
|
|
close(hnd->fd);
|
|
delete hnd;
|
|
return 0;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static int gralloc_close(struct hw_device_t *dev)
|
|
{
|
|
gralloc_context_t* ctx = reinterpret_cast<gralloc_context_t*>(dev);
|
|
if (ctx) {
|
|
/* TODO: keep a list of all buffer_handle_t created, and free them
|
|
* all here.
|
|
*/
|
|
free(ctx);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int gralloc_device_open(const hw_module_t* module, const char* name,
|
|
hw_device_t** device)
|
|
{
|
|
int status = -EINVAL;
|
|
if (!strcmp(name, GRALLOC_HARDWARE_GPU0)) {
|
|
gralloc_context_t *dev;
|
|
dev = (gralloc_context_t*)malloc(sizeof(*dev));
|
|
|
|
/* initialize our state here */
|
|
memset(dev, 0, sizeof(*dev));
|
|
|
|
/* initialize the procs */
|
|
dev->device.common.tag = HARDWARE_DEVICE_TAG;
|
|
dev->device.common.version = 0;
|
|
dev->device.common.module = const_cast<hw_module_t*>(module);
|
|
dev->device.common.close = gralloc_close;
|
|
|
|
dev->device.alloc = gralloc_alloc;
|
|
dev->device.free = gralloc_free;
|
|
|
|
*device = &dev->device.common;
|
|
status = 0;
|
|
} else {
|
|
status = fb_device_open(module, name, device);
|
|
}
|
|
return status;
|
|
}
|