From dddd42690418b1b9aee795cd3fa0deb3eb45c83e Mon Sep 17 00:00:00 2001 From: dec05eba Date: Mon, 10 Apr 2023 02:25:43 +0200 Subject: kms: get plane every frame, might fix not updating issue and issue where plane gets invalid --- kms/server/kms_server.c | 235 +++++++++++++++++++++++++++++------------------- 1 file changed, 144 insertions(+), 91 deletions(-) (limited to 'kms/server') diff --git a/kms/server/kms_server.c b/kms/server/kms_server.c index 73cf9d0..7d0ed5c 100644 --- a/kms/server/kms_server.c +++ b/kms/server/kms_server.c @@ -16,6 +16,11 @@ #define DRM_CLIENT_CAP_UNIVERSAL_PLANES 2 +typedef struct { + int drmfd; + uint32_t plane_id; +} gsr_drm; + static int max_int(int a, int b) { return a > b ? a : b; } @@ -57,99 +62,135 @@ static int send_msg_to_client(int client_fd, gsr_kms_response *response, int *fd return sendmsg(client_fd, &response_message, 0); } -static int get_kms(const char *card_path, gsr_kms_response *response) { - response->result = KMS_RESULT_OK; - response->data.fd.fd = 0; - response->data.fd.width = 0; - response->data.fd.height = 0; - - const int drmfd = open(card_path, O_RDONLY); - if (drmfd < 0) { - response->result = KMS_RESULT_FAILED_TO_OPEN_CARD; - snprintf(response->data.err_msg, sizeof(response->data.err_msg), "failed to open %s, error: %s", card_path, strerror(errno)); - return -1; - } +static int kms_get_plane_id(gsr_drm *drm) { + drmModePlaneResPtr planes = NULL; + drmModePlanePtr plane = NULL; + drmModeFB2Ptr drmfb = NULL; + int result = -1; - if (0 != drmSetClientCap(drmfd, DRM_CLIENT_CAP_UNIVERSAL_PLANES, 1)) { - response->result = KMS_RESULT_INSUFFICIENT_PERMISSIONS; - snprintf(response->data.err_msg, sizeof(response->data.err_msg), "drmSetClientCap failed, error: %s", strerror(errno)); - close(drmfd); - return -1; + if(drmSetClientCap(drm->drmfd, DRM_CLIENT_CAP_UNIVERSAL_PLANES, 1) != 0) { + fprintf(stderr, "kms server error: drmSetClientCap failed, error: %s\n", strerror(errno)); + goto error; } - drmModePlaneResPtr planes = drmModeGetPlaneResources(drmfd); - if (!planes) { - response->result = KMS_RESULT_FAILED_TO_GET_KMS; - snprintf(response->data.err_msg, sizeof(response->data.err_msg), "failed to access planes, error: %s", strerror(errno)); - close(drmfd); - return -1; + planes = drmModeGetPlaneResources(drm->drmfd); + if(!planes) { + fprintf(stderr, "kms server error: failed to access planes, error: %s\n", strerror(errno)); + goto error; } - fprintf(stderr, "DRM planes %d:\n", planes->count_planes); - for (uint32_t i = 0; i < planes->count_planes; ++i) { - drmModePlanePtr plane = drmModeGetPlane(drmfd, planes->planes[i]); - if (!plane) { - fprintf(stderr, "Cannot get drmModePlanePtr for plane %#x: %s (%d)\n", planes->planes[i], strerror(errno), errno); + for(uint32_t i = 0; i < planes->count_planes; ++i) { + plane = drmModeGetPlane(drm->drmfd, planes->planes[i]); + if(!plane) { + fprintf(stderr, "kms server warning: failed to get drmModePlanePtr for plane %#x: %s (%d)\n", planes->planes[i], strerror(errno), errno); continue; } - fprintf(stderr, "\t%d: fb_id=%#x\n", i, plane->fb_id); - - if (!plane->fb_id) - goto plane_continue; - - drmModeFB2Ptr drmfb = drmModeGetFB2(drmfd, plane->fb_id); - if (!drmfb) { - fprintf(stderr, "Cannot get drmModeFBPtr for fb %#x: %s (%d)\n", plane->fb_id, strerror(errno), errno); - } else { - if (!drmfb->handles[0]) { - fprintf(stderr, "\t\tFB handle for fb %#x is NULL\n", plane->fb_id); - fprintf(stderr, "\t\tPossible reason: not permitted to get FB handles. Do `sudo setcap cap_sys_admin+ep`\n"); - } else { - int fb_fd = -1; - const int ret = drmPrimeHandleToFD(drmfd, drmfb->handles[0], 0, &fb_fd); - if (ret != 0 || fb_fd == -1) { - fprintf(stderr, "Cannot get fd for fb %#x handle %#x: %s (%d)\n", plane->fb_id, drmfb->handles[0], strerror(errno), errno); - } else if(drmfb->width * drmfb->height > response->data.fd.width * response->data.fd.height) { - if(response->data.fd.fd != 0) { - close(response->data.fd.fd); - response->data.fd.fd = 0; - } - - response->data.fd.fd = fb_fd; - response->data.fd.width = drmfb->width; - response->data.fd.height = drmfb->height; - response->data.fd.pitch = drmfb->pitches[0]; - response->data.fd.offset = drmfb->offsets[0]; - response->data.fd.pixel_format = drmfb->pixel_format; - response->data.fd.modifier = drmfb->modifier; - fprintf(stderr, "kms width: %u, height: %u, pixel format: %u, modifier: %lu\n", response->data.fd.width, response->data.fd.height, response->data.fd.pixel_format, response->data.fd.modifier); - } else { - close(fb_fd); - } - } - drmModeFreeFB2(drmfb); + if(!plane->fb_id) { + drmModeFreePlane(plane); + continue; } - plane_continue: + break; + } + + if(!plane) { + fprintf(stderr, "kms server error: failed to find a usable plane\n"); + goto error; + } + + // TODO: Fallback to getfb(1)? + drmfb = drmModeGetFB2(drm->drmfd, plane->fb_id); + if(!drmfb) { + fprintf(stderr, "kms server error: drmModeGetFB2 failed on plane fb id %d, error: %s\n", plane->fb_id, strerror(errno)); + goto error; + } + + if(!drmfb->handles[0]) { + fprintf(stderr, "kms server error: drmfb handle is NULL\n"); + goto error; + } + + drm->plane_id = plane->plane_id; + result = 0; + + error: + if(drmfb) + drmModeFreeFB2(drmfb); + if(plane) drmModeFreePlane(plane); + if(planes) + drmModeFreePlaneResources(planes); + + return result; +} + +static int kms_get_fb(gsr_drm *drm, gsr_kms_response *response) { + drmModePlanePtr plane = NULL; + drmModeFB2 *drmfb = NULL; + int result = -1; + + response->result = KMS_RESULT_OK; + response->data.fd.fd = 0; + response->data.fd.width = 0; + response->data.fd.height = 0; + + plane = drmModeGetPlane(drm->drmfd, drm->plane_id); + if(!plane) { + response->result = KMS_RESULT_FAILED_TO_GET_PLANE; + snprintf(response->data.err_msg, sizeof(response->data.err_msg), "failed to get drm plane with id %u, error: %s\n", drm->plane_id, strerror(errno)); + fprintf(stderr, "kms server error: %s\n", response->data.err_msg); + goto error; + } + + drmfb = drmModeGetFB2(drm->drmfd, plane->fb_id); + if(!drmfb) { + response->result = KMS_RESULT_FAILED_TO_GET_PLANE; + snprintf(response->data.err_msg, sizeof(response->data.err_msg), "drmModeGetFB2 failed, error: %s", strerror(errno)); + fprintf(stderr, "kms server error: %s\n", response->data.err_msg); + goto error; + } + + if(!drmfb->handles[0]) { + response->result = KMS_RESULT_FAILED_TO_GET_PLANE; + snprintf(response->data.err_msg, sizeof(response->data.err_msg), "drmfb handle is NULL"); + fprintf(stderr, "kms server error: %s\n", response->data.err_msg); + goto error; } - drmModeFreePlaneResources(planes); - close(drmfd); + // TODO: Check if dimensions have changed by comparing width and height to previous time this was called. + // TODO: Support other plane formats than rgb (with multiple planes, such as direct YUV420 on wayland). - if(response->data.fd.fd == 0) { - response->result = KMS_RESULT_NO_KMS_AVAILABLE; - snprintf(response->data.err_msg, sizeof(response->data.err_msg), "no kms found"); - return -1; + int fb_fd = -1; + const int ret = drmPrimeHandleToFD(drm->drmfd, drmfb->handles[0], O_RDONLY, &fb_fd); + if(ret != 0 || fb_fd == -1) { + response->result = KMS_RESULT_FAILED_TO_GET_PLANE; + snprintf(response->data.err_msg, sizeof(response->data.err_msg), "failed to get fd from drm handle, error: %s", strerror(errno)); + fprintf(stderr, "kms server error: %s\n", response->data.err_msg); + goto error; } - return 0; + response->data.fd.fd = fb_fd; + response->data.fd.width = drmfb->width; + response->data.fd.height = drmfb->height; + response->data.fd.pitch = drmfb->pitches[0]; + response->data.fd.offset = drmfb->offsets[0]; + response->data.fd.pixel_format = drmfb->pixel_format; + response->data.fd.modifier = drmfb->modifier; + result = 0; + + error: + if(drmfb) + drmModeFreeFB2(drmfb); + if(plane) + drmModeFreePlane(plane); + + return result; } int main(int argc, char **argv) { - if(argc != 2) { - fprintf(stderr, "usage: kms_server \n"); + if(argc != 3) { + fprintf(stderr, "usage: kms_server \n"); return 1; } @@ -160,7 +201,22 @@ int main(int argc, char **argv) { return 2; } - fprintf(stderr, "kms server info: connecting to the server\n"); + const char *card_path = argv[2]; + + gsr_drm drm; + drm.plane_id = 0; + drm.drmfd = open(card_path, O_RDONLY); + if(drm.drmfd < 0) { + fprintf(stderr, "kms server error: failed to open %s, error: %s", card_path, strerror(errno)); + return 2; + } + + if(kms_get_plane_id(&drm) != 0) { + close(drm.drmfd); + return 2; + } + + fprintf(stderr, "kms server info: connecting to the client\n"); for(;;) { struct sockaddr_un remote_addr = {0}; remote_addr.sun_family = AF_UNIX; @@ -171,11 +227,13 @@ int main(int argc, char **argv) { continue; // Host not ready yet? TODO: sleep if(errno == EISCONN) // TODO? break; + fprintf(stderr, "kms server error: connect failed, error: %s (%d)\n", strerror(errno), errno); + close(drm.drmfd); return 2; } } - fprintf(stderr, "kms server info: connected to the server\n"); + fprintf(stderr, "kms server info: connected to the client\n"); int res = 0; for(;;) { @@ -202,33 +260,27 @@ int main(int argc, char **argv) { } continue; } - request.data.card_path[254] = '\0'; switch(request.type) { case KMS_REQUEST_TYPE_GET_KMS: { gsr_kms_response response; - int kms_fd = 0; - if (get_kms(request.data.card_path, &response) == 0) { - kms_fd = response.data.fd.fd; - } - - if(send_msg_to_client(socket_fd, &response, &kms_fd, kms_fd == 0 ? 0 : 1) == -1) { - fprintf(stderr, "kms server error: failed to respond to client KMS_REQUEST_TYPE_GET_KMS request\n"); - if(kms_fd != 0) - close(kms_fd); - break; + + if(kms_get_fb(&drm, &response) == 0) { + if(send_msg_to_client(socket_fd, &response, &response.data.fd.fd, 1) == -1) + fprintf(stderr, "kms server error: failed to respond to client KMS_REQUEST_TYPE_GET_KMS request\n"); + close(response.data.fd.fd); + } else { + if(send_msg_to_client(socket_fd, &response, NULL, 0) == -1) + fprintf(stderr, "kms server error: failed to respond to client KMS_REQUEST_TYPE_GET_KMS request\n"); } - if(kms_fd != 0) - close(kms_fd); - break; } default: { gsr_kms_response response; response.result = KMS_RESULT_INVALID_REQUEST; snprintf(response.data.err_msg, sizeof(response.data.err_msg), "invalid request type %d, expected %d (%s)", request.type, KMS_REQUEST_TYPE_GET_KMS, "KMS_REQUEST_TYPE_GET_KMS"); - fprintf(stderr, "%s\n", response.data.err_msg); + fprintf(stderr, "kms server error: %s\n", response.data.err_msg); if(send_msg_to_client(socket_fd, &response, NULL, 0) == -1) { fprintf(stderr, "kms server error: failed to respond to client request\n"); break; @@ -239,6 +291,7 @@ int main(int argc, char **argv) { } done: + close(drm.drmfd); close(socket_fd); return res; } -- cgit v1.2.3