1 /* 2 * Copyright (c) 2011-2012, 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 <stdlib.h> 31 #include <math.h> 32 #include <utils/Log.h> 33 #include <linux/msm_mdp.h> 34 #include <cutils/properties.h> 35 #include "gralloc_priv.h" 36 #include "overlayUtils.h" 37 #include "mdpWrapper.h" 38 #include "mdp_version.h" 39 40 // just a helper static thingy 41 namespace { 42 struct IOFile { 43 IOFile(const char* s, const char* mode) : fp(0) { 44 fp = ::fopen(s, mode); 45 if(!fp) { 46 ALOGE("Failed open %s", s); 47 } 48 } 49 template <class T> 50 size_t read(T& r, size_t elem) { 51 if(fp) { 52 return ::fread(&r, sizeof(T), elem, fp); 53 } 54 return 0; 55 } 56 size_t write(const char* s, uint32_t val) { 57 if(fp) { 58 return ::fprintf(fp, s, val); 59 } 60 return 0; 61 } 62 bool valid() const { return fp != 0; } 63 ~IOFile() { 64 if(fp) ::fclose(fp); 65 fp=0; 66 } 67 FILE* fp; 68 }; 69 } 70 71 namespace overlay { 72 73 //----------From class Res ------------------------------ 74 const char* const Res::fbPath = "/dev/graphics/fb%u"; 75 const char* const Res::rotPath = "/dev/msm_rotator"; 76 const char* const Res::format3DFile = 77 "/sys/class/graphics/fb1/format_3d"; 78 const char* const Res::edid3dInfoFile = 79 "/sys/class/graphics/fb1/3d_present"; 80 const char* const Res::barrierFile = 81 "/sys/devices/platform/mipi_novatek.0/enable_3d_barrier"; 82 //-------------------------------------------------------- 83 84 85 86 namespace utils { 87 88 //-------------------------------------------------------- 89 //Refer to graphics.h, gralloc_priv.h, msm_mdp.h 90 int getMdpFormat(int format) { 91 switch (format) { 92 //From graphics.h 93 case HAL_PIXEL_FORMAT_RGBA_8888 : 94 return MDP_RGBA_8888; 95 case HAL_PIXEL_FORMAT_RGBX_8888: 96 return MDP_RGBX_8888; 97 case HAL_PIXEL_FORMAT_RGB_888: 98 return MDP_RGB_888; 99 case HAL_PIXEL_FORMAT_RGB_565: 100 return MDP_RGB_565; 101 case HAL_PIXEL_FORMAT_BGRA_8888: 102 return MDP_BGRA_8888; 103 case HAL_PIXEL_FORMAT_YV12: 104 return MDP_Y_CR_CB_GH2V2; 105 case HAL_PIXEL_FORMAT_YCbCr_422_SP: 106 return MDP_Y_CBCR_H2V1; 107 case HAL_PIXEL_FORMAT_YCrCb_420_SP: 108 return MDP_Y_CRCB_H2V2; 109 110 //From gralloc_priv.h 111 case HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED: 112 return MDP_Y_CBCR_H2V2_TILE; 113 case HAL_PIXEL_FORMAT_YCbCr_420_SP: 114 return MDP_Y_CBCR_H2V2; 115 case HAL_PIXEL_FORMAT_YCrCb_422_SP: 116 return MDP_Y_CRCB_H2V1; 117 case HAL_PIXEL_FORMAT_YCbCr_444_SP: 118 return MDP_Y_CBCR_H1V1; 119 case HAL_PIXEL_FORMAT_YCrCb_444_SP: 120 return MDP_Y_CRCB_H1V1; 121 case HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS: 122 case HAL_PIXEL_FORMAT_NV12_ENCODEABLE: 123 //NV12 encodeable format maps to the venus format on 124 //B-Family targets 125 return MDP_Y_CBCR_H2V2_VENUS; 126 default: 127 //Unsupported by MDP 128 //---graphics.h-------- 129 //HAL_PIXEL_FORMAT_RGBA_5551 130 //HAL_PIXEL_FORMAT_RGBA_4444 131 //HAL_PIXEL_FORMAT_YCbCr_422_I 132 //---gralloc_priv.h----- 133 //HAL_PIXEL_FORMAT_YCrCb_420_SP_ADRENO = 0x7FA30C01 134 //HAL_PIXEL_FORMAT_R_8 = 0x10D 135 //HAL_PIXEL_FORMAT_RG_88 = 0x10E 136 ALOGE("%s: Unsupported HAL format = 0x%x", __func__, format); 137 return -1; 138 } 139 // not reached 140 return -1; 141 } 142 143 //Takes mdp format as input and translates to equivalent HAL format 144 //Refer to graphics.h, gralloc_priv.h, msm_mdp.h for formats. 145 int getHALFormat(int mdpFormat) { 146 switch (mdpFormat) { 147 //From graphics.h 148 case MDP_RGBA_8888: 149 return HAL_PIXEL_FORMAT_RGBA_8888; 150 case MDP_RGBX_8888: 151 return HAL_PIXEL_FORMAT_RGBX_8888; 152 case MDP_RGB_888: 153 return HAL_PIXEL_FORMAT_RGB_888; 154 case MDP_RGB_565: 155 return HAL_PIXEL_FORMAT_RGB_565; 156 case MDP_BGRA_8888: 157 return HAL_PIXEL_FORMAT_BGRA_8888; 158 case MDP_Y_CR_CB_GH2V2: 159 return HAL_PIXEL_FORMAT_YV12; 160 case MDP_Y_CBCR_H2V1: 161 return HAL_PIXEL_FORMAT_YCbCr_422_SP; 162 case MDP_Y_CRCB_H2V2: 163 return HAL_PIXEL_FORMAT_YCrCb_420_SP; 164 165 //From gralloc_priv.h 166 case MDP_Y_CBCR_H2V2_TILE: 167 return HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED; 168 case MDP_Y_CBCR_H2V2: 169 return HAL_PIXEL_FORMAT_YCbCr_420_SP; 170 case MDP_Y_CRCB_H2V1: 171 return HAL_PIXEL_FORMAT_YCrCb_422_SP; 172 case MDP_Y_CBCR_H1V1: 173 return HAL_PIXEL_FORMAT_YCbCr_444_SP; 174 case MDP_Y_CRCB_H1V1: 175 return HAL_PIXEL_FORMAT_YCrCb_444_SP; 176 case MDP_Y_CBCR_H2V2_VENUS: 177 return HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS; 178 default: 179 ALOGE("%s: Unsupported MDP format = 0x%x", __func__, mdpFormat); 180 return -1; 181 } 182 // not reached 183 return -1; 184 } 185 186 int getMdpOrient(eTransform rotation) { 187 int retTrans = 0; 188 bool trans90 = false; 189 int mdpVersion = qdutils::MDPVersion::getInstance().getMDPVersion(); 190 bool aFamily = (mdpVersion < qdutils::MDSS_V5); 191 192 ALOGD_IF(DEBUG_OVERLAY, "%s: In rotation = %d", __FUNCTION__, rotation); 193 if(rotation & OVERLAY_TRANSFORM_ROT_90) { 194 retTrans |= MDP_ROT_90; 195 trans90 = true; 196 } 197 198 if(rotation & OVERLAY_TRANSFORM_FLIP_H) { 199 if(trans90 && aFamily) { 200 //Swap for a-family, since its driver does 90 first 201 retTrans |= MDP_FLIP_UD; 202 } else { 203 retTrans |= MDP_FLIP_LR; 204 } 205 } 206 207 if(rotation & OVERLAY_TRANSFORM_FLIP_V) { 208 if(trans90 && aFamily) { 209 //Swap for a-family, since its driver does 90 first 210 retTrans |= MDP_FLIP_LR; 211 } else { 212 retTrans |= MDP_FLIP_UD; 213 } 214 } 215 216 ALOGD_IF(DEBUG_OVERLAY, "%s: Out rotation = %d", __FUNCTION__, retTrans); 217 return retTrans; 218 } 219 220 int getDownscaleFactor(const int& src_w, const int& src_h, 221 const int& dst_w, const int& dst_h) { 222 int dscale_factor = utils::ROT_DS_NONE; 223 // The tolerance is an empirical grey area that needs to be adjusted 224 // manually so that we always err on the side of caution 225 float fDscaleTolerance = 0.05; 226 // We need this check to engage the rotator whenever possible to assist MDP 227 // in performing video downscale. 228 // This saves bandwidth and avoids causing the driver to make too many panel 229 // -mode switches between BLT (writeback) and non-BLT (Direct) modes. 230 // Use-case: Video playback [with downscaling and rotation]. 231 if (dst_w && dst_h) 232 { 233 float fDscale = sqrtf((float)(src_w * src_h) / (float)(dst_w * dst_h)) + 234 fDscaleTolerance; 235 236 // On our MTP 1080p playback case downscale after sqrt is coming to 1.87 237 // we were rounding to 1. So entirely MDP has to do the downscaling. 238 // BW requirement and clock requirement is high across MDP4 targets. 239 // It is unable to downscale 1080p video to panel resolution on 8960. 240 // round(x) will round it to nearest integer and avoids above issue. 241 uint32_t dscale = round(fDscale); 242 243 if(dscale < 2) { 244 // Down-scale to > 50% of orig. 245 dscale_factor = utils::ROT_DS_NONE; 246 } else if(dscale < 4) { 247 // Down-scale to between > 25% to <= 50% of orig. 248 dscale_factor = utils::ROT_DS_HALF; 249 } else if(dscale < 8) { 250 // Down-scale to between > 12.5% to <= 25% of orig. 251 dscale_factor = utils::ROT_DS_FOURTH; 252 } else { 253 // Down-scale to <= 12.5% of orig. 254 dscale_factor = utils::ROT_DS_EIGHTH; 255 } 256 } 257 return dscale_factor; 258 } 259 260 void getDecimationFactor(const int& src_w, const int& src_h, 261 const int& dst_w, const int& dst_h, float& horDscale, 262 float& verDscale) { 263 horDscale = ceilf((float)src_w / (float)dst_w); 264 verDscale = ceilf((float)src_h / (float)dst_h); 265 266 //Next power of 2, if not already 267 horDscale = powf(2.0f, ceilf(log2f(horDscale))); 268 verDscale = powf(2.0f, ceilf(log2f(verDscale))); 269 270 //Since MDP can do 1/4 dscale and has better quality, split the task 271 //between decimator and MDP downscale 272 horDscale /= 4.0f; 273 verDscale /= 4.0f; 274 } 275 276 static inline int compute(const uint32_t& x, const uint32_t& y, 277 const uint32_t& z) { 278 return x - ( y + z ); 279 } 280 281 void preRotateSource(const eTransform& tr, Whf& whf, Dim& srcCrop) { 282 if(tr & OVERLAY_TRANSFORM_FLIP_H) { 283 srcCrop.x = compute(whf.w, srcCrop.x, srcCrop.w); 284 } 285 if(tr & OVERLAY_TRANSFORM_FLIP_V) { 286 srcCrop.y = compute(whf.h, srcCrop.y, srcCrop.h); 287 } 288 if(tr & OVERLAY_TRANSFORM_ROT_90) { 289 int tmp = srcCrop.x; 290 srcCrop.x = compute(whf.h, 291 srcCrop.y, 292 srcCrop.h); 293 srcCrop.y = tmp; 294 swap(whf.w, whf.h); 295 swap(srcCrop.w, srcCrop.h); 296 } 297 } 298 299 bool is3DTV() { 300 char is3DTV = '0'; 301 IOFile fp(Res::edid3dInfoFile, "r"); 302 (void)fp.read(is3DTV, 1); 303 ALOGI("3DTV EDID flag: %d", is3DTV); 304 return (is3DTV == '0') ? false : true; 305 } 306 307 bool isPanel3D() { 308 OvFD fd; 309 if(!overlay::open(fd, 0 /*fb*/, Res::fbPath)){ 310 ALOGE("isPanel3D Can't open framebuffer 0"); 311 return false; 312 } 313 fb_fix_screeninfo finfo; 314 if(!mdp_wrapper::getFScreenInfo(fd.getFD(), finfo)) { 315 ALOGE("isPanel3D read fb0 failed"); 316 } 317 fd.close(); 318 return (FB_TYPE_3D_PANEL == finfo.type) ? true : false; 319 } 320 321 bool usePanel3D() { 322 if(!isPanel3D()) 323 return false; 324 char value[PROPERTY_VALUE_MAX]; 325 property_get("persist.user.panel3D", value, "0"); 326 int usePanel3D = atoi(value); 327 return usePanel3D ? true : false; 328 } 329 330 bool send3DInfoPacket (uint32_t format3D) { 331 IOFile fp(Res::format3DFile, "wb"); 332 (void)fp.write("%d", format3D); 333 if(!fp.valid()) { 334 ALOGE("send3DInfoPacket: no sysfs entry for setting 3d mode"); 335 return false; 336 } 337 return true; 338 } 339 340 bool enableBarrier (uint32_t orientation) { 341 IOFile fp(Res::barrierFile, "wb"); 342 (void)fp.write("%d", orientation); 343 if(!fp.valid()) { 344 ALOGE("enableBarrier no sysfs entry for " 345 "enabling barriers on 3D panel"); 346 return false; 347 } 348 return true; 349 } 350 351 uint32_t getS3DFormat(uint32_t fmt) { 352 // The S3D is part of the HAL_PIXEL_FORMAT_YV12 value. Add 353 // an explicit check for the format 354 if (fmt == HAL_PIXEL_FORMAT_YV12) { 355 return 0; 356 } 357 uint32_t fmt3D = format3D(fmt); 358 uint32_t fIn3D = format3DInput(fmt3D); // MSB 2 bytes - inp 359 uint32_t fOut3D = format3DOutput(fmt3D); // LSB 2 bytes - out 360 fmt3D = fIn3D | fOut3D; 361 if (!fIn3D) { 362 fmt3D |= fOut3D << SHIFT_TOT_3D; //Set the input format 363 } 364 if (!fOut3D) { 365 switch (fIn3D) { 366 case HAL_3D_IN_SIDE_BY_SIDE_L_R: 367 case HAL_3D_IN_SIDE_BY_SIDE_R_L: 368 // For all side by side formats, set the output 369 // format as Side-by-Side i.e 0x1 370 fmt3D |= HAL_3D_IN_SIDE_BY_SIDE_L_R >> SHIFT_TOT_3D; 371 break; 372 default: 373 fmt3D |= fIn3D >> SHIFT_TOT_3D; //Set the output format 374 } 375 } 376 return fmt3D; 377 } 378 379 void getDump(char *buf, size_t len, const char *prefix, 380 const mdp_overlay& ov) { 381 char str[256] = {'\0'}; 382 snprintf(str, 256, 383 "%s id=%d z=%d fg=%d alpha=%d mask=%d flags=0x%x H.Deci=%d," 384 "V.Deci=%d\n", 385 prefix, ov.id, ov.z_order, ov.is_fg, ov.alpha, 386 ov.transp_mask, ov.flags, ov.horz_deci, ov.vert_deci); 387 strncat(buf, str, strlen(str)); 388 getDump(buf, len, "\tsrc", ov.src); 389 getDump(buf, len, "\tsrc_rect", ov.src_rect); 390 getDump(buf, len, "\tdst_rect", ov.dst_rect); 391 } 392 393 void getDump(char *buf, size_t len, const char *prefix, 394 const msmfb_img& ov) { 395 char str_src[256] = {'\0'}; 396 snprintf(str_src, 256, 397 "%s w=%d h=%d format=%d %s\n", 398 prefix, ov.width, ov.height, ov.format, 399 overlay::utils::getFormatString(ov.format)); 400 strncat(buf, str_src, strlen(str_src)); 401 } 402 403 void getDump(char *buf, size_t len, const char *prefix, 404 const mdp_rect& ov) { 405 char str_rect[256] = {'\0'}; 406 snprintf(str_rect, 256, 407 "%s x=%d y=%d w=%d h=%d\n", 408 prefix, ov.x, ov.y, ov.w, ov.h); 409 strncat(buf, str_rect, strlen(str_rect)); 410 } 411 412 void getDump(char *buf, size_t len, const char *prefix, 413 const msmfb_overlay_data& ov) { 414 char str[256] = {'\0'}; 415 snprintf(str, 256, 416 "%s id=%d\n", 417 prefix, ov.id); 418 strncat(buf, str, strlen(str)); 419 getDump(buf, len, "\tdata", ov.data); 420 } 421 422 void getDump(char *buf, size_t len, const char *prefix, 423 const msmfb_data& ov) { 424 char str_data[256] = {'\0'}; 425 snprintf(str_data, 256, 426 "%s offset=%d memid=%d id=%d flags=0x%x priv=%d\n", 427 prefix, ov.offset, ov.memory_id, ov.id, ov.flags, 428 ov.priv); 429 strncat(buf, str_data, strlen(str_data)); 430 } 431 432 void getDump(char *buf, size_t len, const char *prefix, 433 const msm_rotator_img_info& rot) { 434 char str[256] = {'\0'}; 435 snprintf(str, 256, "%s sessid=%u rot=%d, enable=%d downscale=%d\n", 436 prefix, rot.session_id, rot.rotations, rot.enable, 437 rot.downscale_ratio); 438 strncat(buf, str, strlen(str)); 439 getDump(buf, len, "\tsrc", rot.src); 440 getDump(buf, len, "\tdst", rot.dst); 441 getDump(buf, len, "\tsrc_rect", rot.src_rect); 442 } 443 444 void getDump(char *buf, size_t len, const char *prefix, 445 const msm_rotator_data_info& rot) { 446 char str[256] = {'\0'}; 447 snprintf(str, 256, 448 "%s sessid=%u\n", 449 prefix, rot.session_id); 450 strncat(buf, str, strlen(str)); 451 getDump(buf, len, "\tsrc", rot.src); 452 getDump(buf, len, "\tdst", rot.dst); 453 } 454 455 //Helper to even out x,w and y,h pairs 456 //x,y are always evened to ceil and w,h are evened to floor 457 void normalizeCrop(uint32_t& xy, uint32_t& wh) { 458 if(xy & 1) { 459 even_ceil(xy); 460 if(wh & 1) 461 even_floor(wh); 462 else 463 wh -= 2; 464 } else { 465 even_floor(wh); 466 } 467 } 468 469 } // utils 470 471 } // overlay 472