Home | History | Annotate | Download | only in fb
      1 /*
      2 * Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
      3 *
      4 * Redistribution and use in source and binary forms, with or without modification, are permitted
      5 * provided that the following conditions are met:
      6 *    * Redistributions of source code must retain the above copyright notice, this list of
      7 *      conditions and the following disclaimer.
      8 *    * Redistributions in binary form must reproduce the above copyright notice, this list of
      9 *      conditions and the following disclaimer in the documentation and/or other materials provided
     10 *      with the distribution.
     11 *    * Neither the name of The Linux Foundation nor the names of its contributors may be used to
     12 *      endorse or promote products derived from this software without specific prior written
     13 *      permission.
     14 *
     15 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
     16 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
     17 * NON-INFRINGEMENT ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE
     18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     19 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
     20 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     21 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     22 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     23 */
     24 
     25 #include <string.h>
     26 #include <stdio.h>
     27 #include <stdlib.h>
     28 #include <fcntl.h>
     29 #include <sys/stat.h>
     30 #include <sys/types.h>
     31 #include <utils/constants.h>
     32 #include <utils/debug.h>
     33 #include <utils/sys.h>
     34 #include <dlfcn.h>
     35 
     36 #include <algorithm>
     37 #include <iostream>
     38 #include <fstream>
     39 #include <map>
     40 #include <memory>
     41 #include <string>
     42 #include <utility>
     43 #include <vector>
     44 
     45 #include "hw_info.h"
     46 
     47 #define __CLASS__ "HWInfo"
     48 
     49 using std::vector;
     50 using std::map;
     51 using std::string;
     52 using std::fstream;
     53 using std::to_string;
     54 
     55 namespace sdm {
     56 
     57 // kDefaultFormatSupport contains the bit map of supported formats for each hw blocks.
     58 // For eg: if Cursor supports MDP_RGBA_8888[bit-13] and MDP_RGB_565[bit-0], then cursor pipe array
     59 // contains { 0x01[0-3], 0x00[4-7], 0x00[8-12], 0x01[13-16], 0x00[17-20], 0x00[21-24], 0x00[24-28] }
     60 const std::bitset<8> HWInfo::kDefaultFormatSupport[kHWSubBlockMax][
     61                                                       BITS_TO_BYTES(MDP_IMGTYPE_LIMIT1)] = {
     62   { 0xFF, 0xF5, 0x1C, 0x1E, 0x20, 0xFF, 0x01, 0x00, 0xFE, 0x1F },  // kHWVIGPipe
     63   { 0x33, 0xE0, 0x00, 0x16, 0x00, 0xBF, 0x00, 0x00, 0xFE, 0x07 },  // kHWRGBPipe
     64   { 0x33, 0xE0, 0x00, 0x16, 0x00, 0xBF, 0x00, 0x00, 0xFE, 0x07 },  // kHWDMAPipe
     65   { 0x12, 0x60, 0x0C, 0x00, 0x00, 0x0F, 0x00, 0x00, 0x00, 0x00 },  // kHWCursorPipe
     66   { 0xFF, 0xF5, 0x1C, 0x1E, 0x20, 0xFF, 0x01, 0x00, 0xFE, 0x1F },  // kHWRotatorInput
     67   { 0xFF, 0xF5, 0x1C, 0x1E, 0x20, 0xFF, 0x01, 0x00, 0xFE, 0x1F },  // kHWRotatorOutput
     68   { 0x3F, 0xF4, 0x10, 0x1E, 0x20, 0xFF, 0x01, 0x00, 0xAA, 0x16 },  // kHWWBIntfOutput
     69 };
     70 
     71 int HWInfo::ParseString(const char *input, char *tokens[], const uint32_t max_token,
     72                         const char *delim, uint32_t *count) {
     73   char *tmp_token = NULL;
     74   char *temp_ptr;
     75   uint32_t index = 0;
     76   if (!input) {
     77     return -1;
     78   }
     79   tmp_token = strtok_r(const_cast<char *>(input), delim, &temp_ptr);
     80   while (tmp_token && index < max_token) {
     81     tokens[index++] = tmp_token;
     82     tmp_token = strtok_r(NULL, delim, &temp_ptr);
     83   }
     84   *count = index;
     85 
     86   return 0;
     87 }
     88 
     89 DisplayError HWInfoInterface::Create(HWInfoInterface **intf) {
     90   DisplayError error = kErrorNone;
     91   HWInfo *hw_info = NULL;
     92 
     93   hw_info = new HWInfo();
     94   if (!hw_info) {
     95     error = kErrorMemory;
     96   } else {
     97     *intf = hw_info;
     98   }
     99 
    100   return error;
    101 }
    102 
    103 DisplayError HWInfoInterface::Destroy(HWInfoInterface *intf) {
    104   HWInfo *hw_info = static_cast<HWInfo *>(intf);
    105   delete hw_info;
    106 
    107   return kErrorNone;
    108 }
    109 
    110 DisplayError HWInfo::GetDynamicBWLimits(HWResourceInfo *hw_resource) {
    111   Sys::fstream fs(kBWModeBitmap, fstream::in);
    112   if (!fs.is_open()) {
    113     DLOGE("File '%s' not found", kBWModeBitmap);
    114     return kErrorHardware;
    115   }
    116 
    117   HWDynBwLimitInfo* bw_info = &hw_resource->dyn_bw_info;
    118   for (int index = 0; index < kBwModeMax; index++) {
    119     bw_info->total_bw_limit[index] = UINT32(hw_resource->max_bandwidth_low);
    120     bw_info->pipe_bw_limit[index] = hw_resource->max_pipe_bw;
    121   }
    122 
    123   uint32_t token_count = 0;
    124   const uint32_t max_count = kBwModeMax;
    125   char *tokens[max_count] = { NULL };
    126   string line;
    127   while (Sys::getline_(fs, line)) {
    128     if (!ParseString(line.c_str(), tokens, max_count, ":, =\n", &token_count)) {
    129       if (!strncmp(tokens[0], "default_pipe", strlen("default_pipe"))) {
    130         bw_info->pipe_bw_limit[kBwDefault] = UINT32(atoi(tokens[1]));
    131       } else if (!strncmp(tokens[0], "camera_pipe", strlen("camera_pipe"))) {
    132         bw_info->pipe_bw_limit[kBwCamera] = UINT32(atoi(tokens[1]));
    133       } else if (!strncmp(tokens[0], "vflip_pipe", strlen("vflip_pipe"))) {
    134         bw_info->pipe_bw_limit[kBwVFlip] = UINT32(atoi(tokens[1]));
    135       } else if (!strncmp(tokens[0], "hflip_pipe", strlen("hflip_pipe"))) {
    136         bw_info->pipe_bw_limit[kBwHFlip] = UINT32(atoi(tokens[1]));
    137       } else if (!strncmp(tokens[0], "default", strlen("default"))) {
    138         bw_info->total_bw_limit[kBwDefault] = UINT32(atoi(tokens[1]));
    139       } else if (!strncmp(tokens[0], "camera", strlen("camera"))) {
    140         bw_info->total_bw_limit[kBwCamera] = UINT32(atoi(tokens[1]));
    141       } else if (!strncmp(tokens[0], "vflip", strlen("vflip"))) {
    142         bw_info->total_bw_limit[kBwVFlip] = UINT32(atoi(tokens[1]));
    143       } else if (!strncmp(tokens[0], "hflip", strlen("hflip"))) {
    144         bw_info->total_bw_limit[kBwHFlip] = UINT32(atoi(tokens[1]));
    145       }
    146     }
    147   }
    148 
    149   return kErrorNone;
    150 }
    151 
    152 DisplayError HWInfo::GetHWResourceInfo(HWResourceInfo *hw_resource) {
    153   string fb_path = "/sys/devices/virtual/graphics/fb"
    154                       + to_string(kHWCapabilitiesNode) + "/mdp/caps";
    155 
    156   Sys::fstream fs(fb_path, fstream::in);
    157   if (!fs.is_open()) {
    158     DLOGE("File '%s' not found", fb_path.c_str());
    159     return kErrorHardware;
    160   }
    161 
    162   InitSupportedFormatMap(hw_resource);
    163   hw_resource->hw_version = kHWMdssVersion5;
    164 
    165   uint32_t token_count = 0;
    166   const uint32_t max_count = 256;
    167   char *tokens[max_count] = { NULL };
    168   string line;
    169   while (Sys::getline_(fs, line)) {
    170     // parse the line and update information accordingly
    171     if (!ParseString(line.c_str(), tokens, max_count, ":, =\n", &token_count)) {
    172       if (!strncmp(tokens[0], "hw_rev", strlen("hw_rev"))) {
    173         hw_resource->hw_revision = UINT32(atoi(tokens[1]));  // HW Rev, v1/v2
    174       } else if (!strncmp(tokens[0], "rot_input_fmts", strlen("rot_input_fmts"))) {
    175         ParseFormats(&tokens[1], (token_count - 1), kHWRotatorInput, hw_resource);
    176       } else if (!strncmp(tokens[0], "rot_output_fmts", strlen("rot_output_fmts"))) {
    177         ParseFormats(&tokens[1], (token_count - 1), kHWRotatorOutput, hw_resource);
    178       } else if (!strncmp(tokens[0], "wb_output_fmts", strlen("wb_output_fmts"))) {
    179         ParseFormats(&tokens[1], (token_count - 1), kHWWBIntfOutput, hw_resource);
    180       } else if (!strncmp(tokens[0], "blending_stages", strlen("blending_stages"))) {
    181         hw_resource->num_blending_stages = UINT8(atoi(tokens[1]));
    182       } else if (!strncmp(tokens[0], "max_downscale_ratio", strlen("max_downscale_ratio"))) {
    183         hw_resource->max_scale_down = UINT32(atoi(tokens[1]));
    184       } else if (!strncmp(tokens[0], "max_upscale_ratio", strlen("max_upscale_ratio"))) {
    185         hw_resource->max_scale_up = UINT32(atoi(tokens[1]));
    186       } else if (!strncmp(tokens[0], "max_bandwidth_low", strlen("max_bandwidth_low"))) {
    187         hw_resource->max_bandwidth_low = UINT64(atol(tokens[1]));
    188       } else if (!strncmp(tokens[0], "max_bandwidth_high", strlen("max_bandwidth_high"))) {
    189         hw_resource->max_bandwidth_high = UINT64(atol(tokens[1]));
    190       } else if (!strncmp(tokens[0], "max_mixer_width", strlen("max_mixer_width"))) {
    191         hw_resource->max_mixer_width = UINT32(atoi(tokens[1]));
    192       } else if (!strncmp(tokens[0], "max_pipe_width", strlen("max_pipe_width"))) {
    193         hw_resource->max_pipe_width = UINT32(atoi(tokens[1]));
    194       } else if (!strncmp(tokens[0], "max_cursor_size", strlen("max_cursor_size"))) {
    195         hw_resource->max_cursor_size = UINT32(atoi(tokens[1]));
    196       } else if (!strncmp(tokens[0], "max_pipe_bw", strlen("max_pipe_bw"))) {
    197         hw_resource->max_pipe_bw = UINT32(atoi(tokens[1]));
    198       } else if (!strncmp(tokens[0], "max_mdp_clk", strlen("max_mdp_clk"))) {
    199         hw_resource->max_sde_clk = UINT32(atoi(tokens[1]));
    200       } else if (!strncmp(tokens[0], "clk_fudge_factor", strlen("clk_fudge_factor"))) {
    201         hw_resource->clk_fudge_factor = FLOAT(atoi(tokens[1])) / FLOAT(atoi(tokens[2]));
    202       } else if (!strncmp(tokens[0], "fmt_mt_nv12_factor", strlen("fmt_mt_nv12_factor"))) {
    203         hw_resource->macrotile_nv12_factor = UINT32(atoi(tokens[1]));
    204       } else if (!strncmp(tokens[0], "fmt_mt_factor", strlen("fmt_mt_factor"))) {
    205         hw_resource->macrotile_factor = UINT32(atoi(tokens[1]));
    206       } else if (!strncmp(tokens[0], "fmt_linear_factor", strlen("fmt_linear_factor"))) {
    207         hw_resource->linear_factor = UINT32(atoi(tokens[1]));
    208       } else if (!strncmp(tokens[0], "scale_factor", strlen("scale_factor"))) {
    209         hw_resource->scale_factor = UINT32(atoi(tokens[1]));
    210       } else if (!strncmp(tokens[0], "xtra_ff_factor", strlen("xtra_ff_factor"))) {
    211         hw_resource->extra_fudge_factor = UINT32(atoi(tokens[1]));
    212       } else if (!strncmp(tokens[0], "amortizable_threshold", strlen("amortizable_threshold"))) {
    213         hw_resource->amortizable_threshold = UINT32(atoi(tokens[1]));
    214       } else if (!strncmp(tokens[0], "system_overhead_lines", strlen("system_overhead_lines"))) {
    215         hw_resource->system_overhead_lines = UINT32(atoi(tokens[1]));
    216       } else if (!strncmp(tokens[0], "wb_intf_index", strlen("wb_intf_index"))) {
    217         hw_resource->writeback_index = UINT32(atoi(tokens[1]));
    218       } else if (!strncmp(tokens[0], "dest_scaler_count", strlen("dest_scaler_count"))) {
    219         hw_resource->hw_dest_scalar_info.count = UINT32(atoi(tokens[1]));
    220       } else if (!strncmp(tokens[0], "max_dest_scale_up", strlen("max_dest_scale_up"))) {
    221         hw_resource->hw_dest_scalar_info.max_scale_up = UINT32(atoi(tokens[1]));
    222       } else if (!strncmp(tokens[0], "max_dest_scaler_input_width",
    223                  strlen("max_dest_scaler_input_width"))) {
    224         hw_resource->hw_dest_scalar_info.max_input_width = UINT32(atoi(tokens[1]));
    225       } else if (!strncmp(tokens[0], "max_dest_scaler_output_width",
    226                  strlen("max_dest_scaler_output_width"))) {
    227         hw_resource->hw_dest_scalar_info.max_output_width = UINT32(atoi(tokens[1]));
    228       } else if (!strncmp(tokens[0], "features", strlen("features"))) {
    229         for (uint32_t i = 0; i < token_count; i++) {
    230           if (!strncmp(tokens[i], "bwc", strlen("bwc"))) {
    231             hw_resource->has_bwc = true;
    232           } else if (!strncmp(tokens[i], "ubwc", strlen("ubwc"))) {
    233             hw_resource->has_ubwc = true;
    234           } else if (!strncmp(tokens[i], "decimation", strlen("decimation"))) {
    235             hw_resource->has_decimation = true;
    236           } else if (!strncmp(tokens[i], "tile_format", strlen("tile_format"))) {
    237             hw_resource->has_macrotile = true;
    238           } else if (!strncmp(tokens[i], "src_split", strlen("src_split"))) {
    239             hw_resource->is_src_split = true;
    240           } else if (!strncmp(tokens[i], "non_scalar_rgb", strlen("non_scalar_rgb"))) {
    241             hw_resource->has_non_scalar_rgb = true;
    242           } else if (!strncmp(tokens[i], "perf_calc", strlen("perf_calc"))) {
    243             hw_resource->perf_calc = true;
    244           } else if (!strncmp(tokens[i], "dynamic_bw_limit", strlen("dynamic_bw_limit"))) {
    245             hw_resource->has_dyn_bw_support = true;
    246           } else if (!strncmp(tokens[i], "separate_rotator", strlen("separate_rotator"))) {
    247             hw_resource->separate_rotator = true;
    248           } else if (!strncmp(tokens[i], "qseed3", strlen("qseed3"))) {
    249             hw_resource->has_qseed3 = true;
    250           } else if (!strncmp(tokens[i], "concurrent_writeback", strlen("concurrent_writeback"))) {
    251             hw_resource->has_concurrent_writeback = true;
    252           }
    253         }
    254       } else if (!strncmp(tokens[0], "pipe_count", strlen("pipe_count"))) {
    255         uint32_t pipe_count = UINT8(atoi(tokens[1]));
    256         for (uint32_t i = 0; i < pipe_count; i++) {
    257           Sys::getline_(fs, line);
    258           if (!ParseString(line.c_str(), tokens, max_count, ": =\n", &token_count)) {
    259             HWPipeCaps pipe_caps;
    260             pipe_caps.type = kPipeTypeUnused;
    261             for (uint32_t j = 0; j < token_count; j += 2) {
    262               if (!strncmp(tokens[j], "pipe_type", strlen("pipe_type"))) {
    263                 if (!strncmp(tokens[j+1], "vig", strlen("vig"))) {
    264                   pipe_caps.type = kPipeTypeVIG;
    265                   hw_resource->num_vig_pipe++;
    266                 } else if (!strncmp(tokens[j+1], "rgb", strlen("rgb"))) {
    267                   pipe_caps.type = kPipeTypeRGB;
    268                   hw_resource->num_rgb_pipe++;
    269                 } else if (!strncmp(tokens[j+1], "dma", strlen("dma"))) {
    270                   pipe_caps.type = kPipeTypeDMA;
    271                   hw_resource->num_dma_pipe++;
    272                 } else if (!strncmp(tokens[j+1], "cursor", strlen("cursor"))) {
    273                   pipe_caps.type = kPipeTypeCursor;
    274                   hw_resource->num_cursor_pipe++;
    275                 }
    276               } else if (!strncmp(tokens[j], "pipe_ndx", strlen("pipe_ndx"))) {
    277                 pipe_caps.id = UINT32(atoi(tokens[j+1]));
    278               } else if (!strncmp(tokens[j], "rects", strlen("rects"))) {
    279                 pipe_caps.max_rects = UINT32(atoi(tokens[j+1]));
    280               } else if (!strncmp(tokens[j], "fmts_supported", strlen("fmts_supported"))) {
    281                 char *tokens_fmt[max_count] = { NULL };
    282                 uint32_t token_fmt_count = 0;
    283                 if (!ParseString(tokens[j+1], tokens_fmt, max_count, ",\n", &token_fmt_count)) {
    284                   if (pipe_caps.type == kPipeTypeVIG) {
    285                     ParseFormats(tokens_fmt, token_fmt_count, kHWVIGPipe, hw_resource);
    286                   } else if (pipe_caps.type == kPipeTypeRGB) {
    287                     ParseFormats(tokens_fmt, token_fmt_count, kHWRGBPipe, hw_resource);
    288                   } else if (pipe_caps.type == kPipeTypeDMA) {
    289                     ParseFormats(tokens_fmt, token_fmt_count, kHWDMAPipe, hw_resource);
    290                   } else if (pipe_caps.type == kPipeTypeCursor) {
    291                     ParseFormats(tokens_fmt, token_fmt_count, kHWCursorPipe, hw_resource);
    292                   }
    293                 }
    294               }
    295             }
    296             hw_resource->hw_pipes.push_back(pipe_caps);
    297           }
    298         }
    299       }
    300     }
    301   }
    302 
    303   // Disable destination scalar count to 0 if extension library is not present
    304   DynLib extension_lib;
    305   if (!extension_lib.Open("libsdmextension.so")) {
    306     hw_resource->hw_dest_scalar_info.count = 0;
    307   }
    308 
    309   DLOGI("SDE Version = %d, SDE Revision = %x, RGB = %d, VIG = %d, DMA = %d, Cursor = %d",
    310         hw_resource->hw_version, hw_resource->hw_revision, hw_resource->num_rgb_pipe,
    311         hw_resource->num_vig_pipe, hw_resource->num_dma_pipe, hw_resource->num_cursor_pipe);
    312   DLOGI("Upscale Ratio = %d, Downscale Ratio = %d, Blending Stages = %d", hw_resource->max_scale_up,
    313         hw_resource->max_scale_down, hw_resource->num_blending_stages);
    314   DLOGI("SourceSplit = %d QSEED3 = %d", hw_resource->is_src_split, hw_resource->has_qseed3);
    315   DLOGI("BWC = %d, UBWC = %d, Decimation = %d, Tile Format = %d Concurrent Writeback = %d",
    316         hw_resource->has_bwc, hw_resource->has_ubwc, hw_resource->has_decimation,
    317         hw_resource->has_macrotile, hw_resource->has_concurrent_writeback);
    318   DLOGI("MaxLowBw = %" PRIu64 " , MaxHighBw = % " PRIu64 "", hw_resource->max_bandwidth_low,
    319         hw_resource->max_bandwidth_high);
    320   DLOGI("MaxPipeBw = %" PRIu64 " KBps, MaxSDEClock = % " PRIu64 " Hz, ClockFudgeFactor = %f",
    321         hw_resource->max_pipe_bw, hw_resource->max_sde_clk, hw_resource->clk_fudge_factor);
    322   DLOGI("Prefill factors: Tiled_NV12 = %d, Tiled = %d, Linear = %d, Scale = %d, Fudge_factor = %d",
    323         hw_resource->macrotile_nv12_factor, hw_resource->macrotile_factor,
    324         hw_resource->linear_factor, hw_resource->scale_factor, hw_resource->extra_fudge_factor);
    325 
    326   if (hw_resource->separate_rotator || hw_resource->num_dma_pipe) {
    327     GetHWRotatorInfo(hw_resource);
    328   }
    329 
    330   // If the driver doesn't spell out the wb index, assume it to be the number of rotators,
    331   // based on legacy implementation.
    332   if (hw_resource->writeback_index == kHWBlockMax) {
    333     hw_resource->writeback_index = hw_resource->hw_rot_info.num_rotator;
    334   }
    335 
    336   if (hw_resource->has_dyn_bw_support) {
    337     DisplayError ret = GetDynamicBWLimits(hw_resource);
    338     if (ret != kErrorNone) {
    339       DLOGE("Failed to read dynamic band width info");
    340       return ret;
    341     }
    342 
    343     DLOGI("Has Support for multiple bw limits shown below");
    344     for (int index = 0; index < kBwModeMax; index++) {
    345       DLOGI("Mode-index=%d  total_bw_limit=%d and pipe_bw_limit=%d",
    346             index, hw_resource->dyn_bw_info.total_bw_limit[index],
    347             hw_resource->dyn_bw_info.pipe_bw_limit[index]);
    348     }
    349   }
    350 
    351   return kErrorNone;
    352 }
    353 
    354 DisplayError HWInfo::GetHWRotatorInfo(HWResourceInfo *hw_resource) {
    355   if (GetMDSSRotatorInfo(hw_resource) != kErrorNone)
    356     return GetV4L2RotatorInfo(hw_resource);
    357 
    358   return kErrorNone;
    359 }
    360 
    361 DisplayError HWInfo::GetMDSSRotatorInfo(HWResourceInfo *hw_resource) {
    362   Sys::fstream fs(kRotatorCapsPath, fstream::in);
    363   if (!fs.is_open()) {
    364     DLOGW("File '%s' not found", kRotatorCapsPath);
    365     return kErrorNotSupported;
    366   }
    367 
    368   uint32_t token_count = 0;
    369   const uint32_t max_count = 10;
    370   char *tokens[max_count] = { NULL };
    371   string line;
    372 
    373   hw_resource->hw_rot_info.type = HWRotatorInfo::ROT_TYPE_MDSS;
    374   while (Sys::getline_(fs, line)) {
    375     if (!ParseString(line.c_str(), tokens, max_count, ":, =\n", &token_count)) {
    376       if (!strncmp(tokens[0], "wb_count", strlen("wb_count"))) {
    377         hw_resource->hw_rot_info.num_rotator = UINT8(atoi(tokens[1]));
    378         hw_resource->hw_rot_info.device_path = "/dev/mdss_rotator";
    379       } else if (!strncmp(tokens[0], "downscale", strlen("downscale"))) {
    380         hw_resource->hw_rot_info.has_downscale = UINT8(atoi(tokens[1]));
    381       }
    382     }
    383   }
    384 
    385   DLOGI("MDSS Rotator: Count = %d, Downscale = %d", hw_resource->hw_rot_info.num_rotator,
    386         hw_resource->hw_rot_info.has_downscale);
    387 
    388   return kErrorNone;
    389 }
    390 
    391 DisplayError HWInfo::GetV4L2RotatorInfo(HWResourceInfo *hw_resource) {
    392   const uint32_t kMaxV4L2Nodes = 64;
    393   bool found = false;
    394 
    395   for (uint32_t i = 0; (i < kMaxV4L2Nodes) && (false == found); i++) {
    396     string path = "/sys/class/video4linux/video" + to_string(i) + "/name";
    397     Sys::fstream fs(path, fstream::in);
    398     if (!fs.is_open()) {
    399       continue;
    400     }
    401 
    402     string line;
    403     if (Sys::getline_(fs, line) &&
    404         (!strncmp(line.c_str(), "sde_rotator", strlen("sde_rotator")))) {
    405        hw_resource->hw_rot_info.device_path = string("/dev/video" + to_string(i));
    406        hw_resource->hw_rot_info.num_rotator++;
    407        hw_resource->hw_rot_info.type = HWRotatorInfo::ROT_TYPE_V4L2;
    408        hw_resource->hw_rot_info.has_downscale = true;
    409        // We support only 1 rotator
    410        found = true;
    411     }
    412   }
    413 
    414   DLOGI("V4L2 Rotator: Count = %d, Downscale = %d", hw_resource->hw_rot_info.num_rotator,
    415         hw_resource->hw_rot_info.has_downscale);
    416 
    417   return kErrorNone;
    418 }
    419 
    420 LayerBufferFormat HWInfo::GetSDMFormat(int mdp_format) {
    421   switch (mdp_format) {
    422   case MDP_ARGB_8888:              return kFormatARGB8888;
    423   case MDP_RGBA_8888:              return kFormatRGBA8888;
    424   case MDP_BGRA_8888:              return kFormatBGRA8888;
    425   case MDP_XRGB_8888:              return kFormatXRGB8888;
    426   case MDP_RGBX_8888:              return kFormatRGBX8888;
    427   case MDP_BGRX_8888:              return kFormatBGRX8888;
    428   case MDP_RGBA_5551:              return kFormatRGBA5551;
    429   case MDP_RGBA_4444:              return kFormatRGBA4444;
    430   case MDP_RGB_888:                return kFormatRGB888;
    431   case MDP_BGR_888:                return kFormatBGR888;
    432   case MDP_RGB_565:                return kFormatRGB565;
    433   case MDP_BGR_565:                return kFormatBGR565;
    434   case MDP_RGBA_8888_UBWC:         return kFormatRGBA8888Ubwc;
    435   case MDP_RGBX_8888_UBWC:         return kFormatRGBX8888Ubwc;
    436   case MDP_RGB_565_UBWC:           return kFormatBGR565Ubwc;
    437   case MDP_Y_CB_CR_H2V2:           return kFormatYCbCr420Planar;
    438   case MDP_Y_CR_CB_H2V2:           return kFormatYCrCb420Planar;
    439   case MDP_Y_CR_CB_GH2V2:          return kFormatYCrCb420PlanarStride16;
    440   case MDP_Y_CBCR_H2V2:            return kFormatYCbCr420SemiPlanar;
    441   case MDP_Y_CRCB_H2V2:            return kFormatYCrCb420SemiPlanar;
    442   case MDP_Y_CBCR_H2V2_VENUS:      return kFormatYCbCr420SemiPlanarVenus;
    443   case MDP_Y_CBCR_H1V2:            return kFormatYCbCr422H1V2SemiPlanar;
    444   case MDP_Y_CRCB_H1V2:            return kFormatYCrCb422H1V2SemiPlanar;
    445   case MDP_Y_CBCR_H2V1:            return kFormatYCbCr422H2V1SemiPlanar;
    446   case MDP_Y_CRCB_H2V1:            return kFormatYCrCb422H2V1SemiPlanar;
    447   case MDP_Y_CBCR_H2V2_UBWC:       return kFormatYCbCr420SPVenusUbwc;
    448   case MDP_Y_CRCB_H2V2_VENUS:      return kFormatYCrCb420SemiPlanarVenus;
    449   case MDP_YCBYCR_H2V1:            return kFormatYCbCr422H2V1Packed;
    450   case MDP_RGBA_1010102:           return kFormatRGBA1010102;
    451   case MDP_ARGB_2101010:           return kFormatARGB2101010;
    452   case MDP_RGBX_1010102:           return kFormatRGBX1010102;
    453   case MDP_XRGB_2101010:           return kFormatXRGB2101010;
    454   case MDP_BGRA_1010102:           return kFormatBGRA1010102;
    455   case MDP_ABGR_2101010:           return kFormatABGR2101010;
    456   case MDP_BGRX_1010102:           return kFormatBGRX1010102;
    457   case MDP_XBGR_2101010:           return kFormatXBGR2101010;
    458   case MDP_RGBA_1010102_UBWC:      return kFormatRGBA1010102Ubwc;
    459   case MDP_RGBX_1010102_UBWC:      return kFormatRGBX1010102Ubwc;
    460   case MDP_Y_CBCR_H2V2_P010:       return kFormatYCbCr420P010;
    461   case MDP_Y_CBCR_H2V2_TP10_UBWC:  return kFormatYCbCr420TP10Ubwc;
    462   default:                         return kFormatInvalid;
    463   }
    464 }
    465 
    466 void HWInfo::InitSupportedFormatMap(HWResourceInfo *hw_resource) {
    467   hw_resource->supported_formats_map.clear();
    468 
    469   for (int sub_blk_type = INT(kHWVIGPipe); sub_blk_type < INT(kHWSubBlockMax); sub_blk_type++) {
    470     PopulateSupportedFormatMap(kDefaultFormatSupport[sub_blk_type], MDP_IMGTYPE_LIMIT1,
    471                                (HWSubBlockType)sub_blk_type, hw_resource);
    472   }
    473 }
    474 
    475 void HWInfo::ParseFormats(char *tokens[], uint32_t token_count, HWSubBlockType sub_blk_type,
    476                           HWResourceInfo *hw_resource) {
    477   if (token_count > BITS_TO_BYTES(MDP_IMGTYPE_LIMIT1)) {
    478     return;
    479   }
    480 
    481   std::unique_ptr<std::bitset<8>[]> format_supported(new std::bitset<8>[token_count]);
    482   for (uint32_t i = 0; i < token_count; i++) {
    483     format_supported[i] = UINT8(atoi(tokens[i]));
    484   }
    485 
    486   PopulateSupportedFormatMap(format_supported.get(), (token_count << 3), sub_blk_type, hw_resource);
    487 }
    488 
    489 void HWInfo::PopulateSupportedFormatMap(const std::bitset<8> *format_supported,
    490                                         uint32_t format_count, HWSubBlockType sub_blk_type,
    491                                         HWResourceInfo *hw_resource) {
    492   vector <LayerBufferFormat> supported_sdm_formats;
    493   for (uint32_t mdp_format = 0; mdp_format < format_count; mdp_format++) {
    494     if (format_supported[mdp_format >> 3][mdp_format & 7]) {
    495       LayerBufferFormat sdm_format = GetSDMFormat(INT(mdp_format));
    496       if (sdm_format != kFormatInvalid) {
    497         supported_sdm_formats.push_back(sdm_format);
    498       }
    499     }
    500   }
    501 
    502   hw_resource->supported_formats_map.erase(sub_blk_type);
    503   hw_resource->supported_formats_map.insert(make_pair(sub_blk_type, supported_sdm_formats));
    504 }
    505 
    506 DisplayError HWInfo::GetFirstDisplayInterfaceType(HWDisplayInterfaceInfo *hw_disp_info) {
    507   Sys::fstream fs("/sys/devices/virtual/graphics/fb0/msm_fb_type", fstream::in);
    508   if (!fs.is_open()) {
    509     return kErrorHardware;
    510   }
    511 
    512   string line;
    513   if (!Sys::getline_(fs, line)) {
    514     return kErrorHardware;
    515   }
    516 
    517   if (!strncmp(line.c_str(), "dtv panel", strlen("dtv panel"))) {
    518     hw_disp_info->type = kHDMI;
    519     DLOGI("First display is HDMI");
    520   } else {
    521     hw_disp_info->type = kPrimary;
    522     DLOGI("First display is internal display");
    523   }
    524 
    525   fs.close();
    526   fs.open("/sys/devices/virtual/graphics/fb0/connected", fstream::in);
    527   if (!fs.is_open()) {
    528     // If fb0 is for a DSI/connected panel, then connected node will not exist.
    529     hw_disp_info->is_connected = true;
    530   } else {
    531     if (!Sys::getline_(fs, line)) {
    532       return kErrorHardware;
    533     }
    534 
    535     hw_disp_info->is_connected =  (!strncmp(line.c_str(), "1", strlen("1")));
    536   }
    537 
    538   return kErrorNone;
    539 }
    540 
    541 }  // namespace sdm
    542 
    543