werunplugged/unplugged-system
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
06ee9615ad
unplugged-system/vendor/mediatek/proprietary/external/libshowlogo/drm_resource.c

997 lines
40 KiB
C
Executable File
Raw Blame History

#define MTK_LOG_ENABLE 1
#include <fcntl.h>
#include <sys/mman.h>
// #include <linux/mediatek_drm.h>
#include <cutils/klog.h>
#include <cutils/ashmem.h>
#include <cutils/log.h>
#include <cutils/atomic.h>
#include <cutils/properties.h>
#include <libdrm_macros.h>
#include <errno.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <errno.h>
#include <sys/types.h>
#include <grp.h>
#include <stdlib.h>
#include <stdbool.h>
#include <drm_fourcc.h>
#include <xf86drm.h>
#include <xf86drmMode.h>
#include "drm_resource.h"
#include "show_logo_log.h"
#ifdef SLOGD
#undef SLOGD
//#define SLOGD(x,...) do { KLOG_ERROR("libshowlogo", x); } while (0)
#define SLOGD(...) \
do \
{ \
KLOG_ERROR("libshowlogo", __VA_ARGS__); \
} while (0)
#endif
#ifdef SLOGE
#undef SLOGE
//#define SLOGE(x,...) do { KLOG_ERROR("libshowlogo", x); } while (0)
#define SLOGE(...) \
do \
{ \
KLOG_ERROR("libshowlogo", __VA_ARGS__); \
} while (0)
#endif
//----------------- macros for custom drm function -------------
#define memclear(s) memset(&s, 0, sizeof(s))
#define U642VOID(x) ((void *)(unsigned long)(x))
#define VOID2U64(x) ((uint64_t)(unsigned long)(x))
// -------------------- Macros end here ----------------
void *imagePointer = {0};
int image_pointer_index = 0;
void *drawPtr = {0};
//--------------------
// set parameters for both LCD in findDisplay()
static int g_found_LCD = NO_LCD;
//--------------------
int possibleCrtcMain = 0;
int possibleCrtcExt = 0;
/*query dual display by lcm interface type
DRM_MODE_CONNECTOR_DSI
*/
static int targetLcmInterface[1] = {DRM_MODE_CONNECTOR_DSI};
void drm_set_lcd_num(int found_lcd)
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] set LCD num %d \n", __FUNCTION__, __LINE__, found_lcd);
}
g_found_LCD = found_lcd;
}
int drm_get_lcd_num(void)
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] get LCD num %d \n", __FUNCTION__, __LINE__, g_found_LCD);
}
return g_found_LCD;
}
bool is_ext_lcd_present(void)
{
int lcd_num = drm_get_lcd_num();
if (lcd_num == EXT_LCD_FOLDABLE)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[libshowlogo %s %d] 2nd LCD present \n", __FUNCTION__, __LINE__);
return true;
}
else
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[libshowlogo %s %d] 2nd LCD not present \n", __FUNCTION__, __LINE__);
return false;
}
}
int init_resource(Drm_resource *drm_resource_object)
{
int res = 0;
(*drm_resource_object).mDrmFd = -1;
(*drm_resource_object).mCrtc = NULL;
(*drm_resource_object).mEncoder =NULL;
(*drm_resource_object).mConnector = NULL;
(*drm_resource_object).mDisplayWidth = 0;
(*drm_resource_object).mDisplayHeight = 0;
(*drm_resource_object).mPinPon = 0;
for (size_t i = 0; i < MAX_BO_SIZE; i++)
{
memset(&((*drm_resource_object).mBo[i]), 0, sizeof(*((*drm_resource_object).mBo)));
(*drm_resource_object).mBo[i].fbId = 0;
(*drm_resource_object).mBo[i].fd = -1;
}
//dualdisplay - 2nd LCD parameters - start
(*drm_resource_object).mCrtc_ext = NULL;
(*drm_resource_object).mEncoder_ext =NULL;
(*drm_resource_object).mConnector_ext = NULL;
(*drm_resource_object).mDisplayWidth_ext = 0;
(*drm_resource_object).mDisplayHeight_ext = 0;
(*drm_resource_object).mPinPon_ext = 0;
for (size_t j = 0; j < MAX_BO_SIZE; j++)
{
memset(&((*drm_resource_object).mBo_ext[j]), 0, sizeof(*((*drm_resource_object).mBo_ext)));
(*drm_resource_object).mBo_ext[j].fbId = 0;
(*drm_resource_object).mBo_ext[j].fd = -1;
}
//dualdisplay - 2nd LCD parameters - end
(*drm_resource_object).mDrmFd = open(DRM_NODE_PATH, O_RDWR);
SLOGD("[drm_resource %s %d] drmFd = %d\n", __FUNCTION__, __LINE__, (*drm_resource_object).mDrmFd);
if ((*drm_resource_object).mDrmFd < 0)
{
SLOGD("failed to open drm device node: %s , %s", DRM_NODE_PATH, strerror(errno));
return -1;
}
else
{
SLOGD("[drm_resource %s %d] drm_resource_object = %p\n", __FUNCTION__, __LINE__, &drm_resource_object);
res = initDrmResource(drm_resource_object);
if (res != 0)
{
SLOGD("failed to init drm resource");
return res;
}
res = findDisplay(drm_resource_object);
if (res == NO_LCD)
{
SLOGD("[drm_resource %s %d] failed to find display", __FUNCTION__, __LINE__);
return res;
}
else
{
SLOGD("[drm_resource %s %d] find display success", __FUNCTION__, __LINE__);
SLOGD("Values => drm_resource_object.mConnector = %p , %p, mDisplayWidth = %d , mDisplayHeight = %d", &((*drm_resource_object).mConnector), &drm_resource_object, drm_resource_object->mDisplayWidth, drm_resource_object->mDisplayHeight);
}
res = createFramebuffer(drm_resource_object);
if (res != 0)
{
SLOGD("[drm_resource %s %d] failed to create framebuffer", __FUNCTION__, __LINE__);
//destroyFramebuffer();
return res;
}
draw(drm_resource_object);
SLOGD("[drm_resource %s %d] draw and attach frambuffer successfully ", __FUNCTION__, __LINE__);
res = getDrmFb(drm_resource_object);
if (res != 0)
{
SLOGD("[drm_resource %s %d] failed to get drmfb", __FUNCTION__, __LINE__);
return res;
}
SLOGD("[drm_resource %s %d] getDrmFb success drm->fb->bpp = %d , drm->fb->width = %d", __FUNCTION__, __LINE__, (drm_resource_object->fb).bpp, (drm_resource_object->fb).width);
SLOGD("[drm_resource %s %d] getDrmFb success drm->fb_ext->bpp = %d , drm->fb_ext->width = %d", __FUNCTION__, __LINE__, (drm_resource_object->fb_ext).bpp, (drm_resource_object->fb_ext).width);
}
return res;
}
uint32_t getDrmBPP(uint32_t format)
{
switch (format)
{
case DRM_FORMAT_XRGB8888:
case DRM_FORMAT_XBGR8888:
case DRM_FORMAT_RGBX8888:
case DRM_FORMAT_BGRX8888:
case DRM_FORMAT_ARGB8888:
case DRM_FORMAT_ABGR8888:
case DRM_FORMAT_RGBA8888:
case DRM_FORMAT_BGRA8888:
case DRM_FORMAT_XRGB2101010:
case DRM_FORMAT_XBGR2101010:
case DRM_FORMAT_RGBX1010102:
case DRM_FORMAT_BGRX1010102:
case DRM_FORMAT_ARGB2101010:
case DRM_FORMAT_ABGR2101010:
case DRM_FORMAT_RGBA1010102:
case DRM_FORMAT_BGRA1010102:
return 32;
case DRM_FORMAT_RGB888:
case DRM_FORMAT_BGR888:
return 24;
case DRM_FORMAT_RGB565:
return 16;
}
SLOGE("Unknown format(%08x) to get bPP, use default 8", format);
return 8;
}
int initDrmResource(Drm_resource *drm_resource_object)
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] initDrmResource: drm_resource_object = %p %p \n", __FUNCTION__, __LINE__, &drm_resource_object, &(*drm_resource_object));
}
// initialise DrmFd
//drm_resource_object.mDrmFd = open(DRM_NODE_PATH, O_RDWR);
drmModeResPtr res = drmModeGetResources(drm_resource_object->mDrmFd);
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] initDrmResource: drmresptr = %p \n", __FUNCTION__, __LINE__, &res);
}
if (!res)
{
if (MTK_LOG_ENABLE == 1)
SLOGE("failed to get drm resource");
return -1;
}
(*drm_resource_object).mCrtcList = (Drm_crtc *)malloc(sizeof(Drm_crtc) * res->count_crtcs);
(*drm_resource_object).mEncoderList = (Drm_encoder *)malloc(sizeof(Drm_encoder) * res->count_encoders);
(*drm_resource_object).mConnectorList = (Drm_connector *)malloc(sizeof(Drm_connector) * res->count_connectors);
SLOGD("[drm_resource: %s %d] initDrmResource: Creating crtc: \n", __FUNCTION__, __LINE__);
int ret = initCrtc(drm_resource_object, res);
if (ret != 0)
{
SLOGE("failed to init crtc");
return -1;
}
SLOGD("[drm_resource: %s %d] initDrmResource: Created crtc successfully. %d\n", __FUNCTION__, __LINE__, ret);
ret = initEncoder(drm_resource_object, res);
if (ret != 0)
{
SLOGE("failed to init encoder");
return -1;
}
SLOGD("[drm_resource: %s %d] initDrmResource: created encoder successfully %d\n", __FUNCTION__, __LINE__, ret);
ret = initConnector(drm_resource_object, res);
if (ret != 0)
{
SLOGE("failed to init connector");
return -1;
}
SLOGD("[drm_resource: %s %d] initDrmResource: created connector successfully %d \n", __FUNCTION__, __LINE__, ret);
return ret;
}
int initCrtc(Drm_resource *drm_resource_object, drmModeResPtr r)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initCrtc: drm_resource_object = %p , r->count_crcts = %d r->count_fbs = %d \n", __FUNCTION__, __LINE__, drm_resource_object, r->count_crtcs, r->count_fbs);
int res = 0;
if (!r->count_crtcs)
{
SLOGE("[drm_resource: %s %d] initCrtc No Crtc Found \n", __FUNCTION__, __LINE__);
return -1;
}
countCrtc = r->count_crtcs;
for (int i = 0; i < r->count_crtcs; i++)
{
Drm_crtc drm_crtc_object;
drmModeCrtcPtr c = drmModeGetCrtc(drm_resource_object->mDrmFd, r->crtcs[i]);
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] drmModeCrtcPtr c = %p , c->bufferid = %d \n", __FUNCTION__, __LINE__, c, c->buffer_id);
if (c == NULL)
{
SLOGE("failed to open drm crtc");
return -1;
}
drm_resource_object->drmCrtc = c;
init_drmcrtc(&drm_crtc_object, i, c);
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] drm_crtc_object->mId = %d\n", __FUNCTION__, __LINE__, drm_crtc_object.mId);
errno = 0;
drm_resource_object->mCrtcList[i] = drm_crtc_object;
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d]drm_resource_object.mCrtcList[%d] = %p drm_crtc_object = %p \n", __FUNCTION__, __LINE__, i, &(drm_resource_object->mCrtcList[i]), &drm_crtc_object);
drmModeFreeCrtc(c);
}
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initCrtc: res = %d \n", __FUNCTION__, __LINE__, res);
return res;
}
int initEncoder(Drm_resource *drm_resource_object, drmModeResPtr r)
{
if (MTK_LOG_ENABLE)
SLOGD("[drm_resource: %s %d] initEncoder: drm_resource_object = %p \n", __FUNCTION__, __LINE__, drm_resource_object);
int res = 0;
if (!r->count_encoders)
{
SLOGE("[drm_resource: %s %d] No Encoder found, return \n", __FUNCTION__, __LINE__);
return -1;
}
countEncoder = r->count_encoders;
for (int i = 0; i < r->count_encoders; i++)
{
drmModeEncoderPtr e = drmModeGetEncoder(drm_resource_object->mDrmFd, r->encoders[i]);
Drm_encoder drm_encoder_object;
init_drmencoder(&drm_encoder_object, e);
drm_resource_object->mEncoderList[i] = drm_encoder_object;
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] drm_resource_object.mEncoderList[%d] = %p drm_encoder_object = %p \n", __FUNCTION__, __LINE__, i, &(drm_resource_object->mEncoderList[i]), &drm_encoder_object);
//SLOGD("[drm_resource: %s %d] Loop successfully %dth time \n", __FUNCTION__, __LINE__, i);
drmModeFreeEncoder(e);
}
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initEncoder: res = %d \n", __FUNCTION__, __LINE__, res);
return res;
}
int initConnector(Drm_resource *drm_resource_object, drmModeResPtr r)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initConnector: drm_resource_object = %p \n", __FUNCTION__, __LINE__, drm_resource_object);
if (!r->count_connectors)
{
SLOGE("[drm_resource: %s %d] No Connector found, return \n", __FUNCTION__, __LINE__);
return -1;
}
int res = 0;
countConnector = r->count_connectors;
for (int i = 0; i < r->count_connectors; i++)
{
drmModeConnectorPtr c = drmModeGetConnector(drm_resource_object->mDrmFd, r->connectors[i]);
if ((!c) || (!c->count_modes) || (!c->count_encoders))
{
SLOGE("[drm_resource: %s %d] connector resource free %dth time, error in c ptr \n", __FUNCTION__, __LINE__, i);
drmModeFreeConnector(c);
continue;
}
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initConnector: count_connectors = %d, count_modes = %d \n", __FUNCTION__, __LINE__, r->count_connectors, c->count_modes);
Drm_connector drm_connector_object;
init_drm_connector(&drm_connector_object, c);
drm_resource_object->mConnectorList[i] = drm_connector_object;
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] drm_resource_object.mConnectorList[%d] = %p drm_connector_object = %p \n", __FUNCTION__, __LINE__, i, &(drm_resource_object->mConnectorList[i]), &drm_connector_object);
//SLOGD("[drm_resource: %s %d] Loop successfully %dth time \n", __FUNCTION__, __LINE__, i);
drmModeFreeConnector(c);
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] connector resource free %dth time \n", __FUNCTION__, __LINE__, i);
}
//SLOGD("[drm_resource: %s %d] initConnector: res = %d \n", __FUNCTION__, __LINE__, res);
return res;
}
int32_t getEncoderIndexByEncoderId(Drm_resource *drm_resource_object, uint32_t mId)
{
for (size_t j = 0; j < countEncoder; j++)
{
//drm_resource_object.mEncoderList.size(); j++) {
Drm_encoder *drm_encoder_object = &(drm_resource_object->mEncoderList[j]);
if (drm_encoder_object->mId == mId)
{
return j;
}
}
return -1;
}
int getLcmCrtcIndex(int mPossibleCrtc, bool isMain0)
{
int i = 0;
SLOGD("%s:, possiblecrtc=%d, isMain0=%d\n", __FUNCTION__, mPossibleCrtc, isMain0);
while (mPossibleCrtc > 0)
{
if (mPossibleCrtc & 1)
{
if (isMain0)
return i;
}
mPossibleCrtc = mPossibleCrtc >> 1;
i++;
}
return i-1;
}
bool checkIfExist(uint32_t mConnectorType)
{
SLOGD("%s: check connectorType=%d exist or not, targetLcm count=%d\n", __FUNCTION__, mConnectorType, sizeof(targetLcmInterface)/sizeof(targetLcmInterface[0]));
for (int i = 0; i < sizeof(targetLcmInterface)/sizeof(targetLcmInterface[0]); i++)
{
if (mConnectorType == targetLcmInterface[0])
{
SLOGD("%s: found-%d connectorType=%d\n", __FUNCTION__, i, mConnectorType);
return true;
}
}
SLOGD("%s: not found connectorType=%d\n", __FUNCTION__, mConnectorType);
return false;
}
int findDisplay(Drm_resource *drm_resource_object)
{
int i = 0;
int possibleEncoderId = 0, encoderIndex = -1;
int found_LCD = NO_LCD;
int lcmConnectorId[2] = {-1,-1};
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] Find Display: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
SLOGD("[drm_resource: %s %d] Find Display: countCrtc = %d, countEncoder = %d, countConnector = %d \n", __FUNCTION__, __LINE__, countCrtc, countEncoder, countConnector);
}
for (size_t k = 0; k < countConnector; k++)
{
Drm_connector *drm_connector_object = &(drm_resource_object->mConnectorList[k]);
SLOGD("%s: loop-%d, connector tyep=%d\n",__FUNCTION__, k, getConnectorType(*drm_connector_object));
if (checkIfExist(getConnectorType(*drm_connector_object)))
{
lcmConnectorId[i] = k;
SLOGD("%s: record Type-%d index[%d]=%d\n",__FUNCTION__, getConnectorType(*drm_connector_object), i, k);
i++;
}
}
SLOGD("%s:, lcmConnectorId_len=%d\n", __FUNCTION__, sizeof(lcmConnectorId)/sizeof(lcmConnectorId[0]));
for (i = 0; i < sizeof(lcmConnectorId)/sizeof(lcmConnectorId[0]); i++)
{
SLOGD("%s:, lcmConnectorId[%d]=%d\n",__FUNCTION__, i, lcmConnectorId[i]);
if (lcmConnectorId[i] != -1)
{
possibleEncoderId = getPossibleEncoder(drm_resource_object->mConnectorList[lcmConnectorId[i]]);
SLOGD("%s:, possibleEncoderId=%d\n",__FUNCTION__, possibleEncoderId);
encoderIndex = getEncoderIndexByEncoderId(drm_resource_object, possibleEncoderId);
Drm_encoder *drm_encoder_object = &(drm_resource_object->mEncoderList[encoderIndex]);
SLOGD("%s:, possibleEncoderId=%d, encoderIndex=%d, possibleCrtc=%d\n",__FUNCTION__, possibleEncoderId, encoderIndex, getPossibleCrtcs(*drm_encoder_object));
found_LCD++;
if (found_LCD == MAIN_LCD) //Primary LCD
{
possibleCrtcMain = getPossibleCrtcs(*drm_encoder_object);
drm_resource_object->mCrtc = &(drm_resource_object->mCrtcList[getLcmCrtcIndex(possibleCrtcMain, true)]);
drm_resource_object->mEncoder = &(drm_resource_object->mEncoderList[encoderIndex]);
drm_resource_object->mConnector = &(drm_resource_object->mConnectorList[lcmConnectorId[i]]);
if (MTK_LOG_ENABLE == 1)
{
SLOGD("find primary display success: crtc[id:%u address:%p] encoder[id:%u address:%p] connector[id:%u address:%p getAdd:%p]",
getLcmCrtcIndex(possibleCrtcMain, true), &(drm_resource_object->mCrtc),
possibleEncoderId, &(drm_resource_object->mEncoder),
drm_resource_object->mConnectorList[lcmConnectorId[i]], &(drm_resource_object->mConnector),
drm_resource_object->mConnector);
}
int getResolution = getModeResolution(*(drm_resource_object->mConnector), &(drm_resource_object->mDisplayWidth), &(drm_resource_object->mDisplayHeight), 0);
if (MTK_LOG_ENABLE == 1)
{
SLOGD(" \n drm_resource_object.mConnector = %p %p %p\n \
drm_resource_object.mDisplayWidth= &=>[%p , %d], %p \n \
drm_resource_object.mDisplayHeight = &=>[%p %d], %p ",
&drm_resource_object->mConnector, &(drm_resource_object->mConnector->mId), &drm_resource_object,
&(drm_resource_object->mDisplayWidth), drm_resource_object->mDisplayWidth, &drm_resource_object->mDisplayWidth,
&(drm_resource_object->mDisplayHeight), drm_resource_object->mDisplayHeight, &drm_resource_object->mDisplayHeight);
}
drm_set_lcd_num(found_LCD);
}
else if (found_LCD == EXT_LCD_FOLDABLE) //Second LCD
{
possibleCrtcExt = getPossibleCrtcs(*drm_encoder_object);
drm_resource_object->mCrtc_ext = &(drm_resource_object->mCrtcList[getLcmCrtcIndex(possibleCrtcExt, false)]);
drm_resource_object->mEncoder_ext = &(drm_resource_object->mEncoderList[encoderIndex]);
drm_resource_object->mConnector_ext = &(drm_resource_object->mConnectorList[lcmConnectorId[i]]);
if (drm_resource_object->mCrtc_ext != NULL) // second LCD not present
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("find ext display success: crtc[id:%u address:%p] encoder[id:%u address:%p] connector[id:%u address:%p getAdd:%p]",
getLcmCrtcIndex(possibleCrtcExt, false), &(drm_resource_object->mCrtc_ext),
possibleEncoderId, &(drm_resource_object->mEncoder_ext),
drm_resource_object->mConnectorList[lcmConnectorId[i]], &(drm_resource_object->mConnector_ext),
drm_resource_object->mConnector_ext);
}
int getResolution = getModeResolution(*(drm_resource_object->mConnector_ext), &(drm_resource_object->mDisplayWidth_ext), &(drm_resource_object->mDisplayHeight_ext), 0);
if (MTK_LOG_ENABLE == 1)
{
SLOGD(" \n drm_resource_object.mConnector_ext = %p %p %p\n \
drm_resource_object.mDisplayWidth_ext = &=>[%p , %d], %p \n \
drm_resource_object.mDisplayHeight_ext = &=>[%p %d], %p ",
&drm_resource_object->mConnector_ext, &(drm_resource_object->mConnector_ext->mId), &drm_resource_object,
&(drm_resource_object->mDisplayWidth_ext), drm_resource_object->mDisplayWidth_ext, &drm_resource_object->mDisplayWidth_ext,
&(drm_resource_object->mDisplayHeight_ext), drm_resource_object->mDisplayHeight_ext, &drm_resource_object->mDisplayHeight_ext);
}
drm_set_lcd_num(found_LCD);
}
}
}
}
return found_LCD;
}
#if 0
int findDisplay(Drm_resource *drm_resource_object)
{
int found_LCD = NO_LCD;
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] Find Display: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
SLOGD("[drm_resource: %s %d] Find Display: countCrtc = %d, countEncoder = %d, countConnector = %d \n", __FUNCTION__, __LINE__, countCrtc, countEncoder, countConnector);
}
for (size_t i = 0; i < countCrtc; i++)
{ //drm_resource_object.mCrtcList.size(); i++) {
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] Find Display: inside loop 1 => [%d] drm_resource_object.mCrtcList[%d] = %p \n", __FUNCTION__, __LINE__, i, i, &(drm_resource_object->mCrtcList[i]));
Drm_crtc *drm_crtc_object = &(drm_resource_object->mCrtcList[i]);
uint32_t pipe = getPipe(*drm_crtc_object);
if (MTK_LOG_ENABLE == 1)
SLOGD("Pipe: %u", pipe);
for (size_t j = i; j < countEncoder; j++)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] Find Display: inside loop 2 => [%d] drm_resource_object.mEncoderList[%d] %p \n", __FUNCTION__, __LINE__, j, j, &(drm_resource_object->mEncoderList[j]));
//drm_resource_object.mEncoderList.size(); j++) {
Drm_encoder *drm_encoder_object = &(drm_resource_object->mEncoderList[j]);
uint32_t mask = 1 << pipe;
if (getPossibleCrtcs(*drm_encoder_object) & mask)
{
for (size_t k = j; k < countConnector; k++)
{ //drm_resource_object.mConnectorList.size(); k++) {
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] Find Display: inside loop 3 => [%d] drm_resource_object.mConnectorList[%d] = %p \n", __FUNCTION__, __LINE__, k, k, &(drm_resource_object->mConnectorList[k]));
Drm_connector *drm_connector_object = &(drm_resource_object->mConnectorList[k]);
if (isValidEncoder(*drm_connector_object, getEncoderId(*drm_encoder_object)) &&
getConnectorType(*drm_connector_object) == DRM_MODE_CONNECTOR_DSI)
{
found_LCD++;
if (found_LCD == MAIN_LCD) //Primary LCD
{
drm_resource_object->mCrtc = &(drm_resource_object->mCrtcList[i]);
drm_resource_object->mEncoder = &(drm_resource_object->mEncoderList[j]);
drm_resource_object->mConnector = &(drm_resource_object->mConnectorList[k]);
if (MTK_LOG_ENABLE == 1)
{
SLOGD("find primary display success: crtc[pipe:%u id:%u address:%p] encoder[id:%u address:%p] connector[id:%u address:%p getAdd:%p]",
pipe, getCrtcId(*drm_crtc_object), &(drm_resource_object->mCrtc), getEncoderId(*drm_encoder_object), &(drm_resource_object->mEncoder), getConnectorId(*drm_connector_object), &(drm_resource_object->mConnector), drm_resource_object->mConnector);
}
int getResolution = getModeResolution(*(drm_resource_object->mConnector), &(drm_resource_object->mDisplayWidth), &(drm_resource_object->mDisplayHeight), 0);
if (MTK_LOG_ENABLE == 1)
{
SLOGD(" \n drm_resource_object.mConnector = %p %p %p\n \
drm_resource_object.mDisplayWidth= &=>[%p , %d], %p \n \
drm_resource_object.mDisplayHeight = &=>[%p %d], %p ",
&drm_resource_object->mConnector, &(drm_resource_object->mConnector->mId), &drm_resource_object,
&(drm_resource_object->mDisplayWidth), drm_resource_object->mDisplayWidth, &drm_resource_object->mDisplayWidth,
&(drm_resource_object->mDisplayHeight), drm_resource_object->mDisplayHeight, &drm_resource_object->mDisplayHeight);
}
drm_set_lcd_num(found_LCD);
break;
}
else if (found_LCD == EXT_LCD_FOLDABLE) //Second LCD
{
drm_resource_object->mCrtc_ext = &(drm_resource_object->mCrtcList[i]);
drm_resource_object->mEncoder_ext = &(drm_resource_object->mEncoderList[j]);
drm_resource_object->mConnector_ext = &(drm_resource_object->mConnectorList[k]);
if (drm_resource_object->mCrtc_ext != NULL) // second LCD not present
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("find second display success: crtc[pipe:%u id:%u address:%p] encoder[id:%u address:%p] connector[id:%u address:%p getAdd:%p]",
pipe, getCrtcId(*drm_crtc_object), &(drm_resource_object->mCrtc_ext), getEncoderId(*drm_encoder_object), &(drm_resource_object->mEncoder_ext), getConnectorId(*drm_connector_object), &(drm_resource_object->mConnector_ext), drm_resource_object->mConnector_ext);
}
int getResolution = getModeResolution(*(drm_resource_object->mConnector_ext), &(drm_resource_object->mDisplayWidth_ext), &(drm_resource_object->mDisplayHeight_ext), 0);
if (MTK_LOG_ENABLE == 1)
{
SLOGD(" \n drm_resource_object.mConnector_ext = %p %p %p\n \
drm_resource_object.mDisplayWidth_ext = &=>[%p , %d], %p \n \
drm_resource_object.mDisplayHeight_ext = &=>[%p %d], %p ",
&drm_resource_object->mConnector_ext, &(drm_resource_object->mConnector_ext->mId), &drm_resource_object,
&(drm_resource_object->mDisplayWidth_ext), drm_resource_object->mDisplayWidth_ext, &drm_resource_object->mDisplayWidth_ext,
&(drm_resource_object->mDisplayHeight_ext), drm_resource_object->mDisplayHeight_ext, &drm_resource_object->mDisplayHeight_ext);
}
drm_set_lcd_num(found_LCD);
break;
}
}
}
}
break;
}
}
}
return found_LCD;
}
#endif
int createFramebuffer(Drm_resource *drm_resource_object)
{
int res, res_ext = 0;
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] createFrambuffer: drm_resource_object = %p\n", __FUNCTION__, __LINE__, &drm_resource_object);
for (size_t i = 0; i < MAX_BO_SIZE; i++)
{
drm_resource_object->mBo[i].width = drm_resource_object->mDisplayWidth;
drm_resource_object->mBo[i].height = drm_resource_object->mDisplayHeight;
drm_resource_object->mBo[i].format = DRM_FORMAT_RGBA8888;
res = allocateBuffer(drm_resource_object, &(drm_resource_object->mBo[i]));
if (res != 0)
{
SLOGE("Primary display : failed to allocateBuffer_%zu: %d", i, res);
return res;
}
}
if (drm_resource_object->mCrtc_ext != NULL) //2nd lcd present
{
for (size_t j = 0; j < MAX_BO_SIZE; j++)
{
drm_resource_object->mBo_ext[j].width = drm_resource_object->mDisplayWidth_ext;
drm_resource_object->mBo_ext[j].height = drm_resource_object->mDisplayHeight_ext;
drm_resource_object->mBo_ext[j].format = DRM_FORMAT_RGBA8888;
res_ext = allocateBuffer(drm_resource_object, &(drm_resource_object->mBo_ext[j]));
if (res_ext != 0)
{
SLOGE("Ext display : failed to allocateBuffer_%zu: %d", j, res_ext);
return res_ext;
}
}
}
return res;
}
int allocateBuffer(Drm_resource *drm_resource_object, struct DrmBo *bo)
{
int res = 0;
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] allocateBuffer: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
SLOGD("allocateBuffer: %ux%u format:0x%08x", bo->width, bo->height, bo->format);
}
res = createDumb(drm_resource_object, bo);
if (res)
{
SLOGE("failed to create dumb buffer: %d (wxh=%ux%u)",
res, bo->width, bo->height);
return res;
}
res = addFb(drm_resource_object, bo);
if (res)
{
SLOGE("faile to add fb: %d", res);
struct drm_mode_destroy_dumb destroyArg;
memset(&destroyArg, 0, sizeof(destroyArg));
destroyArg.handle = bo->gemHandles[0];
if (drmIoctl(drm_resource_object->mDrmFd, DRM_IOCTL_MODE_DESTROY_DUMB, &destroyArg))
SLOGE("[drm_resource: %s %d]: destroy dumb %d", __FUNCTION__, __LINE__, res);
return res;
}
else
{
SLOGD("success to add fb: fb_id=%u", bo->fbId);
}
#if 1
int fd = -1;
res = drmPrimeHandleToFD(drm_resource_object->mDrmFd, bo->gemHandles[0], DRM_RDWR, &fd);
if (res)
{
SLOGE("[drm_resource: %s %d]: failed to exchange the fd: %d", __FUNCTION__, __LINE__, res);
freeBuffer(drm_resource_object, bo);
return res;
}
else
{
SLOGD("[drm_resource: %s %d]: success to exchange fd: %d", __FUNCTION__, __LINE__, fd);
}
bo->fd = fd;
#endif
return res;
}
int createDumb(Drm_resource *drm_resource_object, struct DrmBo *bo)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] createDumb: drm_resource_object = %p bpp = %d\n", __FUNCTION__, __LINE__, &drm_resource_object, getDrmBPP(bo->format));
int res = 0;
struct drm_mode_create_dumb createArg;
memset(&createArg, 0, sizeof(createArg));
createArg.bpp = getDrmBPP(bo->format);
createArg.width = bo->width;
createArg.height = bo->height;
res = drmIoctl(drm_resource_object->mDrmFd, DRM_IOCTL_MODE_CREATE_DUMB, &createArg);
if (res == 0)
{
bo->pitches[0] = createArg.pitch;
bo->gemHandles[0] = createArg.handle;
bo->offsets[0] = 0;
bo->size = createArg.size;
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] bo->size = %d \n", __FUNCTION__, __LINE__, bo->size);
}
else
SLOGE("[drm_resource: %s %d] create dumb IOCTL failed", __FUNCTION__, __LINE__);
return res;
}
int addFb(Drm_resource *drm_resource_object, struct DrmBo *bo)
{
if (MTK_LOG_ENABLE == 1)
{
SLOGD("[drm_resource: %s %d] addFb: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
SLOGD("add fb w:%u h:%u f:%x hnd:%u p:%u o:%u",
bo->width, bo->height, bo->format, bo->gemHandles[0],
bo->pitches[0], bo->offsets[0]);
}
int res = 0;
res = drmModeAddFB2WithModifiers(drm_resource_object->mDrmFd, bo->width, bo->height, bo->format, bo->gemHandles,
bo->pitches, bo->offsets, bo->modifier, &(bo->fbId), DRM_MODE_FB_MODIFIERS);
if (res)
{
SLOGE("failed to add fb ret=%d, w:%u h:%u f:%x hnd:%u p:%u o:%u",
res, bo->width, bo->height, bo->format, bo->gemHandles[0],
bo->pitches[0], bo->offsets[0]);
}
return res;
}
int freeBuffer(Drm_resource *drm_resource_object, struct DrmBo *bo)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] initConnector: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
int res = 0;
res = removeFb(drm_resource_object, bo->fbId);
if (res)
{
SLOGE("[drm_resource: %s %d] failed to remove fb: %d", __FUNCTION__, __LINE__, res);
}
res = destroyDumb(drm_resource_object, bo);
if (res)
{
SLOGE("[drm_resource: %s %d] failed to destroy dumb: %d", __FUNCTION__, __LINE__, res);
}
return res;
}
int removeFb(Drm_resource *drm_resource_object, uint32_t fbId)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] removeFb: drm_resource_object = %p FbID = %u \n", __FUNCTION__, __LINE__, &drm_resource_object, fbId);
int res = 0;
res = drmModeRmFB(drm_resource_object->mDrmFd, fbId);
if (res)
{
SLOGE("[drm_resource: %s %d] failed to remove fb ret=%d, id:%u", __FUNCTION__, __LINE__, res, fbId);
}
return res;
}
int destroyDumb(Drm_resource *drm_resource_object, struct DrmBo *bo)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource: %s %d] destroyDumb: drm_resource_object = %p \n", __FUNCTION__, __LINE__, &drm_resource_object);
int res = 0;
struct drm_mode_destroy_dumb destroyArg;
memset(&destroyArg, 0, sizeof(destroyArg));
destroyArg.handle = bo->gemHandles[0];
res = drmIoctl(drm_resource_object->mDrmFd, DRM_IOCTL_MODE_DESTROY_DUMB, &destroyArg);
return res;
}
void draw(Drm_resource *drm_resource_object)
{
uint32_t connectorId = getConnectorId(*(drm_resource_object->mConnector));
drmModeModeInfo modeInfo = getModeInfo(drm_resource_object->mConnector->mModes[0]);
uint32_t crtcId = getCrtcId(*(drm_resource_object->mCrtc));
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] drm_resource_object = %p ", __FUNCTION__, __LINE__, drm_resource_object);
for (int i = 0; i < MAX_BO_SIZE; ++i)
{
struct DrmBo *bo = &(drm_resource_object->mBo[drm_resource_object->mPinPon]);
SLOGD("[drm_resource %s %d] data for crtc => mdrmfd = %d , crtcId = %d, fbId = %d,x= %d,Y = %d, connectorId = %p , 1, modeInfo = %p %p",
__FUNCTION__, __LINE__, drm_resource_object->mDrmFd, crtcId, bo->fbId, 0, 0, &connectorId, &modeInfo, modeInfo);
SLOGD("[drm_resource %s %d] drmmodeinfo before setCrtc = %d,\n hdisplay = %d, hsync_start = %d, hsync_end = %d, htotal = %d, hskew = %d, \n vdisplay = %d, vsync_start = %d, vsync_end = %d, vtotal = %d, vscan = %d, \n vrefresh = %d, flags = %d, type = %d",
__FUNCTION__, __LINE__, modeInfo.clock, modeInfo.hdisplay, modeInfo.hsync_start, modeInfo.hsync_end, modeInfo.htotal, modeInfo.hskew, modeInfo.vdisplay, modeInfo.vsync_start, modeInfo.vsync_end, modeInfo.vtotal, modeInfo.vtotal, modeInfo.vscan, modeInfo.vrefresh, modeInfo.flags, modeInfo.type);
int res = drmModeSetCrtc(drm_resource_object->mDrmFd, crtcId, bo->fbId, 0, 0, &connectorId, 1, &modeInfo);
if (res != 0)
{
SLOGE("[drm_resource %s %d] failed to set crtc for 1st LCD: %d", __FUNCTION__, __LINE__, res);
}
else
{
SLOGD("[drm_resource %s %d] 1st LCD - draw a frame [%zu]fb_id=%u crtc=%u conn=%u", __FUNCTION__, __LINE__, drm_resource_object->mPinPon, drm_resource_object->mBo[drm_resource_object->mPinPon].fbId, crtcId, connectorId);
}
drm_resource_object->mPinPon = drm_resource_object->mPinPon + 1;
drm_resource_object->mPinPon = drm_resource_object->mPinPon % MAX_BO_SIZE;
//dualdisplay
if (drm_resource_object->mCrtc_ext != NULL) //2nd lcd present
{
uint32_t connectorId_ext = getConnectorId(*(drm_resource_object->mConnector_ext));
drmModeModeInfo modeInfo_ext = getModeInfo(drm_resource_object->mConnector_ext->mModes[0]);
uint32_t crtcId_ext = getCrtcId(*(drm_resource_object->mCrtc_ext));
struct DrmBo *bo_ext = &(drm_resource_object->mBo_ext[drm_resource_object->mPinPon_ext]);
SLOGD("[drm_resource %s %d] 2nd LCD data for crtc => mdrmfd = %d , crtcId = %d, fbId = %d,x= %d,Y = %d, connectorId = %p , 1, modeInfo = %p %p",
__FUNCTION__, __LINE__, drm_resource_object->mDrmFd, crtcId_ext, bo_ext->fbId, 0, 0, &connectorId_ext, &modeInfo_ext, modeInfo_ext);
SLOGD("[drm_resource %s %d] 2nd LCD drmmodeinfo before setCrtc = %d,\n hdisplay = %d, hsync_start = %d, hsync_end = %d, htotal = %d, hskew = %d, \n vdisplay = %d, vsync_start = %d, vsync_end = %d, vtotal = %d, vscan = %d, \n vrefresh = %d, flags = %d, type = %d",
__FUNCTION__, __LINE__, modeInfo_ext.clock, modeInfo_ext.hdisplay, modeInfo_ext.hsync_start, modeInfo_ext.hsync_end, modeInfo_ext.htotal, modeInfo_ext.hskew, modeInfo_ext.vdisplay, modeInfo_ext.vsync_start, modeInfo_ext.vsync_end, modeInfo_ext.vtotal, modeInfo_ext.vtotal, modeInfo_ext.vscan, modeInfo_ext.vrefresh, modeInfo_ext.flags, modeInfo_ext.type);
int res_ext = drmModeSetCrtc(drm_resource_object->mDrmFd, crtcId_ext, bo_ext->fbId, 0, 0, &connectorId_ext, 1, &modeInfo_ext);
if (res_ext != 0)
{
SLOGE("[drm_resource %s %d] failed to set crtc for 2nd LCD: %d", __FUNCTION__, __LINE__, res_ext);
}
else
{
SLOGD("[drm_resource %s %d] 2nd LCD - draw a frame [%zu]fb_id=%u crtc=%u conn=%u", __FUNCTION__, __LINE__, drm_resource_object->mPinPon_ext, drm_resource_object->mBo_ext[drm_resource_object->mPinPon_ext].fbId, crtcId_ext, connectorId_ext);
}
drm_resource_object->mPinPon_ext = drm_resource_object->mPinPon_ext + 1;
drm_resource_object->mPinPon_ext = drm_resource_object->mPinPon_ext % MAX_BO_SIZE;
}
}
}
int getDrmFb(Drm_resource *drm_resource_object)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] getDrmFb called ", __FUNCTION__, __LINE__);
int ret = 0;
int setPinpon = -1;
int setPinpon_ext = -1;
drmModeResPtr res = drmModeGetResources(drm_resource_object->mDrmFd);
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] res->count_fbs=%d, res->count_crtcs=%d ", __FUNCTION__, __LINE__, res->count_fbs, res->count_crtcs);
for (int i = 0; i < res->count_crtcs; i++)
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] iteration = %d ", __FUNCTION__, __LINE__, i);
drmModeCrtcPtr c = drmModeGetCrtc(drm_resource_object->mDrmFd, res->crtcs[i]);
drmModeFBPtr fb = drmModeGetFB(drm_resource_object->mDrmFd, c->buffer_id);
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] crtc value=%d\n", __FUNCTION__, __LINE__, res->crtcs[i]);
if (fb == NULL)
{
SLOGE("[drm_resource %s %d] getDrmFb failed\n", __FUNCTION__, __LINE__);
drmModeFreeFB(fb);
drmModeFreeCrtc(c);
}
else
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] getDrmFb info fb->id = %d fb->bpp = %d, fb->width = %d ", __FUNCTION__, __LINE__, fb->fb_id, fb->bpp, fb->width);
//if ((*drm_resource_object).mCrtc == res->crtcs[i]) // LCD 1
if (i == 0) // LCD 1
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] Primary LCD getDrmFb success fb->id = %d fb->bpp = %d, fb->width = %d ", __FUNCTION__, __LINE__, fb->fb_id, fb->bpp, fb->width);
(*drm_resource_object).fb = *fb;
}
//else if ((*drm_resource_object).mCrtc_ext == res->crtcs[i]) // LCD 2
else if (i == getLcmCrtcIndex(possibleCrtcExt, false) && is_ext_lcd_present()) // LCD 2
{
if (MTK_LOG_ENABLE == 1)
SLOGD("[drm_resource %s %d] 2nd LCD getDrmFb success fb_ext->id = %d fb_ext->bpp = %d, fb_ext->width = %d ", __FUNCTION__, __LINE__, fb->fb_id, fb->bpp, fb->width);
(*drm_resource_object).fb_ext = *fb;
}
drmModeFreeFB(fb);
drmModeFreeCrtc(c);
}
}
drmModeFreeResources(res);
for (int j = 0; j < MAX_BO_SIZE; ++j)
{
if (drm_resource_object->mBo[j].fbId == drm_resource_object->fb.fb_id)
{
setPinpon = j;
continue;
}
if ((drm_resource_object->mBo_ext[j].fbId == drm_resource_object->fb_ext.fb_id) && is_ext_lcd_present())
{
setPinpon_ext = j;
continue;
}
}
if (setPinpon != -1)
{
drm_resource_object->mPinPon = (setPinpon + 1) % MAX_BO_SIZE;
}
if ((setPinpon_ext != -1) && is_ext_lcd_present())
{
drm_resource_object->mPinPon_ext = (setPinpon_ext + 1) % MAX_BO_SIZE;
}
return ret;
}
void freeResource(Drm_resource *drm_resource_object) {
for(int i = 0; i < MAX_BO_SIZE; ++i){
if(drm_resource_object->mBo[i].fd >= 0)
close(drm_resource_object->mBo[i].fd);
if(drm_resource_object->mBo[i].fbId != 0)
removeFb(drm_resource_object, drm_resource_object->mBo[i].fbId);
if(drm_resource_object->mBo[i].gemHandles[0])
destroyDumb(drm_resource_object, &(drm_resource_object->mBo[i]));
//dualdisplay
if (is_ext_lcd_present()) // 2nd LCD present
{
if(drm_resource_object->mBo_ext[i].fd >= 0)
close(drm_resource_object->mBo_ext[i].fd);
if(drm_resource_object->mBo_ext[i].fbId != 0)
removeFb(drm_resource_object, drm_resource_object->mBo_ext[i].fbId);
if(drm_resource_object->mBo_ext[i].gemHandles[0])
destroyDumb(drm_resource_object, &(drm_resource_object->mBo_ext[i]));
}
}
free(drm_resource_object->mCrtc);
free(drm_resource_object->mEncoder);
free(drm_resource_object->mConnector);
//dualdisplay
if (is_ext_lcd_present()) // 2nd LCD present
{
free(drm_resource_object->mCrtc_ext);
free(drm_resource_object->mEncoder_ext);
free(drm_resource_object->mConnector_ext);
}
free(drm_resource_object->mCrtcList);
free(drm_resource_object->mEncoderList);
free(drm_resource_object->mConnectorList);
}
Reference in New Issue View Git Blame Copy Permalink