mapper.cpp revision 77a5ae0adc2e220228a988c65696757b37d0826e
1a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev/* 2a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * Copyright (C) 2008 The Android Open Source Project 3befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed * Copyright (c) 2011-2012, Code Aurora Forum. All rights reserved. 4a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * 5a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * Licensed under the Apache License, Version 2.0 (the "License"); 6a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * you may not use this file except in compliance with the License. 7a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * You may obtain a copy of the License at 8a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * 9a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * http://www.apache.org/licenses/LICENSE-2.0 10a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * 11a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * Unless required by applicable law or agreed to in writing, software 12a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * distributed under the License is distributed on an "AS IS" BASIS, 13a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * See the License for the specific language governing permissions and 15a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * limitations under the License. 16a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev */ 17a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 18a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <limits.h> 19a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <errno.h> 20a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <pthread.h> 21a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <unistd.h> 22a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <string.h> 23a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <stdarg.h> 24a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 25a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <sys/mman.h> 26a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <sys/stat.h> 27a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <sys/types.h> 28a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <sys/ioctl.h> 29a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <linux/ashmem.h> 30a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 31a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <cutils/log.h> 32a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <cutils/atomic.h> 33a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <cutils/ashmem.h> 34a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 35a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <hardware/hardware.h> 36a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <hardware/gralloc.h> 37a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <genlock.h> 38a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 39a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include <linux/android_pmem.h> 40a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 41a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include "gralloc_priv.h" 42a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include "gr.h" 43a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include "alloc_controller.h" 44a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev#include "memalloc.h" 45a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 46a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevusing namespace gralloc; 47a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev/*****************************************************************************/ 48a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 49a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev// Return the type of allocator - 50a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev// these are used for mapping/unmapping 51be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmedstatic IMemAlloc* getAllocator(int flags) 52a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 53be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed IMemAlloc* memalloc; 54be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed IAllocController* alloc_ctrl = IAllocController::getInstance(); 55a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev memalloc = alloc_ctrl->getAllocator(flags); 56a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return memalloc; 57a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 58a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 59a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevstatic int gralloc_map(gralloc_module_t const* module, 60befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle, 61befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed void** vaddr) 62a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 63a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 64a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev void *mappedAddress; 65a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (!(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER) && 66a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev !(hnd->flags & private_handle_t::PRIV_FLAGS_SECURE_BUFFER)) { 67a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev size_t size = hnd->size; 68be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 69a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int err = memalloc->map_buffer(&mappedAddress, size, 70befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed hnd->offset, hnd->fd); 71a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if(err) { 72a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE("Could not mmap handle %p, fd=%d (%s)", 73befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed handle, hnd->fd, strerror(errno)); 74a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->base = 0; 75a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -errno; 76a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 77a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 78a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (mappedAddress == MAP_FAILED) { 79a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE("Could not mmap handle %p, fd=%d (%s)", 80befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed handle, hnd->fd, strerror(errno)); 81a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->base = 0; 82a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -errno; 83a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 84a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->base = intptr_t(mappedAddress) + hnd->offset; 85befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed //LOGD("gralloc_map() succeeded fd=%d, off=%d, size=%d, vaddr=%p", 86a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // hnd->fd, hnd->offset, hnd->size, mappedAddress); 87a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 88a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev *vaddr = (void*)hnd->base; 89a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 90a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 91a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 92a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevstatic int gralloc_unmap(gralloc_module_t const* module, 93befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle) 94a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 95a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 96a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (!(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)) { 97a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int err = -EINVAL; 98a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev void* base = (void*)hnd->base; 99a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev size_t size = hnd->size; 100be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 101a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if(memalloc != NULL) 102a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev err = memalloc->unmap_buffer(base, size, hnd->offset); 103a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (err) { 104a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE("Could not unmap memory at address %p", base); 105a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 106a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 107a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->base = 0; 108a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 109a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 110a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 111a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev/*****************************************************************************/ 112a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 113a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevstatic pthread_mutex_t sMapLock = PTHREAD_MUTEX_INITIALIZER; 114a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 115a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev/*****************************************************************************/ 116a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 117a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint gralloc_register_buffer(gralloc_module_t const* module, 118befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle) 119a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 120a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (private_handle_t::validate(handle) < 0) 121a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 122a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 123a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // In this implementation, we don't need to do anything here 124a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 125a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev /* NOTE: we need to initialize the buffer as not mapped/not locked 126a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * because it shouldn't when this function is called the first time 127a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * in a new process. Ideally these flags shouldn't be part of the 128a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * handle, but instead maintained in the kernel or at least 129a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * out-of-line 130a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev */ 131a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 132a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 13377a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar hnd->base = 0; 13477a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar void *vaddr; 13577a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar int err = gralloc_map(module, handle, &vaddr); 13677a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar if (err) { 13777a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar ALOGE("%s: gralloc_map failed", __FUNCTION__); 13877a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar return err; 13977a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar } 140a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 14177a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar // Reset the genlock private fd flag in the handle 14277a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar hnd->genlockPrivFd = -1; 143a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 14477a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar // Check if there is a valid lock attached to the handle. 14577a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar if (-1 == hnd->genlockHandle) { 14677a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar ALOGE("%s: the lock is invalid.", __FUNCTION__); 14777a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar gralloc_unmap(module, handle); 14877a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar hnd->base = 0; 14977a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar return -EINVAL; 15077a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar } 151a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 15277a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar // Attach the genlock handle 15377a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar if (GENLOCK_NO_ERROR != genlock_attach_lock((native_handle_t *)handle)) { 15477a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar ALOGE("%s: genlock_attach_lock failed", __FUNCTION__); 15577a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar gralloc_unmap(module, handle); 15677a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar hnd->base = 0; 15777a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar return -EINVAL; 158a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 159a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 160a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 161a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 162a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint gralloc_unregister_buffer(gralloc_module_t const* module, 163befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle) 164a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 165a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (private_handle_t::validate(handle) < 0) 166a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 167a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 168a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev /* 169a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * If the buffer has been mapped during a lock operation, it's time 170a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * to un-map it. It's an error to be here with a locked buffer. 171a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * NOTE: the framebuffer is handled differently and is never unmapped. 172a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev */ 173a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 174a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 175a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 17677a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar if (hnd->base != 0) { 17777a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar gralloc_unmap(module, handle); 17877a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar } 17977a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar hnd->base = 0; 18077a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar // Release the genlock 18177a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar if (-1 != hnd->genlockHandle) { 18277a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar return genlock_release_lock((native_handle_t *)handle); 18377a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar } else { 18477a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar ALOGE("%s: there was no genlock attached to this buffer", __FUNCTION__); 18577a5ae0adc2e220228a988c65696757b37d0826eKinjal Bhavsar return -EINVAL; 186a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 187a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 188a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 189a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 190a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint terminateBuffer(gralloc_module_t const* module, 191befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed private_handle_t* hnd) 192a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 193a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev /* 194a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * If the buffer has been mapped during a lock operation, it's time 195a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev * to un-map it. It's an error to be here with a locked buffer. 196a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev */ 197a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 198a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (hnd->base != 0) { 199a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // this buffer was mapped, unmap it now 200a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (hnd->flags & (private_handle_t::PRIV_FLAGS_USES_PMEM | 201a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t::PRIV_FLAGS_USES_PMEM_ADSP | 202a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t::PRIV_FLAGS_USES_ASHMEM | 203a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t::PRIV_FLAGS_USES_ION)) { 204a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev gralloc_unmap(module, hnd); 205a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } else { 206befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed ALOGE("terminateBuffer: unmapping a non pmem/ashmem buffer flags = 0x%x", 207befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed hnd->flags); 208a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev gralloc_unmap(module, hnd); 209a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 210a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 211a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 212a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 213a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 214a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 215a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint gralloc_lock(gralloc_module_t const* module, 216befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle, int usage, 217befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed int l, int t, int w, int h, 218befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed void** vaddr) 219a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 220a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (private_handle_t::validate(handle) < 0) 221a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 222a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 223a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int err = 0; 224a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 225a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (usage & (GRALLOC_USAGE_SW_READ_MASK | GRALLOC_USAGE_SW_WRITE_MASK)) { 226a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (hnd->base == 0) { 227a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // we need to map for real 228a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev pthread_mutex_t* const lock = &sMapLock; 229a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev pthread_mutex_lock(lock); 230a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev err = gralloc_map(module, handle, vaddr); 231a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev pthread_mutex_unlock(lock); 232a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 233a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev *vaddr = (void*)hnd->base; 234a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 235a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // Lock the buffer for read/write operation as specified. Write lock 236a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // has a higher priority over read lock. 237a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int lockType = 0; 238a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (usage & GRALLOC_USAGE_SW_WRITE_MASK) { 239a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev lockType = GENLOCK_WRITE_LOCK; 240a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } else if (usage & GRALLOC_USAGE_SW_READ_MASK) { 241a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev lockType = GENLOCK_READ_LOCK; 242a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 243a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 244a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int timeout = GENLOCK_MAX_TIMEOUT; 245a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (GENLOCK_NO_ERROR != genlock_lock_buffer((native_handle_t *)handle, 246befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed (genlock_lock_type)lockType, 247befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed timeout)) { 248a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE("%s: genlock_lock_buffer (lockType=0x%x) failed", __FUNCTION__, 249befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed lockType); 250a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 251a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } else { 252a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // Mark this buffer as locked for SW read/write operation. 253a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->flags |= private_handle_t::PRIV_FLAGS_SW_LOCK; 254a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 255a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 256a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if ((usage & GRALLOC_USAGE_SW_WRITE_MASK) && 257a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev !(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)) { 258a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // Mark the buffer to be flushed after cpu read/write 259a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->flags |= private_handle_t::PRIV_FLAGS_NEEDS_FLUSH; 260a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 261a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 262a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return err; 263a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 264a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 265a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint gralloc_unlock(gralloc_module_t const* module, 266befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed buffer_handle_t handle) 267a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 268a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (private_handle_t::validate(handle) < 0) 269a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 270a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 271a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 272a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 273a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (hnd->flags & private_handle_t::PRIV_FLAGS_NEEDS_FLUSH) { 274a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int err; 275be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 276a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev err = memalloc->clean_buffer((void*)hnd->base, 277befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed hnd->size, hnd->offset, hnd->fd); 278a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE_IF(err < 0, "cannot flush handle %p (offs=%x len=%x, flags = 0x%x) err=%s\n", 279befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed hnd, hnd->offset, hnd->size, hnd->flags, strerror(errno)); 280a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->flags &= ~private_handle_t::PRIV_FLAGS_NEEDS_FLUSH; 281a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 282a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 283a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if ((hnd->flags & private_handle_t::PRIV_FLAGS_SW_LOCK)) { 284a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev // Unlock the buffer. 285a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev if (GENLOCK_NO_ERROR != genlock_unlock_buffer((native_handle_t *)handle)) { 286a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev ALOGE("%s: genlock_unlock_buffer failed", __FUNCTION__); 287a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return -EINVAL; 288a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } else 289a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->flags &= ~private_handle_t::PRIV_FLAGS_SW_LOCK; 290a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 291a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return 0; 292a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 293a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 294a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev/*****************************************************************************/ 295a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 296a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchevint gralloc_perform(struct gralloc_module_t const* module, 297befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed int operation, ... ) 298a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev{ 299a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int res = -EINVAL; 300a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev va_list args; 301a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev va_start(args, operation); 302a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev switch (operation) { 303a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev case GRALLOC_MODULE_PERFORM_CREATE_HANDLE_FROM_BUFFER: 304a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev { 305a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int fd = va_arg(args, int); 306a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev size_t size = va_arg(args, size_t); 307a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev size_t offset = va_arg(args, size_t); 308a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev void* base = va_arg(args, void*); 309a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int width = va_arg(args, int); 310a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int height = va_arg(args, int); 311a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int format = va_arg(args, int); 312a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 313a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev native_handle_t** handle = va_arg(args, native_handle_t**); 314a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev int memoryFlags = va_arg(args, int); 315a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev private_handle_t* hnd = (private_handle_t*)native_handle_create( 316befc466069680cb8a65b1f22ad44723d949128c8Naseer Ahmed private_handle_t::sNumFds, private_handle_t::sNumInts); 317a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->magic = private_handle_t::sMagic; 318a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->fd = fd; 319be2e1bb9057c8d0666de057743eeb898c78f34b0Naseer Ahmed hnd->flags = private_handle_t::PRIV_FLAGS_USES_ION; 320a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->size = size; 321a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->offset = offset; 322a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->base = intptr_t(base) + offset; 323a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->gpuaddr = 0; 324a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->width = width; 325a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->height = height; 326a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev hnd->format = format; 327a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev *handle = (native_handle_t *)hnd; 328a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev res = 0; 329a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev break; 330a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev 331a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 332a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev default: 333a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev break; 334a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev } 335a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev va_end(args); 336a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev return res; 337a19f21d925628239ef52c8ce392fa4ada91df6fcIliyan Malchev} 338