/* * Copyright (c) 2012-2017, The Linux Foundation. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are * met: * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * * Neither the name of The Linux Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include <errno.h> #include <string.h> #include <sys/mman.h> #include <cutils/log.h> #include <cinttypes> #include <gralloc_priv.h> #include "qdMetaData.h" static int validateAndMap(private_handle_t* handle) { if (private_handle_t::validate(handle)) { ALOGE("%s: Private handle is invalid - handle:%p", __func__, handle); return -1; } if (handle->fd_metadata == -1) { ALOGE("%s: Invalid metadata fd - handle:%p id: %" PRIu64 "fd: %d", __func__, handle, handle->id, handle->fd_metadata); return -1; } if (!handle->base_metadata) { unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); void *base = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED, handle->fd_metadata, 0); if (base == reinterpret_cast<void*>(MAP_FAILED)) { ALOGE("%s: metadata mmap failed - handle:%p id: %" PRIu64 "fd: %d err: %s", __func__, handle, handle->id, handle->fd_metadata, strerror(errno)); return -1; } handle->base_metadata = (uintptr_t) base; } return 0; } int setMetaData(private_handle_t *handle, DispParamType paramType, void *param) { auto err = validateAndMap(handle); if (err != 0) return err; MetaData_t *data = reinterpret_cast <MetaData_t *>(handle->base_metadata); // If parameter is NULL reset the specific MetaData Key if (!param) { data->operation &= ~paramType; // param unset return 0; } data->operation |= paramType; switch (paramType) { case PP_PARAM_INTERLACED: data->interlaced = *((int32_t *)param); break; case UPDATE_BUFFER_GEOMETRY: data->bufferDim = *((BufferDim_t *)param); break; case UPDATE_REFRESH_RATE: data->refreshrate = *((float *)param); break; case UPDATE_COLOR_SPACE: data->colorSpace = *((ColorSpace_t *)param); break; case MAP_SECURE_BUFFER: data->mapSecureBuffer = *((int32_t *)param); break; case S3D_FORMAT: data->s3dFormat = *((uint32_t *)param); break; case LINEAR_FORMAT: data->linearFormat = *((uint32_t *)param); break; case SET_IGC: data->igc = *((IGC_t *)param); break; case SET_SINGLE_BUFFER_MODE: data->isSingleBufferMode = *((uint32_t *)param); break; case SET_S3D_COMP: data->s3dComp = *((S3DGpuComp_t *)param); break; case SET_VT_TIMESTAMP: data->vtTimeStamp = *((uint64_t *)param); break; #ifdef USE_COLOR_METADATA case COLOR_METADATA: data->color = *((ColorMetaData *)param); #endif break; default: ALOGE("Unknown paramType %d", paramType); break; } return 0; } int clearMetaData(private_handle_t *handle, DispParamType paramType) { auto err = validateAndMap(handle); if (err != 0) return err; MetaData_t *data = reinterpret_cast <MetaData_t *>(handle->base_metadata); data->operation &= ~paramType; switch (paramType) { case SET_S3D_COMP: data->s3dComp.displayId = -1; data->s3dComp.s3dMode = 0; break; default: ALOGE("Unknown paramType %d", paramType); break; } return 0; } int getMetaData(private_handle_t *handle, DispFetchParamType paramType, void *param) { int ret = validateAndMap(handle); if (ret != 0) return ret; MetaData_t *data = reinterpret_cast <MetaData_t *>(handle->base_metadata); // Make sure we send 0 only if the operation queried is present ret = -EINVAL; switch (paramType) { case GET_PP_PARAM_INTERLACED: if (data->operation & PP_PARAM_INTERLACED) { *((int32_t *)param) = data->interlaced; ret = 0; } break; case GET_BUFFER_GEOMETRY: if (data->operation & UPDATE_BUFFER_GEOMETRY) { *((BufferDim_t *)param) = data->bufferDim; ret = 0; } break; case GET_REFRESH_RATE: if (data->operation & UPDATE_REFRESH_RATE) { *((float *)param) = data->refreshrate; ret = 0; } break; case GET_COLOR_SPACE: if (data->operation & UPDATE_COLOR_SPACE) { *((ColorSpace_t *)param) = data->colorSpace; ret = 0; } break; case GET_MAP_SECURE_BUFFER: if (data->operation & MAP_SECURE_BUFFER) { *((int32_t *)param) = data->mapSecureBuffer; ret = 0; } break; case GET_S3D_FORMAT: if (data->operation & S3D_FORMAT) { *((uint32_t *)param) = data->s3dFormat; ret = 0; } break; case GET_LINEAR_FORMAT: if (data->operation & LINEAR_FORMAT) { *((uint32_t *)param) = data->linearFormat; ret = 0; } break; case GET_IGC: if (data->operation & SET_IGC) { *((IGC_t *)param) = data->igc; ret = 0; } break; case GET_SINGLE_BUFFER_MODE: if (data->operation & SET_SINGLE_BUFFER_MODE) { *((uint32_t *)param) = data->isSingleBufferMode; ret = 0; } break; case GET_S3D_COMP: if (data->operation & SET_S3D_COMP) { *((S3DGpuComp_t *)param) = data->s3dComp; ret = 0; } break; case GET_VT_TIMESTAMP: if (data->operation & SET_VT_TIMESTAMP) { *((uint64_t *)param) = data->vtTimeStamp; ret = 0; } break; #ifdef USE_COLOR_METADATA case GET_COLOR_METADATA: if (data->operation & COLOR_METADATA) { *((ColorMetaData *)param) = data->color; ret = 0; } #endif break; default: ALOGE("Unknown paramType %d", paramType); break; } return ret; } int copyMetaData(struct private_handle_t *src, struct private_handle_t *dst) { auto err = validateAndMap(src); if (err != 0) return err; err = validateAndMap(dst); if (err != 0) return err; unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); MetaData_t *src_data = reinterpret_cast <MetaData_t *>(src->base_metadata); MetaData_t *dst_data = reinterpret_cast <MetaData_t *>(dst->base_metadata); memcpy(src_data, dst_data, size); return 0; }