Framebuffer::Framebuffer(Card& card, uint32_t id)
: DrmObject(card, id, DRM_MODE_OBJECT_FB)
{
auto fb = drmModeGetFB(card.fd(), id);
m_width = fb->width;
m_height = fb->height;
drmModeFreeFB(fb);
card.m_framebuffers.push_back(this);
}
static void printFramebuffers(int fd, uint32_t* ids, uint32_t count) {
int i;
for (i = 0; i < count; i++) {
drmModeFB *fb;
fb = drmModeGetFB(fd, ids[i]);
fprintf(stdout, " Framebuffer %u:\n", fb->fb_id);
fprintf(stdout, " Handle: %u\n", fb->handle);
fprintf(stdout, " Dimensions: %u x %u\n", fb->width, fb->height);
fprintf(stdout, " Depth: %u\n", fb->depth);
fprintf(stdout, " BPP: %u\n", fb->bpp);
fprintf(stdout, " Pitch: %u\n", fb->pitch);
fprintf(stdout, "\n");
drmModeFreeFB(fb);
}
}
bool IntelHWComposerDrm::setupDrmFb(int disp,
uint32_t fb_handler,
drmModeModeInfoPtr mode)
{
if (mDrmFd < 0) {
ALOGE("%s: invalid drm FD\n", __func__);
return false;
}
if (!mode) {
ALOGW("%s: invalid mode !\n", __func__);
return false;
}
int width = mode->hdisplay;
int height = mode->vdisplay;
int stride = align_to(width*4, 64);
uint32_t fb_id = 0;
// Drm add FB
int ret = drmModeAddFB(mDrmFd, width, height, 24, 32,
stride, (uint32_t)(fb_handler), &fb_id);
if (ret) {
ALOGE("%s: Failed to add fb !", __func__);
return false;
}
// add to local output structure
drmModeFBPtr fbInfo = drmModeGetFB(mDrmFd, fb_id);
if (!fbInfo) {
ALOGE("%s: Failed to get fbInfo! ", __func__);
return false;
}
setOutputFBInfo(disp, fbInfo);
drmModeFreeFB(fbInfo);
return true;
}
bool IntelHWComposerDrm::detectDrmModeInfo()
{
ALOGD_IF(ALLOW_MONITOR_PRINT, "%s: detecting drm mode info...\n", __func__);
if (mDrmFd < 0) {
ALOGE("%s: invalid drm FD\n", __func__);
return false;
}
/*try to get drm resources*/
drmModeResPtr resources = drmModeGetResources(mDrmFd);
if (!resources || !resources->connectors) {
ALOGE("%s: fail to get drm resources. %s\n", __func__, strerror(errno));
return false;
}
/*get mipi0 info*/
drmModeConnectorPtr connector = NULL;
drmModeEncoderPtr encoder = NULL;
drmModeCrtcPtr crtc = NULL;
drmModeConnectorPtr connectors[OUTPUT_MAX];
drmModeModeInfoPtr mode = NULL;
drmModeFBPtr fbInfo = NULL;
for (int i = 0; i < resources->count_connectors; i++) {
connector = drmModeGetConnector(mDrmFd, resources->connectors[i]);
if (!connector) {
ALOGW("%s: fail to get drm connector\n", __func__);
continue;
}
int outputIndex = -1;
if (connector->connector_type == DRM_MODE_CONNECTOR_MIPI ||
connector->connector_type == DRM_MODE_CONNECTOR_LVDS) {
ALOGD_IF(ALLOW_MONITOR_PRINT, "%s: got MIPI/LVDS connector\n", __func__);
if (connector->connector_type_id == 1)
outputIndex = OUTPUT_MIPI0;
else if (connector->connector_type_id == 2)
outputIndex = OUTPUT_MIPI1;
else {
ALOGW("%s: unknown connector type\n", __func__);
outputIndex = OUTPUT_MIPI0;
}
} else if (connector->connector_type == DRM_MODE_CONNECTOR_DVID) {
ALOGD_IF(ALLOW_MONITOR_PRINT, "%s: got HDMI connector\n", __func__);
outputIndex = OUTPUT_HDMI;
}
/*update connection status*/
setOutputConnection(outputIndex, connector->connection);
/*get related encoder*/
encoder = drmModeGetEncoder(mDrmFd, connector->encoder_id);
if (!encoder) {
ALOGD_IF(ALLOW_MONITOR_PRINT, "%s: fail to get drm encoder\n", __func__);
drmModeFreeConnector(connector);
setOutputConnection(outputIndex, DRM_MODE_DISCONNECTED);
continue;
}
/*get related crtc*/
crtc = drmModeGetCrtc(mDrmFd, encoder->crtc_id);
if (!crtc) {
ALOGD_IF(ALLOW_MONITOR_PRINT, "%s: fail to get drm crtc\n", __func__);
drmModeFreeEncoder(encoder);
drmModeFreeConnector(connector);
setOutputConnection(outputIndex, DRM_MODE_DISCONNECTED);
continue;
}
/*set crtc mode*/
setOutputMode(outputIndex, &crtc->mode, crtc->mode_valid);
// get fb info
fbInfo = drmModeGetFB(mDrmFd, crtc->buffer_id);
if (!fbInfo) {
ALOGD("%s: fail to get fb info\n", __func__);
drmModeFreeCrtc(crtc);
drmModeFreeEncoder(encoder);
drmModeFreeConnector(connector);
setOutputConnection(outputIndex, DRM_MODE_DISCONNECTED);
continue;
}
setOutputFBInfo(outputIndex, fbInfo);
/*free all crtc/connector/encoder*/
drmModeFreeFB(fbInfo);
drmModeFreeCrtc(crtc);
drmModeFreeEncoder(encoder);
drmModeFreeConnector(connector);
}
drmModeFreeResources(resources);
drmModeConnection mipi0 = getOutputConnection(OUTPUT_MIPI0);
drmModeConnection mipi1 = getOutputConnection(OUTPUT_MIPI1);
drmModeConnection hdmi = getOutputConnection(OUTPUT_HDMI);
detectMDSModeChange();
ALOGD_IF(ALLOW_MONITOR_PRINT,
"%s: mipi/lvds %s, mipi1 %s, hdmi %s, displayMode %d\n",
__func__,
((mipi0 == DRM_MODE_CONNECTED) ? "connected" : "disconnected"),
((mipi1 == DRM_MODE_CONNECTED) ? "connected" : "disconnected"),
((hdmi == DRM_MODE_CONNECTED) ? "connected" : "disconnected"),
getDisplayMode());
return true;
}
static gboolean
configure_mode_setting (GstKMSSink * self, GstVideoInfo * vinfo)
{
gboolean ret;
drmModeConnector *conn;
int err;
drmModeFB *fb;
gint i;
drmModeModeInfo *mode;
guint32 fb_id;
GstKMSMemory *kmsmem;
ret = FALSE;
conn = NULL;
fb = NULL;
mode = NULL;
kmsmem = NULL;
if (self->conn_id < 0)
goto bail;
GST_INFO_OBJECT (self, "configuring mode setting");
kmsmem = (GstKMSMemory *) gst_kms_allocator_bo_alloc (self->allocator, vinfo);
if (!kmsmem)
goto bo_failed;
fb_id = kmsmem->fb_id;
conn = drmModeGetConnector (self->fd, self->conn_id);
if (!conn)
goto connector_failed;
fb = drmModeGetFB (self->fd, fb_id);
if (!fb)
goto framebuffer_failed;
for (i = 0; i < conn->count_modes; i++) {
if (conn->modes[i].vdisplay == fb->height &&
conn->modes[i].hdisplay == fb->width) {
mode = &conn->modes[i];
break;
}
}
if (!mode)
goto mode_failed;
err = drmModeSetCrtc (self->fd, self->crtc_id, fb_id, 0, 0,
(uint32_t *) & self->conn_id, 1, mode);
if (err)
goto modesetting_failed;
self->tmp_kmsmem = (GstMemory *) kmsmem;
ret = TRUE;
bail:
if (fb)
drmModeFreeFB (fb);
if (conn)
drmModeFreeConnector (conn);
return ret;
/* ERRORS */
bo_failed:
{
GST_ERROR_OBJECT (self,
"failed to allocate buffer object for mode setting");
goto bail;
}
connector_failed:
{
GST_ERROR_OBJECT (self, "Could not find a valid monitor connector");
goto bail;
}
framebuffer_failed:
{
GST_ERROR_OBJECT (self, "drmModeGetFB failed: %s (%d)",
strerror (errno), errno);
goto bail;
}
mode_failed:
{
GST_ERROR_OBJECT (self, "cannot find appropriate mode");
goto bail;
}
modesetting_failed:
{
GST_ERROR_OBJECT (self, "Failed to set mode: %s", strerror (errno));
goto bail;
}
}
