You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
453 lines
14 KiB
453 lines
14 KiB
/* |
|
* Copyright (C) 2008 The Android Open Source Project |
|
* Copyright (c) 2010-2014 The Linux Foundation. All rights reserved. |
|
* |
|
* 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 <sys/mman.h> |
|
|
|
#include <cutils/log.h> |
|
#include <cutils/properties.h> |
|
#include <dlfcn.h> |
|
|
|
#include <hardware/hardware.h> |
|
|
|
#include <fcntl.h> |
|
#include <errno.h> |
|
#include <sys/ioctl.h> |
|
#include <string.h> |
|
#include <stdlib.h> |
|
#include <pthread.h> |
|
#include <cutils/atomic.h> |
|
|
|
#include <linux/fb.h> |
|
#include <linux/msm_mdp.h> |
|
|
|
#include <GLES/gl.h> |
|
|
|
#include "gralloc_priv.h" |
|
#include "fb_priv.h" |
|
#include "gr.h" |
|
#include <cutils/properties.h> |
|
#include <profiler.h> |
|
|
|
#define EVEN_OUT(x) if (x & 0x0001) {x--;} |
|
|
|
enum { |
|
PAGE_FLIP = 0x00000001, |
|
}; |
|
|
|
struct fb_context_t { |
|
framebuffer_device_t device; |
|
//fd - which is returned on open |
|
int fbFd; |
|
}; |
|
|
|
static int fb_setSwapInterval(struct framebuffer_device_t* dev, |
|
int interval) |
|
{ |
|
//XXX: Get the value here and implement along with |
|
//single vsync in HWC |
|
char pval[PROPERTY_VALUE_MAX]; |
|
property_get("debug.egl.swapinterval", pval, "-1"); |
|
int property_interval = atoi(pval); |
|
if (property_interval >= 0) |
|
interval = property_interval; |
|
|
|
private_module_t* m = reinterpret_cast<private_module_t*>( |
|
dev->common.module); |
|
if (interval < dev->minSwapInterval || interval > dev->maxSwapInterval) |
|
return -EINVAL; |
|
|
|
m->swapInterval = interval; |
|
return 0; |
|
} |
|
|
|
static int fb_post(struct framebuffer_device_t* dev, buffer_handle_t buffer) |
|
{ |
|
private_module_t* m = |
|
reinterpret_cast<private_module_t*>(dev->common.module); |
|
private_handle_t *hnd = static_cast<private_handle_t*> |
|
(const_cast<native_handle_t*>(buffer)); |
|
fb_context_t *ctx = reinterpret_cast<fb_context_t*>(dev); |
|
const unsigned int offset = (unsigned int) (hnd->base - |
|
m->framebuffer->base); |
|
m->info.activate = FB_ACTIVATE_VBL; |
|
m->info.yoffset = (int)(offset / m->finfo.line_length); |
|
if (ioctl(ctx->fbFd, FBIOPUT_VSCREENINFO, &m->info) == -1) { |
|
ALOGE("%s: FBIOPUT_VSCREENINFO for primary failed, str: %s", |
|
__FUNCTION__, strerror(errno)); |
|
return -errno; |
|
} |
|
return 0; |
|
} |
|
|
|
static int fb_compositionComplete(struct framebuffer_device_t* dev) |
|
{ |
|
// TODO: Properly implement composition complete callback |
|
if(!dev) { |
|
return -1; |
|
} |
|
glFinish(); |
|
|
|
return 0; |
|
} |
|
|
|
int mapFrameBufferLocked(framebuffer_device_t *dev) |
|
{ |
|
private_module_t* module = |
|
reinterpret_cast<private_module_t*>(dev->common.module); |
|
fb_context_t *ctx = reinterpret_cast<fb_context_t*>(dev); |
|
// already initialized... |
|
if (module->framebuffer) { |
|
return 0; |
|
} |
|
char const * const device_template[] = { |
|
"/dev/graphics/fb%u", |
|
"/dev/fb%u", |
|
0 }; |
|
|
|
int fd = -1; |
|
int i=0; |
|
char name[64]; |
|
char property[PROPERTY_VALUE_MAX]; |
|
|
|
while ((fd==-1) && device_template[i]) { |
|
snprintf(name, 64, device_template[i], 0); |
|
fd = open(name, O_RDWR, 0); |
|
i++; |
|
} |
|
if (fd < 0) |
|
return -errno; |
|
|
|
struct fb_fix_screeninfo finfo; |
|
if (ioctl(fd, FBIOGET_FSCREENINFO, &finfo) == -1) { |
|
close(fd); |
|
return -errno; |
|
} |
|
|
|
struct fb_var_screeninfo info; |
|
if (ioctl(fd, FBIOGET_VSCREENINFO, &info) == -1) { |
|
close(fd); |
|
return -errno; |
|
} |
|
|
|
info.reserved[0] = 0; |
|
info.reserved[1] = 0; |
|
info.reserved[2] = 0; |
|
info.xoffset = 0; |
|
info.yoffset = 0; |
|
info.activate = FB_ACTIVATE_NOW; |
|
|
|
/* Interpretation of offset for color fields: All offsets are from the |
|
* right, inside a "pixel" value, which is exactly 'bits_per_pixel' wide |
|
* (means: you can use the offset as right argument to <<). A pixel |
|
* afterwards is a bit stream and is written to video memory as that |
|
* unmodified. This implies big-endian byte order if bits_per_pixel is |
|
* greater than 8. |
|
*/ |
|
|
|
if(info.bits_per_pixel == 32) { |
|
/* |
|
* Explicitly request RGBA_8888 |
|
*/ |
|
info.bits_per_pixel = 32; |
|
info.red.offset = 24; |
|
info.red.length = 8; |
|
info.green.offset = 16; |
|
info.green.length = 8; |
|
info.blue.offset = 8; |
|
info.blue.length = 8; |
|
info.transp.offset = 0; |
|
info.transp.length = 8; |
|
|
|
/* Note: the GL driver does not have a r=8 g=8 b=8 a=0 config, so if we |
|
* do not use the MDP for composition (i.e. hw composition == 0), ask |
|
* for RGBA instead of RGBX. */ |
|
if (property_get("debug.sf.hw", property, NULL) > 0 && |
|
atoi(property) == 0) |
|
module->fbFormat = HAL_PIXEL_FORMAT_RGBX_8888; |
|
else if(property_get("debug.composition.type", property, NULL) > 0 && |
|
(strncmp(property, "mdp", 3) == 0)) |
|
module->fbFormat = HAL_PIXEL_FORMAT_RGBX_8888; |
|
else |
|
module->fbFormat = HAL_PIXEL_FORMAT_RGBA_8888; |
|
} else { |
|
/* |
|
* Explicitly request 5/6/5 |
|
*/ |
|
info.bits_per_pixel = 16; |
|
info.red.offset = 11; |
|
info.red.length = 5; |
|
info.green.offset = 5; |
|
info.green.length = 6; |
|
info.blue.offset = 0; |
|
info.blue.length = 5; |
|
info.transp.offset = 0; |
|
info.transp.length = 0; |
|
module->fbFormat = HAL_PIXEL_FORMAT_RGB_565; |
|
} |
|
|
|
//adreno needs 4k aligned offsets. Max hole size is 4096-1 |
|
unsigned int size = roundUpToPageSize(info.yres * info.xres * |
|
(info.bits_per_pixel/8)); |
|
|
|
/* |
|
* Request NUM_BUFFERS screens (at least 2 for page flipping) |
|
*/ |
|
int numberOfBuffers = (int)(finfo.smem_len/size); |
|
ALOGV("num supported framebuffers in kernel = %d", numberOfBuffers); |
|
|
|
if (property_get("debug.gr.numframebuffers", property, NULL) > 0) { |
|
int num = atoi(property); |
|
if ((num >= NUM_FRAMEBUFFERS_MIN) && (num <= NUM_FRAMEBUFFERS_MAX)) { |
|
numberOfBuffers = num; |
|
} |
|
} |
|
if (numberOfBuffers > NUM_FRAMEBUFFERS_MAX) |
|
numberOfBuffers = NUM_FRAMEBUFFERS_MAX; |
|
|
|
ALOGV("We support %d buffers", numberOfBuffers); |
|
|
|
//consider the included hole by 4k alignment |
|
uint32_t line_length = (info.xres * info.bits_per_pixel / 8); |
|
info.yres_virtual = (uint32_t) ((size * numberOfBuffers) / line_length); |
|
|
|
uint32_t flags = PAGE_FLIP; |
|
|
|
if (info.yres_virtual < ((size * 2) / line_length) ) { |
|
// we need at least 2 for page-flipping |
|
info.yres_virtual = (int)(size / line_length); |
|
flags &= ~PAGE_FLIP; |
|
ALOGW("page flipping not supported (yres_virtual=%d, requested=%d)", |
|
info.yres_virtual, info.yres*2); |
|
} |
|
|
|
if (ioctl(fd, FBIOGET_VSCREENINFO, &info) == -1) { |
|
close(fd); |
|
return -errno; |
|
} |
|
|
|
if (int(info.width) <= 0 || int(info.height) <= 0) { |
|
// the driver doesn't return that information |
|
// default to 160 dpi |
|
info.width = (uint32_t)(((float)(info.xres) * 25.4f)/160.0f + 0.5f); |
|
info.height = (uint32_t)(((float)(info.yres) * 25.4f)/160.0f + 0.5f); |
|
} |
|
|
|
float xdpi = ((float)(info.xres) * 25.4f) / (float)info.width; |
|
float ydpi = ((float)(info.yres) * 25.4f) / (float)info.height; |
|
|
|
#ifdef MSMFB_METADATA_GET |
|
struct msmfb_metadata metadata; |
|
memset(&metadata, 0 , sizeof(metadata)); |
|
metadata.op = metadata_op_frame_rate; |
|
if (ioctl(fd, MSMFB_METADATA_GET, &metadata) == -1) { |
|
ALOGE("Error retrieving panel frame rate"); |
|
close(fd); |
|
return -errno; |
|
} |
|
float fps = (float)metadata.data.panel_frame_rate; |
|
#else |
|
//XXX: Remove reserved field usage on all baselines |
|
//The reserved[3] field is used to store FPS by the driver. |
|
float fps = info.reserved[3] & 0xFF; |
|
#endif |
|
ALOGI("using (fd=%d)\n" |
|
"id = %s\n" |
|
"xres = %d px\n" |
|
"yres = %d px\n" |
|
"xres_virtual = %d px\n" |
|
"yres_virtual = %d px\n" |
|
"bpp = %d\n" |
|
"r = %2u:%u\n" |
|
"g = %2u:%u\n" |
|
"b = %2u:%u\n", |
|
fd, |
|
finfo.id, |
|
info.xres, |
|
info.yres, |
|
info.xres_virtual, |
|
info.yres_virtual, |
|
info.bits_per_pixel, |
|
info.red.offset, info.red.length, |
|
info.green.offset, info.green.length, |
|
info.blue.offset, info.blue.length |
|
); |
|
|
|
ALOGI("width = %d mm (%f dpi)\n" |
|
"height = %d mm (%f dpi)\n" |
|
"refresh rate = %.2f Hz\n", |
|
info.width, xdpi, |
|
info.height, ydpi, |
|
fps |
|
); |
|
|
|
|
|
if (ioctl(fd, FBIOGET_FSCREENINFO, &finfo) == -1) { |
|
close(fd); |
|
return -errno; |
|
} |
|
|
|
if (finfo.smem_len <= 0) { |
|
close(fd); |
|
return -errno; |
|
} |
|
|
|
module->flags = flags; |
|
module->info = info; |
|
module->finfo = finfo; |
|
module->xdpi = xdpi; |
|
module->ydpi = ydpi; |
|
module->fps = fps; |
|
module->swapInterval = 1; |
|
|
|
CALC_INIT(); |
|
|
|
/* |
|
* map the framebuffer |
|
*/ |
|
|
|
module->numBuffers = info.yres_virtual / info.yres; |
|
module->bufferMask = 0; |
|
//adreno needs page aligned offsets. Align the fbsize to pagesize. |
|
unsigned int fbSize = roundUpToPageSize(finfo.line_length * info.yres)* |
|
module->numBuffers; |
|
void* vaddr = mmap(0, fbSize, PROT_READ|PROT_WRITE, MAP_SHARED, fd, 0); |
|
if (vaddr == MAP_FAILED) { |
|
ALOGE("Error mapping the framebuffer (%s)", strerror(errno)); |
|
close(fd); |
|
return -errno; |
|
} |
|
//store the framebuffer fd in the ctx |
|
ctx->fbFd = fd; |
|
#ifdef MSMFB_METADATA_GET |
|
memset(&metadata, 0 , sizeof(metadata)); |
|
metadata.op = metadata_op_get_ion_fd; |
|
// get the ION fd for the framebuffer, as GPU needs ION fd |
|
if (ioctl(fd, MSMFB_METADATA_GET, &metadata) == -1) { |
|
ALOGE("Error getting ION fd (%s)", strerror(errno)); |
|
close(fd); |
|
return -errno; |
|
} |
|
if(metadata.data.fbmem_ionfd < 0) { |
|
ALOGE("Error: Ioctl returned invalid ION fd = %d", |
|
metadata.data.fbmem_ionfd); |
|
close(fd); |
|
return -errno; |
|
} |
|
fd = metadata.data.fbmem_ionfd; |
|
#endif |
|
// Create framebuffer handle using the ION fd |
|
module->framebuffer = new private_handle_t(fd, fbSize, |
|
private_handle_t::PRIV_FLAGS_USES_ION, |
|
BUFFER_TYPE_UI, |
|
module->fbFormat, info.xres, info.yres); |
|
module->framebuffer->base = uint64_t(vaddr); |
|
memset(vaddr, 0, fbSize); |
|
//Enable vsync |
|
int enable = 1; |
|
ioctl(ctx->fbFd, MSMFB_OVERLAY_VSYNC_CTRL, &enable); |
|
return 0; |
|
} |
|
|
|
static int mapFrameBuffer(framebuffer_device_t *dev) |
|
{ |
|
int err = -1; |
|
char property[PROPERTY_VALUE_MAX]; |
|
if((property_get("debug.gralloc.map_fb_memory", property, NULL) > 0) && |
|
(!strncmp(property, "1", PROPERTY_VALUE_MAX ) || |
|
(!strncasecmp(property,"true", PROPERTY_VALUE_MAX )))) { |
|
private_module_t* module = |
|
reinterpret_cast<private_module_t*>(dev->common.module); |
|
pthread_mutex_lock(&module->lock); |
|
err = mapFrameBufferLocked(dev); |
|
pthread_mutex_unlock(&module->lock); |
|
} |
|
return err; |
|
} |
|
|
|
/*****************************************************************************/ |
|
|
|
static int fb_close(struct hw_device_t *dev) |
|
{ |
|
fb_context_t* ctx = (fb_context_t*)dev; |
|
if (ctx) { |
|
#ifdef MSMFB_METADATA_GET |
|
if(ctx->fbFd >=0) { |
|
close(ctx->fbFd); |
|
} |
|
#endif |
|
//Hack until fbdev is removed. Framework could close this causing hwc a |
|
//pain. |
|
//free(ctx); |
|
} |
|
return 0; |
|
} |
|
|
|
int fb_device_open(hw_module_t const* module, const char* name, |
|
hw_device_t** device) |
|
{ |
|
int status = -EINVAL; |
|
if (!strcmp(name, GRALLOC_HARDWARE_FB0)) { |
|
alloc_device_t* gralloc_device; |
|
status = gralloc_open(module, &gralloc_device); |
|
if (status < 0) |
|
return status; |
|
|
|
/* initialize our state here */ |
|
fb_context_t *dev = (fb_context_t*)malloc(sizeof(*dev)); |
|
if(dev == NULL) { |
|
gralloc_close(gralloc_device); |
|
return status; |
|
} |
|
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 = fb_close; |
|
dev->device.setSwapInterval = fb_setSwapInterval; |
|
dev->device.post = fb_post; |
|
dev->device.setUpdateRect = 0; |
|
dev->device.compositionComplete = fb_compositionComplete; |
|
|
|
status = mapFrameBuffer((framebuffer_device_t*)dev); |
|
private_module_t* m = (private_module_t*)dev->device.common.module; |
|
if (status >= 0) { |
|
int stride = m->finfo.line_length / (m->info.bits_per_pixel >> 3); |
|
const_cast<uint32_t&>(dev->device.flags) = 0; |
|
const_cast<uint32_t&>(dev->device.width) = m->info.xres; |
|
const_cast<uint32_t&>(dev->device.height) = m->info.yres; |
|
const_cast<int&>(dev->device.stride) = stride; |
|
const_cast<int&>(dev->device.format) = m->fbFormat; |
|
const_cast<float&>(dev->device.xdpi) = m->xdpi; |
|
const_cast<float&>(dev->device.ydpi) = m->ydpi; |
|
const_cast<float&>(dev->device.fps) = m->fps; |
|
const_cast<int&>(dev->device.minSwapInterval) = |
|
PRIV_MIN_SWAP_INTERVAL; |
|
const_cast<int&>(dev->device.maxSwapInterval) = |
|
PRIV_MAX_SWAP_INTERVAL; |
|
const_cast<int&>(dev->device.numFramebuffers) = m->numBuffers; |
|
dev->device.setUpdateRect = 0; |
|
|
|
*device = &dev->device.common; |
|
} |
|
|
|
// Close the gralloc module |
|
gralloc_close(gralloc_device); |
|
} |
|
return status; |
|
}
|
|
|