mapper.cpp revision c0945d8a389f71cdf8432947a6911838d1219c4b
1202a77d28ac251545f6f998a974690212309b927Iliyan Malchev/* 2202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * Copyright (C) 2008 The Android Open Source Project 329a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed * Copyright (c) 2011-2012, Code Aurora Forum. All rights reserved. 4202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * 5202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * Licensed under the Apache License, Version 2.0 (the "License"); 6202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * you may not use this file except in compliance with the License. 7202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * You may obtain a copy of the License at 8202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * 9202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * http://www.apache.org/licenses/LICENSE-2.0 10202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * 11202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * Unless required by applicable law or agreed to in writing, software 12202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * distributed under the License is distributed on an "AS IS" BASIS, 13202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * See the License for the specific language governing permissions and 15202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * limitations under the License. 16202a77d28ac251545f6f998a974690212309b927Iliyan Malchev */ 17202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 18202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <limits.h> 19202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <errno.h> 20202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <pthread.h> 21202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <unistd.h> 22202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <string.h> 23202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <stdarg.h> 24202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 25202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <sys/mman.h> 26202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <sys/stat.h> 27202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <sys/types.h> 28202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <sys/ioctl.h> 29202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <linux/ashmem.h> 30202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 31202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <cutils/log.h> 32202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <cutils/atomic.h> 33202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <cutils/ashmem.h> 34202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 35202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <hardware/hardware.h> 36202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <hardware/gralloc.h> 37202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <genlock.h> 38202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 39202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include <linux/android_pmem.h> 40202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 41202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include "gralloc_priv.h" 42202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include "gr.h" 43202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include "alloc_controller.h" 44202a77d28ac251545f6f998a974690212309b927Iliyan Malchev#include "memalloc.h" 45c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan#include <qdMetaData.h> 46202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 47202a77d28ac251545f6f998a974690212309b927Iliyan Malchevusing namespace gralloc; 48202a77d28ac251545f6f998a974690212309b927Iliyan Malchev/*****************************************************************************/ 49202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 50202a77d28ac251545f6f998a974690212309b927Iliyan Malchev// Return the type of allocator - 51202a77d28ac251545f6f998a974690212309b927Iliyan Malchev// these are used for mapping/unmapping 5201d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmedstatic IMemAlloc* getAllocator(int flags) 53202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 5401d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed IMemAlloc* memalloc; 5501d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed IAllocController* alloc_ctrl = IAllocController::getInstance(); 56202a77d28ac251545f6f998a974690212309b927Iliyan Malchev memalloc = alloc_ctrl->getAllocator(flags); 57202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return memalloc; 58202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 59202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 60202a77d28ac251545f6f998a974690212309b927Iliyan Malchevstatic int gralloc_map(gralloc_module_t const* module, 6129a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle, 6229a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed void** vaddr) 63202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 64202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 65202a77d28ac251545f6f998a974690212309b927Iliyan Malchev void *mappedAddress; 66202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (!(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER) && 67202a77d28ac251545f6f998a974690212309b927Iliyan Malchev !(hnd->flags & private_handle_t::PRIV_FLAGS_SECURE_BUFFER)) { 68202a77d28ac251545f6f998a974690212309b927Iliyan Malchev size_t size = hnd->size; 6901d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 70202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int err = memalloc->map_buffer(&mappedAddress, size, 7129a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed hnd->offset, hnd->fd); 72c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan if(err || mappedAddress == MAP_FAILED) { 73202a77d28ac251545f6f998a974690212309b927Iliyan Malchev ALOGE("Could not mmap handle %p, fd=%d (%s)", 7429a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed handle, hnd->fd, strerror(errno)); 75202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->base = 0; 76202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -errno; 77202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 78202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 79202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->base = intptr_t(mappedAddress) + hnd->offset; 8029a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed //LOGD("gralloc_map() succeeded fd=%d, off=%d, size=%d, vaddr=%p", 81202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // hnd->fd, hnd->offset, hnd->size, mappedAddress); 82c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan mappedAddress = MAP_FAILED; 83c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 84c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan err = memalloc->map_buffer(&mappedAddress, size, 85c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan hnd->offset_metadata, hnd->fd_metadata); 86c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan if(err || mappedAddress == MAP_FAILED) { 87c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan ALOGE("Could not mmap handle %p, fd=%d (%s)", 88c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan handle, hnd->fd_metadata, strerror(errno)); 89c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan hnd->base_metadata = 0; 90c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan return -errno; 91c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan } 92c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan hnd->base_metadata = intptr_t(mappedAddress) + hnd->offset_metadata; 93202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 94202a77d28ac251545f6f998a974690212309b927Iliyan Malchev *vaddr = (void*)hnd->base; 95202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 96202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 97202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 98202a77d28ac251545f6f998a974690212309b927Iliyan Malchevstatic int gralloc_unmap(gralloc_module_t const* module, 9929a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle) 100202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 101202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 102202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (!(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)) { 103202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int err = -EINVAL; 104202a77d28ac251545f6f998a974690212309b927Iliyan Malchev void* base = (void*)hnd->base; 105202a77d28ac251545f6f998a974690212309b927Iliyan Malchev size_t size = hnd->size; 10601d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 107c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan if(memalloc != NULL) { 108202a77d28ac251545f6f998a974690212309b927Iliyan Malchev err = memalloc->unmap_buffer(base, size, hnd->offset); 109c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan if (err) { 110c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan ALOGE("Could not unmap memory at address %p", base); 111c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan } 112c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan base = (void*)hnd->base_metadata; 113c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 114c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan err = memalloc->unmap_buffer(base, size, hnd->offset_metadata); 115c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan if (err) { 116c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan ALOGE("Could not unmap memory at address %p", base); 117c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan } 118202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 119202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 120202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->base = 0; 121202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 122202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 123202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 124202a77d28ac251545f6f998a974690212309b927Iliyan Malchev/*****************************************************************************/ 125202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 126202a77d28ac251545f6f998a974690212309b927Iliyan Malchevstatic pthread_mutex_t sMapLock = PTHREAD_MUTEX_INITIALIZER; 127202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 128202a77d28ac251545f6f998a974690212309b927Iliyan Malchev/*****************************************************************************/ 129202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 130202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint gralloc_register_buffer(gralloc_module_t const* module, 13129a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle) 132202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 133202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (private_handle_t::validate(handle) < 0) 134202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 135202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 136202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // In this implementation, we don't need to do anything here 137202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 138202a77d28ac251545f6f998a974690212309b927Iliyan Malchev /* NOTE: we need to initialize the buffer as not mapped/not locked 139202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * because it shouldn't when this function is called the first time 140202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * in a new process. Ideally these flags shouldn't be part of the 141202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * handle, but instead maintained in the kernel or at least 142202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * out-of-line 143202a77d28ac251545f6f998a974690212309b927Iliyan Malchev */ 144202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 145202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 146139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar hnd->base = 0; 147139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar void *vaddr; 148139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar int err = gralloc_map(module, handle, &vaddr); 149139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar if (err) { 150139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar ALOGE("%s: gralloc_map failed", __FUNCTION__); 151139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar return err; 152139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar } 153202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 154139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar // Reset the genlock private fd flag in the handle 155139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar hnd->genlockPrivFd = -1; 156202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 157139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar // Check if there is a valid lock attached to the handle. 158139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar if (-1 == hnd->genlockHandle) { 159139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar ALOGE("%s: the lock is invalid.", __FUNCTION__); 160139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar gralloc_unmap(module, handle); 161139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar hnd->base = 0; 162139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar return -EINVAL; 163139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar } 164202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 165139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar // Attach the genlock handle 166139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar if (GENLOCK_NO_ERROR != genlock_attach_lock((native_handle_t *)handle)) { 167139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar ALOGE("%s: genlock_attach_lock failed", __FUNCTION__); 168139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar gralloc_unmap(module, handle); 169139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar hnd->base = 0; 170139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar return -EINVAL; 171202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 172202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 173202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 174202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 175202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint gralloc_unregister_buffer(gralloc_module_t const* module, 17629a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle) 177202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 178202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (private_handle_t::validate(handle) < 0) 179202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 180202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 181202a77d28ac251545f6f998a974690212309b927Iliyan Malchev /* 182202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * If the buffer has been mapped during a lock operation, it's time 183202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * to un-map it. It's an error to be here with a locked buffer. 184202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * NOTE: the framebuffer is handled differently and is never unmapped. 185202a77d28ac251545f6f998a974690212309b927Iliyan Malchev */ 186202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 187202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 188202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 189139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar if (hnd->base != 0) { 190139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar gralloc_unmap(module, handle); 191139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar } 192139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar hnd->base = 0; 193139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar // Release the genlock 194139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar if (-1 != hnd->genlockHandle) { 195139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar return genlock_release_lock((native_handle_t *)handle); 196139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar } else { 197139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar ALOGE("%s: there was no genlock attached to this buffer", __FUNCTION__); 198139e162e3457f86a7b4a6b4927c75c477ef98100Kinjal Bhavsar return -EINVAL; 199202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 200202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 201202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 202202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 203202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint terminateBuffer(gralloc_module_t const* module, 20429a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed private_handle_t* hnd) 205202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 206202a77d28ac251545f6f998a974690212309b927Iliyan Malchev /* 207202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * If the buffer has been mapped during a lock operation, it's time 208202a77d28ac251545f6f998a974690212309b927Iliyan Malchev * to un-map it. It's an error to be here with a locked buffer. 209202a77d28ac251545f6f998a974690212309b927Iliyan Malchev */ 210202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 211202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (hnd->base != 0) { 212202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // this buffer was mapped, unmap it now 213202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (hnd->flags & (private_handle_t::PRIV_FLAGS_USES_PMEM | 214202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t::PRIV_FLAGS_USES_PMEM_ADSP | 215202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t::PRIV_FLAGS_USES_ASHMEM | 216202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t::PRIV_FLAGS_USES_ION)) { 217202a77d28ac251545f6f998a974690212309b927Iliyan Malchev gralloc_unmap(module, hnd); 218202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } else { 21929a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed ALOGE("terminateBuffer: unmapping a non pmem/ashmem buffer flags = 0x%x", 22029a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed hnd->flags); 221202a77d28ac251545f6f998a974690212309b927Iliyan Malchev gralloc_unmap(module, hnd); 222202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 223202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 224202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 225202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 226202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 227202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 228202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint gralloc_lock(gralloc_module_t const* module, 22929a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle, int usage, 23029a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed int l, int t, int w, int h, 23129a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed void** vaddr) 232202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 233202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (private_handle_t::validate(handle) < 0) 234202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 235202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 236202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int err = 0; 237202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 238202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (usage & (GRALLOC_USAGE_SW_READ_MASK | GRALLOC_USAGE_SW_WRITE_MASK)) { 239202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (hnd->base == 0) { 240202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // we need to map for real 241202a77d28ac251545f6f998a974690212309b927Iliyan Malchev pthread_mutex_t* const lock = &sMapLock; 242202a77d28ac251545f6f998a974690212309b927Iliyan Malchev pthread_mutex_lock(lock); 243202a77d28ac251545f6f998a974690212309b927Iliyan Malchev err = gralloc_map(module, handle, vaddr); 244202a77d28ac251545f6f998a974690212309b927Iliyan Malchev pthread_mutex_unlock(lock); 245202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 246202a77d28ac251545f6f998a974690212309b927Iliyan Malchev *vaddr = (void*)hnd->base; 247202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 248202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // Lock the buffer for read/write operation as specified. Write lock 249202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // has a higher priority over read lock. 250202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int lockType = 0; 251202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (usage & GRALLOC_USAGE_SW_WRITE_MASK) { 252202a77d28ac251545f6f998a974690212309b927Iliyan Malchev lockType = GENLOCK_WRITE_LOCK; 253202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } else if (usage & GRALLOC_USAGE_SW_READ_MASK) { 254202a77d28ac251545f6f998a974690212309b927Iliyan Malchev lockType = GENLOCK_READ_LOCK; 255202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 256202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 257202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int timeout = GENLOCK_MAX_TIMEOUT; 258202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (GENLOCK_NO_ERROR != genlock_lock_buffer((native_handle_t *)handle, 25929a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed (genlock_lock_type)lockType, 26029a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed timeout)) { 261202a77d28ac251545f6f998a974690212309b927Iliyan Malchev ALOGE("%s: genlock_lock_buffer (lockType=0x%x) failed", __FUNCTION__, 26229a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed lockType); 263202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 264202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } else { 265202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // Mark this buffer as locked for SW read/write operation. 266202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->flags |= private_handle_t::PRIV_FLAGS_SW_LOCK; 267202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 268202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 269202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if ((usage & GRALLOC_USAGE_SW_WRITE_MASK) && 270202a77d28ac251545f6f998a974690212309b927Iliyan Malchev !(hnd->flags & private_handle_t::PRIV_FLAGS_FRAMEBUFFER)) { 271202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // Mark the buffer to be flushed after cpu read/write 272202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->flags |= private_handle_t::PRIV_FLAGS_NEEDS_FLUSH; 273202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 274202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 275202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return err; 276202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 277202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 278202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint gralloc_unlock(gralloc_module_t const* module, 27929a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed buffer_handle_t handle) 280202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 281202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (private_handle_t::validate(handle) < 0) 282202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 283202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 284202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)handle; 285202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 286202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (hnd->flags & private_handle_t::PRIV_FLAGS_NEEDS_FLUSH) { 287202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int err; 28801d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed IMemAlloc* memalloc = getAllocator(hnd->flags) ; 289202a77d28ac251545f6f998a974690212309b927Iliyan Malchev err = memalloc->clean_buffer((void*)hnd->base, 29029a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed hnd->size, hnd->offset, hnd->fd); 291202a77d28ac251545f6f998a974690212309b927Iliyan Malchev ALOGE_IF(err < 0, "cannot flush handle %p (offs=%x len=%x, flags = 0x%x) err=%s\n", 29229a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed hnd, hnd->offset, hnd->size, hnd->flags, strerror(errno)); 293c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 294c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan err = memalloc->clean_buffer((void*)hnd->base_metadata, size, 295c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan hnd->offset_metadata, hnd->fd_metadata); 296c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan ALOGE_IF(err < 0, "cannot flush handle %p (offs=%x len=%lu, " 297c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan "flags = 0x%x) err=%s\n", hnd, hnd->offset_metadata, size, 298c0945d8a389f71cdf8432947a6911838d1219c4bRamkumar Radhakrishnan hnd->flags, strerror(errno)); 299202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->flags &= ~private_handle_t::PRIV_FLAGS_NEEDS_FLUSH; 300202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 301202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 302202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if ((hnd->flags & private_handle_t::PRIV_FLAGS_SW_LOCK)) { 303202a77d28ac251545f6f998a974690212309b927Iliyan Malchev // Unlock the buffer. 304202a77d28ac251545f6f998a974690212309b927Iliyan Malchev if (GENLOCK_NO_ERROR != genlock_unlock_buffer((native_handle_t *)handle)) { 305202a77d28ac251545f6f998a974690212309b927Iliyan Malchev ALOGE("%s: genlock_unlock_buffer failed", __FUNCTION__); 306202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return -EINVAL; 307202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } else 308202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->flags &= ~private_handle_t::PRIV_FLAGS_SW_LOCK; 309202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 310202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return 0; 311202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 312202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 313202a77d28ac251545f6f998a974690212309b927Iliyan Malchev/*****************************************************************************/ 314202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 315202a77d28ac251545f6f998a974690212309b927Iliyan Malchevint gralloc_perform(struct gralloc_module_t const* module, 31629a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed int operation, ... ) 317202a77d28ac251545f6f998a974690212309b927Iliyan Malchev{ 318202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int res = -EINVAL; 319202a77d28ac251545f6f998a974690212309b927Iliyan Malchev va_list args; 320202a77d28ac251545f6f998a974690212309b927Iliyan Malchev va_start(args, operation); 321202a77d28ac251545f6f998a974690212309b927Iliyan Malchev switch (operation) { 322202a77d28ac251545f6f998a974690212309b927Iliyan Malchev case GRALLOC_MODULE_PERFORM_CREATE_HANDLE_FROM_BUFFER: 323202a77d28ac251545f6f998a974690212309b927Iliyan Malchev { 324202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int fd = va_arg(args, int); 325202a77d28ac251545f6f998a974690212309b927Iliyan Malchev size_t size = va_arg(args, size_t); 326202a77d28ac251545f6f998a974690212309b927Iliyan Malchev size_t offset = va_arg(args, size_t); 327202a77d28ac251545f6f998a974690212309b927Iliyan Malchev void* base = va_arg(args, void*); 328202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int width = va_arg(args, int); 329202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int height = va_arg(args, int); 330202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int format = va_arg(args, int); 331202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 332202a77d28ac251545f6f998a974690212309b927Iliyan Malchev native_handle_t** handle = va_arg(args, native_handle_t**); 333202a77d28ac251545f6f998a974690212309b927Iliyan Malchev int memoryFlags = va_arg(args, int); 334202a77d28ac251545f6f998a974690212309b927Iliyan Malchev private_handle_t* hnd = (private_handle_t*)native_handle_create( 33529a26818d7294055539167b2fbfdaa168bcf725cNaseer Ahmed private_handle_t::sNumFds, private_handle_t::sNumInts); 336202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->magic = private_handle_t::sMagic; 337202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->fd = fd; 33801d3fd3318a767e6ba75492ed08d57896df95d63Naseer Ahmed hnd->flags = private_handle_t::PRIV_FLAGS_USES_ION; 339202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->size = size; 340202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->offset = offset; 341202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->base = intptr_t(base) + offset; 342202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->gpuaddr = 0; 343202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->width = width; 344202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->height = height; 345202a77d28ac251545f6f998a974690212309b927Iliyan Malchev hnd->format = format; 346202a77d28ac251545f6f998a974690212309b927Iliyan Malchev *handle = (native_handle_t *)hnd; 347202a77d28ac251545f6f998a974690212309b927Iliyan Malchev res = 0; 348202a77d28ac251545f6f998a974690212309b927Iliyan Malchev break; 349202a77d28ac251545f6f998a974690212309b927Iliyan Malchev 350202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 351e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan case GRALLOC_MODULE_PERFORM_UPDATE_BUFFER_GEOMETRY: 352e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan { 353e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan int width = va_arg(args, int); 354e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan int height = va_arg(args, int); 355e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan int format = va_arg(args, int); 356e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan private_handle_t* hnd = va_arg(args, private_handle_t*); 357e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan if (private_handle_t::validate(hnd)) { 358e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan return res; 359e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan } 360e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan hnd->width = width; 361e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan hnd->height = height; 362e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan hnd->format = format; 363e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan res = 0; 364e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan } 365e15a1a9ff2891695fbea56ecb8339e8dd06a0eefRamkumar Radhakrishnan break; 366202a77d28ac251545f6f998a974690212309b927Iliyan Malchev default: 367202a77d28ac251545f6f998a974690212309b927Iliyan Malchev break; 368202a77d28ac251545f6f998a974690212309b927Iliyan Malchev } 369202a77d28ac251545f6f998a974690212309b927Iliyan Malchev va_end(args); 370202a77d28ac251545f6f998a974690212309b927Iliyan Malchev return res; 371202a77d28ac251545f6f998a974690212309b927Iliyan Malchev} 372