Home | History | Annotate | Download | only in gralloc 
      1 /*
      2  * Copyright (C) 2008 The Android Open Source Project
      3  *
      4  * Licensed under the Apache License, Version 2.0 (the "License");
      5  * you may not use this file except in compliance with the License.
      6  * You may obtain a copy of the License at
      7  *
      8  *      http://www.apache.org/licenses/LICENSE-2.0
      9  *
     10  * Unless required by applicable law or agreed to in writing, software
     11  * distributed under the License is distributed on an "AS IS" BASIS,
     12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
     13  * See the License for the specific language governing permissions and
     14  * limitations under the License.
     15  */
     16 
     17 #include <limits.h>
     18 #include <unistd.h>
     19 #include <fcntl.h>
     20 #include <errno.h>
     21 #include <pthread.h>
     22 #include <stdlib.h>
     23 #include <string.h>
     24 
     25 #include <sys/mman.h>
     26 #include <sys/stat.h>
     27 #include <sys/types.h>
     28 #include <sys/ioctl.h>
     29 
     30 #include <cutils/ashmem.h>
     31 #include <cutils/log.h>
     32 #include <cutils/atomic.h>
     33 
     34 #include <hardware/hardware.h>
     35 #include <hardware/gralloc.h>
     36 
     37 #include "gralloc_priv.h"
     38 #include "gr.h"
     39 
     40 /*****************************************************************************/
     41 
     42 struct gralloc_context_t {
     43     alloc_device_t  device;
     44     /* our private data here */
     45 };
     46 
     47 static int gralloc_alloc_buffer(alloc_device_t* dev,
     48         size_t size, int usage, buffer_handle_t* pHandle);
     49 
     50 /*****************************************************************************/
     51 
     52 int fb_device_open(const hw_module_t* module, const char* name,
     53         hw_device_t** device);
     54 
     55 static int gralloc_device_open(const hw_module_t* module, const char* name,
     56         hw_device_t** device);
     57 
     58 extern int gralloc_lock(gralloc_module_t const* module,
     59         buffer_handle_t handle, int usage,
     60         int l, int t, int w, int h,
     61         void** vaddr);
     62 
     63 extern int gralloc_unlock(gralloc_module_t const* module,
     64         buffer_handle_t handle);
     65 
     66 extern int gralloc_register_buffer(gralloc_module_t const* module,
     67         buffer_handle_t handle);
     68 
     69 extern int gralloc_unregister_buffer(gralloc_module_t const* module,
     70         buffer_handle_t handle);
     71 
     72 /*****************************************************************************/
     73 
     74 static struct hw_module_methods_t gralloc_module_methods = {
     75         .open = gralloc_device_open
     76 };
     77 
     78 struct private_module_t HAL_MODULE_INFO_SYM = {
     79     .base = {
     80         .common = {
     81             .tag = HARDWARE_MODULE_TAG,
     82             .version_major = 1,
     83             .version_minor = 0,
     84             .id = GRALLOC_HARDWARE_MODULE_ID,
     85             .name = "Graphics Memory Allocator Module",
     86             .author = "The Android Open Source Project",
     87             .methods = &gralloc_module_methods
     88         },
     89         .registerBuffer = gralloc_register_buffer,
     90         .unregisterBuffer = gralloc_unregister_buffer,
     91         .lock = gralloc_lock,
     92         .unlock = gralloc_unlock,
     93     },
     94     .framebuffer = 0,
     95     .flags = 0,
     96     .numBuffers = 0,
     97     .bufferMask = 0,
     98     .lock = PTHREAD_MUTEX_INITIALIZER,
     99     .currentBuffer = 0,
    100 };
    101 
    102 /*****************************************************************************/
    103 
    104 static int gralloc_alloc_framebuffer_locked(alloc_device_t* dev,
    105         size_t size, int usage, buffer_handle_t* pHandle)
    106 {
    107     private_module_t* m = reinterpret_cast<private_module_t*>(
    108             dev->common.module);
    109 
    110     // allocate the framebuffer
    111     if (m->framebuffer == NULL) {
    112         // initialize the framebuffer, the framebuffer is mapped once
    113         // and forever.
    114         int err = mapFrameBufferLocked(m);
    115         if (err < 0) {
    116             return err;
    117         }
    118     }
    119 
    120     const uint32_t bufferMask = m->bufferMask;
    121     const uint32_t numBuffers = m->numBuffers;
    122     const size_t bufferSize = m->finfo.line_length * m->info.yres;
    123     if (numBuffers == 1) {
    124         // If we have only one buffer, we never use page-flipping. Instead,
    125         // we return a regular buffer which will be memcpy'ed to the main
    126         // screen when post is called.
    127         int newUsage = (usage & ~GRALLOC_USAGE_HW_FB) | GRALLOC_USAGE_HW_2D;
    128         return gralloc_alloc_buffer(dev, bufferSize, newUsage, pHandle);
    129     }
    130 
    131     if (bufferMask >= ((1LU<<numBuffers)-1)) {
    132         // We ran out of buffers.
    133         return -ENOMEM;
    134     }
    135 
    136     // create a "fake" handles for it
    137     intptr_t vaddr = intptr_t(m->framebuffer->base);
    138     private_handle_t* hnd = new private_handle_t(dup(m->framebuffer->fd), size,
    139             private_handle_t::PRIV_FLAGS_FRAMEBUFFER);
    140 
    141     // find a free slot
    142     for (uint32_t i=0 ; i<numBuffers ; i++) {
    143         if ((bufferMask & (1LU<<i)) == 0) {
    144             m->bufferMask |= (1LU<<i);
    145             break;
    146         }
    147         vaddr += bufferSize;
    148     }
    149 
    150     hnd->base = vaddr;
    151     hnd->offset = vaddr - intptr_t(m->framebuffer->base);
    152     *pHandle = hnd;
    153 
    154     return 0;
    155 }
    156 
    157 static int gralloc_alloc_framebuffer(alloc_device_t* dev,
    158         size_t size, int usage, buffer_handle_t* pHandle)
    159 {
    160     private_module_t* m = reinterpret_cast<private_module_t*>(
    161             dev->common.module);
    162     pthread_mutex_lock(&m->lock);
    163     int err = gralloc_alloc_framebuffer_locked(dev, size, usage, pHandle);
    164     pthread_mutex_unlock(&m->lock);
    165     return err;
    166 }
    167 
    168 static int gralloc_alloc_buffer(alloc_device_t* dev,
    169         size_t size, int /*usage*/, buffer_handle_t* pHandle)
    170 {
    171     int err = 0;
    172     int fd = -1;
    173 
    174     size = roundUpToPageSize(size);
    175 
    176     fd = ashmem_create_region("gralloc-buffer", size);
    177     if (fd < 0) {
    178         ALOGE("couldn't create ashmem (%s)", strerror(-errno));
    179         err = -errno;
    180     }
    181 
    182     if (err == 0) {
    183         private_handle_t* hnd = new private_handle_t(fd, size, 0);
    184         gralloc_module_t* module = reinterpret_cast<gralloc_module_t*>(
    185                 dev->common.module);
    186         err = mapBuffer(module, hnd);
    187         if (err == 0) {
    188             *pHandle = hnd;
    189         }
    190     }
    191 
    192     ALOGE_IF(err, "gralloc failed err=%s", strerror(-err));
    193 
    194     return err;
    195 }
    196 
    197 /*****************************************************************************/
    198 
    199 static int gralloc_alloc(alloc_device_t* dev,
    200         int w, int h, int format, int usage,
    201         buffer_handle_t* pHandle, int* pStride)
    202 {
    203     if (!pHandle || !pStride)
    204         return -EINVAL;
    205 
    206     size_t size, stride;
    207 
    208     int align = 4;
    209     int bpp = 0;
    210     switch (format) {
    211         case HAL_PIXEL_FORMAT_RGBA_8888:
    212         case HAL_PIXEL_FORMAT_RGBX_8888:
    213         case HAL_PIXEL_FORMAT_BGRA_8888:
    214             bpp = 4;
    215             break;
    216         case HAL_PIXEL_FORMAT_RGB_888:
    217             bpp = 3;
    218             break;
    219         case HAL_PIXEL_FORMAT_RGB_565:
    220         case HAL_PIXEL_FORMAT_RAW_SENSOR:
    221             bpp = 2;
    222             break;
    223         default:
    224             return -EINVAL;
    225     }
    226     size_t bpr = (w*bpp + (align-1)) & ~(align-1);
    227     size = bpr * h;
    228     stride = bpr / bpp;
    229 
    230     int err;
    231     if (usage & GRALLOC_USAGE_HW_FB) {
    232         err = gralloc_alloc_framebuffer(dev, size, usage, pHandle);
    233     } else {
    234         err = gralloc_alloc_buffer(dev, size, usage, pHandle);
    235     }
    236 
    237     if (err < 0) {
    238         return err;
    239     }
    240 
    241     *pStride = stride;
    242     return 0;
    243 }
    244 
    245 static int gralloc_free(alloc_device_t* dev,
    246         buffer_handle_t handle)
    247 {
    248     if (private_handle_t::validate(handle) < 0)
    249         return -EINVAL;
    250 
    251     private_handle_t const* hnd = reinterpret_cast<private_handle_t const*>(handle);
    252     if (hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER) {
    253         // free this buffer
    254         private_module_t* m = reinterpret_cast<private_module_t*>(
    255                 dev->common.module);
    256         const size_t bufferSize = m->finfo.line_length * m->info.yres;
    257         int index = (hnd->base - m->framebuffer->base) / bufferSize;
    258         m->bufferMask &= ~(1<<index);
    259     } else {
    260         gralloc_module_t* module = reinterpret_cast<gralloc_module_t*>(
    261                 dev->common.module);
    262         terminateBuffer(module, const_cast<private_handle_t*>(hnd));
    263     }
    264 
    265     close(hnd->fd);
    266     delete hnd;
    267     return 0;
    268 }
    269 
    270 /*****************************************************************************/
    271 
    272 static int gralloc_close(struct hw_device_t *dev)
    273 {
    274     gralloc_context_t* ctx = reinterpret_cast<gralloc_context_t*>(dev);
    275     if (ctx) {
    276         /* TODO: keep a list of all buffer_handle_t created, and free them
    277          * all here.
    278          */
    279         free(ctx);
    280     }
    281     return 0;
    282 }
    283 
    284 int gralloc_device_open(const hw_module_t* module, const char* name,
    285         hw_device_t** device)
    286 {
    287     int status = -EINVAL;
    288     if (!strcmp(name, GRALLOC_HARDWARE_GPU0)) {
    289         gralloc_context_t *dev;
    290         dev = (gralloc_context_t*)malloc(sizeof(*dev));
    291 
    292         /* initialize our state here */
    293         memset(dev, 0, sizeof(*dev));
    294 
    295         /* initialize the procs */
    296         dev->device.common.tag = HARDWARE_DEVICE_TAG;
    297         dev->device.common.version = 0;
    298         dev->device.common.module = const_cast<hw_module_t*>(module);
    299         dev->device.common.close = gralloc_close;
    300 
    301         dev->device.alloc   = gralloc_alloc;
    302         dev->device.free    = gralloc_free;
    303 
    304         *device = &dev->device.common;
    305         status = 0;
    306     } else {
    307         status = fb_device_open(module, name, device);
    308     }
    309     return status;
    310 }
    311