Home | History | Annotate | Download | only in libqdutils
      1 /*
      2  * Copyright (c) 2013, 2017 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 <unistd.h>
     31 #include <gralloc_priv.h>
     32 #include "qd_utils.h"
     33 
     34 namespace qdutils {
     35 
     36 static int parseLine(char *input, char *tokens[], const uint32_t maxToken, uint32_t *count) {
     37     char *tmpToken = NULL;
     38     char *tmpPtr;
     39     uint32_t index = 0;
     40     const char *delim = ", =\n";
     41     if (!input) {
     42       return -1;
     43     }
     44     tmpToken = strtok_r(input, delim, &tmpPtr);
     45     while (tmpToken && index < maxToken) {
     46       tokens[index++] = tmpToken;
     47       tmpToken = strtok_r(NULL, delim, &tmpPtr);
     48     }
     49     *count = index;
     50 
     51     return 0;
     52 }
     53 
     54 static int getExternalNode(const char *type) {
     55     FILE *displayDeviceFP = NULL;
     56     char fbType[MAX_FRAME_BUFFER_NAME_SIZE];
     57     char msmFbTypePath[MAX_FRAME_BUFFER_NAME_SIZE];
     58     int j = 0;
     59 
     60     for(j = 0; j < HWC_NUM_DISPLAY_TYPES; j++) {
     61         snprintf (msmFbTypePath, sizeof(msmFbTypePath),
     62                   "/sys/class/graphics/fb%d/msm_fb_type", j);
     63         displayDeviceFP = fopen(msmFbTypePath, "r");
     64         if(displayDeviceFP) {
     65             fread(fbType, sizeof(char), MAX_FRAME_BUFFER_NAME_SIZE,
     66                     displayDeviceFP);
     67             if(strncmp(fbType, type, strlen(type)) == 0) {
     68                 ALOGD("%s: %s is at fb%d", __func__, type, j);
     69                 fclose(displayDeviceFP);
     70                 break;
     71             }
     72             fclose(displayDeviceFP);
     73         } else {
     74             ALOGE("%s: Failed to open fb node %d", __func__, j);
     75         }
     76     }
     77 
     78     if (j < HWC_NUM_DISPLAY_TYPES)
     79         return j;
     80     else
     81         ALOGE("%s: Failed to find %s node", __func__, type);
     82 
     83     return -1;
     84 }
     85 
     86 static int querySDEInfoDRM(HWQueryType type, int *value) {
     87     char property[PROPERTY_VALUE_MAX] = {0};
     88 
     89     // TODO(user): If future targets don't support WB UBWC, add separate
     90     // properties in target specific system.prop and have clients like WFD
     91     // directly rely on those.
     92     switch(type) {
     93     case HAS_UBWC:
     94     case HAS_WB_UBWC:  // WFD stack still uses this
     95         *value = 1;
     96         property_get("debug.gralloc.gfx_ubwc_disable", property, "0");
     97         if(!(strncmp(property, "1", PROPERTY_VALUE_MAX)) ||
     98                 !(strncmp(property, "true", PROPERTY_VALUE_MAX))) {
     99             *value = 0;
    100         }
    101         break;
    102     default:
    103         ALOGE("Invalid query type %d", type);
    104         return -EINVAL;
    105     }
    106 
    107     return 0;
    108 }
    109 
    110 static int querySDEInfoFB(HWQueryType type, int *value) {
    111     FILE *fileptr = NULL;
    112     const char *featureName;
    113     char stringBuffer[MAX_STRING_LENGTH];
    114     uint32_t tokenCount = 0;
    115     const uint32_t maxCount = 10;
    116     char *tokens[maxCount] = { NULL };
    117 
    118     switch(type) {
    119     case HAS_UBWC:
    120         featureName = "ubwc";
    121         break;
    122     case HAS_WB_UBWC:
    123         featureName = "wb_ubwc";
    124         break;
    125     default:
    126         ALOGE("Invalid query type %d", type);
    127         return -EINVAL;
    128     }
    129 
    130     fileptr = fopen("/sys/devices/virtual/graphics/fb0/mdp/caps", "rb");
    131     if (!fileptr) {
    132         ALOGE("File '%s' not found", stringBuffer);
    133         return -EINVAL;
    134     }
    135 
    136     size_t len = MAX_STRING_LENGTH;
    137     ssize_t read;
    138     char *line = stringBuffer;
    139     while ((read = getline(&line, &len, fileptr)) != -1) {
    140         // parse the line and update information accordingly
    141         if (parseLine(line, tokens, maxCount, &tokenCount)) {
    142             continue;
    143         }
    144 
    145         if (strncmp(tokens[0], "features", strlen("features"))) {
    146             continue;
    147         }
    148 
    149         for (uint32_t i = 0; i < tokenCount; i++) {
    150             if (!strncmp(tokens[i], featureName, strlen(featureName))) {
    151               *value = 1;
    152             }
    153         }
    154     }
    155     fclose(fileptr);
    156 
    157     return 0;
    158 }
    159 
    160 int querySDEInfo(HWQueryType type, int *value) {
    161     if (!value) {
    162         return -EINVAL;
    163     }
    164 
    165     if (getDriverType() ==  DriverType::DRM) {
    166         return querySDEInfoDRM(type, value);
    167     }
    168 
    169     return querySDEInfoFB(type, value);
    170 }
    171 
    172 int getHDMINode(void) {
    173     return getExternalNode("dtv panel");
    174 }
    175 
    176 int getEdidRawData(char *buffer)
    177 {
    178     int size;
    179     int edidFile;
    180     char msmFbTypePath[MAX_FRAME_BUFFER_NAME_SIZE];
    181     int node_id = getHDMINode();
    182 
    183     if (node_id < 0) {
    184         ALOGE("%s no HDMI node found", __func__);
    185         return 0;
    186     }
    187 
    188     snprintf(msmFbTypePath, sizeof(msmFbTypePath),
    189                  "/sys/class/graphics/fb%d/edid_raw_data", node_id);
    190 
    191     edidFile = open(msmFbTypePath, O_RDONLY, 0);
    192 
    193     if (edidFile < 0) {
    194         ALOGE("%s no edid raw data found", __func__);
    195         return 0;
    196     }
    197 
    198     size = (int)read(edidFile, (char*)buffer, EDID_RAW_DATA_SIZE);
    199     close(edidFile);
    200     return size;
    201 }
    202 
    203 bool isDPConnected() {
    204     char connectPath[MAX_FRAME_BUFFER_NAME_SIZE];
    205     FILE *connectFile = NULL;
    206     size_t len = MAX_STRING_LENGTH;
    207     char stringBuffer[MAX_STRING_LENGTH];
    208     char *line = stringBuffer;
    209 
    210     int nodeId = getExternalNode("dp panel");
    211     if (nodeId < 0) {
    212         ALOGE("%s no DP node found", __func__);
    213         return false;
    214     }
    215 
    216     snprintf(connectPath, sizeof(connectPath),
    217              "/sys/class/graphics/fb%d/connected", nodeId);
    218 
    219     connectFile = fopen(connectPath, "rb");
    220     if (!connectFile) {
    221         ALOGW("Failed to open connect node for device node %d", nodeId);
    222         return false;
    223     }
    224 
    225     if (getline(&line, &len, connectFile) < 0) {
    226         fclose(connectFile);
    227         return false;
    228     }
    229 
    230     fclose(connectFile);
    231 
    232     return atoi(line);
    233 }
    234 
    235 int getDPTestConfig(uint32_t *panelBpp, uint32_t *patternType) {
    236     if (!panelBpp || !patternType) {
    237         return -1;
    238     }
    239 
    240     char configPath[MAX_FRAME_BUFFER_NAME_SIZE];
    241     FILE *configFile = NULL;
    242     uint32_t tokenCount = 0;
    243     const uint32_t maxCount = 10;
    244     char *tokens[maxCount] = { NULL };
    245     size_t len = MAX_STRING_LENGTH;
    246     char stringBuffer[MAX_STRING_LENGTH];
    247     char *line = stringBuffer;
    248 
    249     int nodeId = getExternalNode("dp panel");
    250     if (nodeId < 0) {
    251         ALOGE("%s no DP node found", __func__);
    252         return -EINVAL;
    253     }
    254 
    255     snprintf(configPath, sizeof(configPath),
    256              "/sys/class/graphics/fb%d/config", nodeId);
    257 
    258     configFile = fopen(configPath, "rb");
    259     if (!configFile) {
    260         ALOGW("Failed to open config node for device node %d", nodeId);
    261         return -EINVAL;
    262     }
    263 
    264     while (getline(&line, &len, configFile) != -1) {
    265         if (!parseLine(line, tokens, maxCount, &tokenCount)) {
    266             if (!strncmp(tokens[0], "bpp", strlen("bpp"))) {
    267                 *panelBpp = static_cast<uint32_t>(atoi(tokens[1]));
    268             } else  if (!strncmp(tokens[0], "pattern", strlen("pattern"))) {
    269                 *patternType = static_cast<uint32_t>(atoi(tokens[1]));
    270             }
    271         }
    272     }
    273 
    274     fclose(configFile);
    275 
    276     return 0;
    277 }
    278 
    279 DriverType getDriverType() {
    280     const char *fb_caps = "/sys/devices/virtual/graphics/fb0/mdp/caps";
    281     // 0 - File exists
    282     return access(fb_caps, F_OK) ? DriverType::DRM : DriverType::FB;
    283 }
    284 
    285 const char *GetHALPixelFormatString(int format) {
    286   switch (format) {
    287   case HAL_PIXEL_FORMAT_RGBA_8888:
    288     return "RGBA_8888";
    289   case HAL_PIXEL_FORMAT_RGBX_8888:
    290     return "RGBX_8888";
    291   case HAL_PIXEL_FORMAT_RGB_888:
    292     return "RGB_888";
    293   case HAL_PIXEL_FORMAT_RGB_565:
    294     return "RGB_565";
    295   case HAL_PIXEL_FORMAT_BGR_565:
    296     return "BGR_565";
    297   case HAL_PIXEL_FORMAT_BGRA_8888:
    298     return "BGRA_8888";
    299   case HAL_PIXEL_FORMAT_RGBA_5551:
    300     return "RGBA_5551";
    301   case HAL_PIXEL_FORMAT_RGBA_4444:
    302     return "RGBA_4444";
    303   case HAL_PIXEL_FORMAT_YV12:
    304     return "YV12";
    305   case HAL_PIXEL_FORMAT_YCbCr_422_SP:
    306     return "YCbCr_422_SP_NV16";
    307   case HAL_PIXEL_FORMAT_YCrCb_420_SP:
    308     return "YCrCb_420_SP_NV21";
    309   case HAL_PIXEL_FORMAT_YCbCr_422_I:
    310     return "YCbCr_422_I_YUY2";
    311   case HAL_PIXEL_FORMAT_YCrCb_422_I:
    312     return "YCrCb_422_I_YVYU";
    313   case HAL_PIXEL_FORMAT_NV12_ENCODEABLE:
    314     return "NV12_ENCODEABLE";
    315   case HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED:
    316     return "YCbCr_420_SP_TILED_TILE_4x2";
    317   case HAL_PIXEL_FORMAT_YCbCr_420_SP:
    318     return "YCbCr_420_SP";
    319   case HAL_PIXEL_FORMAT_YCrCb_420_SP_ADRENO:
    320     return "YCrCb_420_SP_ADRENO";
    321   case HAL_PIXEL_FORMAT_YCrCb_422_SP:
    322     return "YCrCb_422_SP";
    323   case HAL_PIXEL_FORMAT_R_8:
    324     return "R_8";
    325   case HAL_PIXEL_FORMAT_RG_88:
    326     return "RG_88";
    327   case HAL_PIXEL_FORMAT_INTERLACE:
    328     return "INTERLACE";
    329   case HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS:
    330     return "YCbCr_420_SP_VENUS";
    331   case HAL_PIXEL_FORMAT_YCrCb_420_SP_VENUS:
    332     return "YCrCb_420_SP_VENUS";
    333   case HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS_UBWC:
    334     return "YCbCr_420_SP_VENUS_UBWC";
    335   case HAL_PIXEL_FORMAT_RGBA_1010102:
    336     return "RGBA_1010102";
    337   case HAL_PIXEL_FORMAT_ARGB_2101010:
    338     return "ARGB_2101010";
    339   case HAL_PIXEL_FORMAT_RGBX_1010102:
    340     return "RGBX_1010102";
    341   case HAL_PIXEL_FORMAT_XRGB_2101010:
    342     return "XRGB_2101010";
    343   case HAL_PIXEL_FORMAT_BGRA_1010102:
    344     return "BGRA_1010102";
    345   case HAL_PIXEL_FORMAT_ABGR_2101010:
    346     return "ABGR_2101010";
    347   case HAL_PIXEL_FORMAT_BGRX_1010102:
    348     return "BGRX_1010102";
    349   case HAL_PIXEL_FORMAT_XBGR_2101010:
    350     return "XBGR_2101010";
    351   case HAL_PIXEL_FORMAT_YCbCr_420_P010:
    352     return "YCbCr_420_P010";
    353   case HAL_PIXEL_FORMAT_YCbCr_420_TP10_UBWC:
    354     return "YCbCr_420_TP10_UBWC";
    355   default:
    356     return "Unknown_format";
    357   }
    358 }
    359 
    360 }; //namespace qdutils
    361