1 /* 2 * Copyright (c) 2012-2016, The Linux Foundation. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions are 6 * met: 7 * * Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * * Redistributions in binary form must reproduce the above 10 * copyright notice, this list of conditions and the following 11 * disclaimer in the documentation and/or other materials provided 12 * with the distribution. 13 * * Neither the name of The Linux Foundation nor the names of its 14 * contributors may be used to endorse or promote products derived 15 * from this software without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED 18 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS 21 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 22 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR 24 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 25 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE 26 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN 27 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 28 */ 29 30 #include <errno.h> 31 #include <string.h> 32 #include <sys/mman.h> 33 #include <cutils/log.h> 34 #include <gralloc_priv.h> 35 #define __STDC_FORMAT_MACROS 1 36 #include <inttypes.h> 37 #include "qdMetaData.h" 38 39 int setMetaData(private_handle_t *handle, DispParamType paramType, 40 void *param) { 41 if (!handle) { 42 ALOGE("%s: Private handle is null!", __func__); 43 return -1; 44 } 45 if (handle->fd_metadata == -1) { 46 ALOGE("%s: Bad fd for extra data!", __func__); 47 return -1; 48 } 49 if (!param) { 50 ALOGE("%s: input param is null!", __func__); 51 return -1; 52 } 53 unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 54 void *base = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED, 55 handle->fd_metadata, 0); 56 if (base == reinterpret_cast<void*>(MAP_FAILED)) { 57 ALOGE("%s: mmap() failed: error is %s!", __func__, strerror(errno)); 58 return -1; 59 } 60 MetaData_t *data = reinterpret_cast <MetaData_t *>(base); 61 data->operation |= paramType; 62 switch (paramType) { 63 case PP_PARAM_INTERLACED: 64 data->interlaced = *((int32_t *)param); 65 break; 66 case UPDATE_BUFFER_GEOMETRY: 67 data->bufferDim = *((BufferDim_t *)param); 68 break; 69 case UPDATE_REFRESH_RATE: 70 data->refreshrate = *((float *)param); 71 break; 72 case UPDATE_COLOR_SPACE: 73 data->colorSpace = *((ColorSpace_t *)param); 74 break; 75 case MAP_SECURE_BUFFER: 76 data->mapSecureBuffer = *((int32_t *)param); 77 break; 78 case S3D_FORMAT: 79 data->s3dFormat = *((uint32_t *)param); 80 break; 81 case LINEAR_FORMAT: 82 data->linearFormat = *((uint32_t *)param); 83 break; 84 case SET_IGC: 85 data->igc = *((IGC_t *)param); 86 break; 87 case SET_SINGLE_BUFFER_MODE: 88 data->isSingleBufferMode = *((uint32_t *)param); 89 break; 90 case SET_VT_TIMESTAMP: 91 data->vtTimeStamp = *((uint64_t *)param); 92 break; 93 default: 94 ALOGE("Unknown paramType %d", paramType); 95 break; 96 } 97 if(munmap(base, size)) 98 ALOGE("%s: failed to unmap ptr %p, err %d", __func__, (void*)base, 99 errno); 100 return 0; 101 } 102 103 int getMetaData(private_handle_t *handle, DispFetchParamType paramType, 104 void *param) { 105 if (!handle) { 106 ALOGE("%s: Private handle is null!", __func__); 107 return -1; 108 } 109 if (handle->fd_metadata == -1) { 110 ALOGE("%s: Bad fd for extra data!", __func__); 111 return -1; 112 } 113 if (!param) { 114 ALOGE("%s: input param is null!", __func__); 115 return -1; 116 } 117 unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 118 void *base = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED, 119 handle->fd_metadata, 0); 120 if (base == reinterpret_cast<void*>(MAP_FAILED)) { 121 ALOGE("%s: mmap() failed: error is %s!", __func__, strerror(errno)); 122 return -1; 123 } 124 125 MetaData_t *data = reinterpret_cast <MetaData_t *>(base); 126 data->operation |= paramType; 127 switch (paramType) { 128 case GET_PP_PARAM_INTERLACED: 129 *((int32_t *)param) = data->interlaced; 130 break; 131 case GET_BUFFER_GEOMETRY: 132 *((BufferDim_t *)param) = data->bufferDim; 133 break; 134 case GET_REFRESH_RATE: 135 *((float *)param) = data->refreshrate; 136 break; 137 case GET_COLOR_SPACE: 138 *((ColorSpace_t *)param) = data->colorSpace; 139 break; 140 case GET_MAP_SECURE_BUFFER: 141 *((int32_t *)param) = data->mapSecureBuffer; 142 break; 143 case GET_S3D_FORMAT: 144 *((uint32_t *)param) = data->s3dFormat; 145 break; 146 case GET_LINEAR_FORMAT: 147 *((uint32_t *)param) = data->linearFormat; 148 break; 149 case GET_IGC: 150 *((IGC_t *)param) = data->igc; 151 break; 152 case GET_SINGLE_BUFFER_MODE: 153 *((uint32_t *)param) = data->isSingleBufferMode ; 154 break; 155 case GET_VT_TIMESTAMP: 156 *((uint64_t *)param) = data->vtTimeStamp; 157 break; 158 default: 159 ALOGE("Unknown paramType %d", paramType); 160 break; 161 } 162 if(munmap(base, size)) 163 ALOGE("%s: failed to unmap ptr %p, err %d", __func__, (void*)base, 164 errno); 165 return 0; 166 } 167 168 int copyMetaData(struct private_handle_t *src, struct private_handle_t *dst) { 169 if (!src || !dst) { 170 ALOGE("%s: Private handle is null!", __func__); 171 return -1; 172 } 173 if (src->fd_metadata == -1) { 174 ALOGE("%s: Bad fd for src extra data!", __func__); 175 return -1; 176 } 177 if (dst->fd_metadata == -1) { 178 ALOGE("%s: Bad fd for dst extra data!", __func__); 179 return -1; 180 } 181 182 unsigned long size = ROUND_UP_PAGESIZE(sizeof(MetaData_t)); 183 184 void *base_src = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED, 185 src->fd_metadata, 0); 186 if (base_src == reinterpret_cast<void*>(MAP_FAILED)) { 187 ALOGE("%s: src mmap() failed: error is %s!", __func__, strerror(errno)); 188 return -1; 189 } 190 191 void *base_dst = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED, 192 dst->fd_metadata, 0); 193 if (base_dst == reinterpret_cast<void*>(MAP_FAILED)) { 194 ALOGE("%s: dst mmap() failed: error is %s!", __func__, strerror(errno)); 195 return -1; 196 } 197 198 memcpy(base_dst, base_src, size); 199 200 if(munmap(base_src, size)) 201 ALOGE("%s: failed to unmap src ptr %p, err %d", __func__, (void*)base_src, 202 errno); 203 if(munmap(base_dst, size)) 204 ALOGE("%s: failed to unmap src ptr %p, err %d", __func__, (void*)base_dst, 205 errno); 206 return 0; 207 } 208