From cb82677ae8e7b3d5ef35a36b7c6d88020959864c Mon Sep 17 00:00:00 2001 From: dec05eba Date: Sun, 9 Apr 2023 15:54:29 +0200 Subject: Move kms client and server to separate directories --- build.sh | 4 +- include/kms/kms_client.h | 21 ---- include/kms/kms_shared.h | 45 --------- kms/client/kms_client.c | 245 +++++++++++++++++++++++++++++++++++++++++++++++ kms/client/kms_client.h | 21 ++++ kms/kms_shared.h | 45 +++++++++ kms/server/.gitignore | 1 + kms/server/kms_server.c | 244 ++++++++++++++++++++++++++++++++++++++++++++++ kms/server/project.conf | 8 ++ project.conf | 2 +- src/capture/kms_vaapi.c | 2 +- src/kms/kms_client.c | 245 ----------------------------------------------- src/kms/kms_server.c | 244 ---------------------------------------------- 13 files changed, 568 insertions(+), 559 deletions(-) delete mode 100644 include/kms/kms_client.h delete mode 100644 include/kms/kms_shared.h create mode 100644 kms/client/kms_client.c create mode 100644 kms/client/kms_client.h create mode 100644 kms/kms_shared.h create mode 100644 kms/server/.gitignore create mode 100644 kms/server/kms_server.c create mode 100644 kms/server/project.conf delete mode 100644 src/kms/kms_client.c delete mode 100644 src/kms/kms_server.c diff --git a/build.sh b/build.sh index 591728b..317340b 100755 --- a/build.sh +++ b/build.sh @@ -5,7 +5,7 @@ build_gsr_kms_server() { includes="$(pkg-config --cflags $dependencies)" libs="$(pkg-config --libs $dependencies) -ldl" opts="-O2 -g0 -DNDEBUG" - gcc -c src/kms/kms_server.c $opts $includes + gcc -c kms/server/kms_server.c $opts $includes gcc -o gsr-kms-server -O2 kms_server.o -s $libs } @@ -19,7 +19,7 @@ build_gsr() { gcc -c src/capture/xcomposite_cuda.c $opts $includes gcc -c src/capture/xcomposite_vaapi.c $opts $includes gcc -c src/capture/kms_vaapi.c $opts $includes - gcc -c src/kms/kms_client.c $opts $includes + gcc -c kms/client/kms_client.c $opts $includes gcc -c src/egl.c $opts $includes gcc -c src/cuda.c $opts $includes gcc -c src/xnvctrl.c $opts $includes diff --git a/include/kms/kms_client.h b/include/kms/kms_client.h deleted file mode 100644 index bb4325b..0000000 --- a/include/kms/kms_client.h +++ /dev/null @@ -1,21 +0,0 @@ -#ifndef GSR_KMS_CLIENT_H -#define GSR_KMS_CLIENT_H - -#include "kms_shared.h" -#include - -typedef struct { - pid_t kms_server_pid; - int socket_fd; - int client_fd; - char socket_path[27]; - char *card_path; -} gsr_kms_client; - -/* |card_path| should be a path to card, for example /dev/dri/card0 */ -int gsr_kms_client_init(gsr_kms_client *self, const char *card_path, const char *program_dir); -void gsr_kms_client_deinit(gsr_kms_client *self); - -int gsr_kms_client_get_kms(gsr_kms_client *self, gsr_kms_response *response); - -#endif /* #define GSR_KMS_CLIENT_H */ diff --git a/include/kms/kms_shared.h b/include/kms/kms_shared.h deleted file mode 100644 index f63c2f3..0000000 --- a/include/kms/kms_shared.h +++ /dev/null @@ -1,45 +0,0 @@ -#ifndef GSR_KMS_SHARED_H -#define GSR_KMS_SHARED_H - -#include - -typedef enum { - KMS_REQUEST_TYPE_GET_KMS -} gsr_kms_request_type; - -typedef enum { - KMS_RESULT_OK, - KMS_RESULT_INVALID_REQUEST, - KMS_RESULT_FAILED_TO_OPEN_CARD, - KMS_RESULT_INSUFFICIENT_PERMISSIONS, - KMS_RESULT_FAILED_TO_GET_KMS, - KMS_RESULT_NO_KMS_AVAILABLE, - KMS_RESULT_FAILED_TO_SEND -} gsr_kms_result; - -typedef struct { - int type; /* gsr_kms_request_type */ - union { - char card_path[255]; - } data; -} gsr_kms_request; - -typedef struct { - int fd; - uint32_t width; - uint32_t height; - uint32_t pitch; - uint32_t offset; - uint32_t pixel_format; - uint64_t modifier; -} gsr_kms_response_fd; - -typedef struct { - int result; /* gsr_kms_result */ - union { - char err_msg[128]; - gsr_kms_response_fd fd; - } data; -} gsr_kms_response; - -#endif /* #define GSR_KMS_SHARED_H */ diff --git a/kms/client/kms_client.c b/kms/client/kms_client.c new file mode 100644 index 0000000..2b59836 --- /dev/null +++ b/kms/client/kms_client.c @@ -0,0 +1,245 @@ +#include "kms_client.h" +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +static bool is_inside_flatpak(void) { + return getenv("FLATPAK_ID") != NULL; +} + +static int send_msg_to_server(int server_fd, gsr_kms_request *request) { + struct iovec iov; + iov.iov_base = request; + iov.iov_len = sizeof(*request); + + struct msghdr request_message = {0}; + request_message.msg_iov = &iov; + request_message.msg_iovlen = 1; + + return sendmsg(server_fd, &request_message, 0); +} + +static int recv_msg_from_server(int server_fd, gsr_kms_response *response) { + struct iovec iov; + iov.iov_base = response; + iov.iov_len = sizeof(*response); + + struct msghdr response_message = {0}; + response_message.msg_iov = &iov; + response_message.msg_iovlen = 1; + + char cmsgbuf[CMSG_SPACE(sizeof(int))]; + memset(cmsgbuf, 0, sizeof(cmsgbuf)); + response_message.msg_control = cmsgbuf; + response_message.msg_controllen = sizeof(cmsgbuf); + + int res = recvmsg(server_fd, &response_message, MSG_WAITALL); + if(res <= 0) + return res; + + if(response->result == KMS_RESULT_OK) + response->data.fd.fd = 0; + + struct cmsghdr *cmsg = CMSG_FIRSTHDR(&response_message); + if(cmsg) { + fprintf(stderr, "got cmsg, %d\n", cmsg->cmsg_type); + if(cmsg->cmsg_type == SCM_RIGHTS) { + int kms_fd = 0; + memcpy(&kms_fd, CMSG_DATA(cmsg), sizeof(int)); + fprintf(stderr, "kms fd: %d\n", kms_fd); + response->data.fd.fd = kms_fd; + } + } + + return res; +} + +int gsr_kms_client_init(gsr_kms_client *self, const char *card_path, const char *program_dir) { + self->kms_server_pid = -1; + self->card_path = NULL; + self->socket_fd = -1; + self->client_fd = -1; + self->socket_path[0] = '\0'; + struct sockaddr_un local_addr = {0}; + struct sockaddr_un remote_addr = {0}; + + bool inside_flatpak = is_inside_flatpak(); + char server_filepath[PATH_MAX]; + snprintf(server_filepath, sizeof(server_filepath), "%s/%s", program_dir, "gsr-kms-server"); + if(access(server_filepath, F_OK) != 0 || inside_flatpak) + snprintf(server_filepath, sizeof(server_filepath), "gsr-kms-server"); // Assume gsr-kms-server is in $PATH + + bool has_perm = 0; + if(geteuid() == 0) { + has_perm = true; + } else { + cap_t kms_server_cap = cap_get_file(server_filepath); + if(kms_server_cap) { + cap_flag_value_t res = 0; + cap_get_flag(kms_server_cap, CAP_SYS_ADMIN, CAP_PERMITTED, &res); + if(res == CAP_SET) { + //fprintf(stderr, "has permission!\n"); + has_perm = true; + } else { + //fprintf(stderr, "No permission:(\n"); + } + cap_free(kms_server_cap); + } else { + if(errno == ENODATA) + fprintf(stderr, "gsr info: gsr_kms_client_init: gsr-kms-server is missing sys_admin cap and will require root authentication. To bypass this automatically, run: sudo setcap cap_sys_admin+ep '%s'\n", server_filepath); + else + fprintf(stderr, "gsr info: gsr_kms_client_init: failed to get cap\n"); + } + } + + fprintf(stderr, "gsr info: gsr server path: %s, exists: %s\n", server_filepath, access(server_filepath, F_OK) == 0 ? "yes" : "no"); + + self->card_path = strdup(card_path); + if(!self->card_path) { + fprintf(stderr, "gsr error: gsr_kms_client_init: failed to duplicate card_path\n"); + goto err; + } + + strcpy(self->socket_path, "/tmp/gsr-kms-socket-XXXXXX"); + if(!tmpnam(self->socket_path)) { + fprintf(stderr, "gsr error: gsr_kms_client_init: mkstemp failed, error: %s\n", strerror(errno)); + goto err; + } + + self->socket_fd = socket(AF_UNIX, SOCK_STREAM, 0); + if(self->socket_fd == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_init: socket failed, error: %s\n", strerror(errno)); + goto err; + } + + local_addr.sun_family = AF_UNIX; + strncpy(local_addr.sun_path, self->socket_path, sizeof(local_addr.sun_path)); + if(bind(self->socket_fd, (struct sockaddr*)&local_addr, sizeof(local_addr.sun_family) + strlen(local_addr.sun_path)) == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_init: failed to bind socket, error: %s\n", strerror(errno)); + goto err; + } + + if(listen(self->socket_fd, 1) == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_init: failed to listen on socket, error: %s\n", strerror(errno)); + goto err; + } + + pid_t pid = fork(); + if(pid == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_init: fork failed, error: %s\n", strerror(errno)); + goto err; + } else if(pid == 0) { /* child */ + if(has_perm) { + const char *args[] = { server_filepath, self->socket_path, NULL }; + execvp(args[0], (char *const*)args); + } else if(inside_flatpak) { + const char *args[] = { "flatpak-spawn", "--host", "pkexec", server_filepath, self->socket_path, NULL }; + execvp(args[0], (char *const*)args); + } else { + const char *args[] = { "pkexec", server_filepath, self->socket_path, NULL }; + execvp(args[0], (char *const*)args); + } + perror("execvp"); + _exit(127); + } else { /* parent */ + self->kms_server_pid = pid; + } + + fprintf(stderr, "gsr info: gsr_kms_client_init: waiting for client to connect\n"); + for(;;) { + struct timeval tv; + fd_set rfds; + FD_ZERO(&rfds); + FD_SET(self->socket_fd, &rfds); + + tv.tv_sec = 0; + tv.tv_usec = 100 * 1000; // 100 ms + + int select_res = select(1 + self->socket_fd, &rfds, NULL, NULL, &tv); + if(select_res > 0) { + socklen_t sock_len = 0; + self->client_fd = accept(self->socket_fd, (struct sockaddr*)&remote_addr, &sock_len); + if(self->client_fd == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_init: accept failed on socket, error: %s\n", strerror(errno)); + goto err; + } + break; + } else { + int status; + int wait_result = waitpid(self->kms_server_pid, &status, WNOHANG); + if(wait_result != 0) { + fprintf(stderr, "gsr error: gsr_kms_client_init: kms server died or never started, error: %s\n", strerror(errno)); + goto err; + } + } + } + fprintf(stderr, "gsr info: gsr_kms_client_init: client connected\n"); + + return 0; + + err: + gsr_kms_client_deinit(self); + return -1; +} + +void gsr_kms_client_deinit(gsr_kms_client *self) { + if(self->card_path) { + free(self->card_path); + self->card_path = NULL; + } + + if(self->client_fd != -1) { + close(self->client_fd); + self->client_fd = -1; + } + + if(self->socket_fd != -1) { + close(self->socket_fd); + self->socket_fd = -1; + } + + if(self->kms_server_pid != -1) { + kill(self->kms_server_pid, SIGINT); + int status; + waitpid(self->kms_server_pid, &status, 0); + self->kms_server_pid = -1; + } + + if(self->socket_path[0] != '\0') { + remove(self->socket_path); + self->socket_path[0] = '\0'; + } +} + +int gsr_kms_client_get_kms(gsr_kms_client *self, gsr_kms_response *response) { + response->result = KMS_RESULT_FAILED_TO_SEND; + strcpy(response->data.err_msg, "failed to send"); + + gsr_kms_request request; + request.type = KMS_REQUEST_TYPE_GET_KMS; + strcpy(request.data.card_path, self->card_path); + if(send_msg_to_server(self->client_fd, &request) == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_get_kms: failed to send request message to server\n"); + return -1; + } + + const int recv_res = recv_msg_from_server(self->client_fd, response); + if(recv_res == 0) { + fprintf(stderr, "gsr warning: gsr_kms_client_get_kms: kms server shut down\n"); + return -1; + } else if(recv_res == -1) { + fprintf(stderr, "gsr error: gsr_kms_client_get_kms: failed to receive response\n"); + return -1; + } + + return 0; +} diff --git a/kms/client/kms_client.h b/kms/client/kms_client.h new file mode 100644 index 0000000..59d3cb3 --- /dev/null +++ b/kms/client/kms_client.h @@ -0,0 +1,21 @@ +#ifndef GSR_KMS_CLIENT_H +#define GSR_KMS_CLIENT_H + +#include "../kms_shared.h" +#include + +typedef struct { + pid_t kms_server_pid; + int socket_fd; + int client_fd; + char socket_path[27]; + char *card_path; +} gsr_kms_client; + +/* |card_path| should be a path to card, for example /dev/dri/card0 */ +int gsr_kms_client_init(gsr_kms_client *self, const char *card_path, const char *program_dir); +void gsr_kms_client_deinit(gsr_kms_client *self); + +int gsr_kms_client_get_kms(gsr_kms_client *self, gsr_kms_response *response); + +#endif /* #define GSR_KMS_CLIENT_H */ diff --git a/kms/kms_shared.h b/kms/kms_shared.h new file mode 100644 index 0000000..f63c2f3 --- /dev/null +++ b/kms/kms_shared.h @@ -0,0 +1,45 @@ +#ifndef GSR_KMS_SHARED_H +#define GSR_KMS_SHARED_H + +#include + +typedef enum { + KMS_REQUEST_TYPE_GET_KMS +} gsr_kms_request_type; + +typedef enum { + KMS_RESULT_OK, + KMS_RESULT_INVALID_REQUEST, + KMS_RESULT_FAILED_TO_OPEN_CARD, + KMS_RESULT_INSUFFICIENT_PERMISSIONS, + KMS_RESULT_FAILED_TO_GET_KMS, + KMS_RESULT_NO_KMS_AVAILABLE, + KMS_RESULT_FAILED_TO_SEND +} gsr_kms_result; + +typedef struct { + int type; /* gsr_kms_request_type */ + union { + char card_path[255]; + } data; +} gsr_kms_request; + +typedef struct { + int fd; + uint32_t width; + uint32_t height; + uint32_t pitch; + uint32_t offset; + uint32_t pixel_format; + uint64_t modifier; +} gsr_kms_response_fd; + +typedef struct { + int result; /* gsr_kms_result */ + union { + char err_msg[128]; + gsr_kms_response_fd fd; + } data; +} gsr_kms_response; + +#endif /* #define GSR_KMS_SHARED_H */ diff --git a/kms/server/.gitignore b/kms/server/.gitignore new file mode 100644 index 0000000..97420ef --- /dev/null +++ b/kms/server/.gitignore @@ -0,0 +1 @@ +sibs-build/ diff --git a/kms/server/kms_server.c b/kms/server/kms_server.c new file mode 100644 index 0000000..73cf9d0 --- /dev/null +++ b/kms/server/kms_server.c @@ -0,0 +1,244 @@ +#include "../kms_shared.h" + +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include +#include + +#define DRM_CLIENT_CAP_UNIVERSAL_PLANES 2 + +static int max_int(int a, int b) { + return a > b ? a : b; +} + +static int send_msg_to_client(int client_fd, gsr_kms_response *response, int *fds, int num_fds) { + struct iovec iov; + iov.iov_base = response; + iov.iov_len = sizeof(*response); + + struct msghdr response_message = {0}; + response_message.msg_iov = &iov; + response_message.msg_iovlen = 1; + + char cmsgbuf[CMSG_SPACE(sizeof(int)) * max_int(1, num_fds)]; + memset(cmsgbuf, 0, sizeof(cmsgbuf)); + + if(num_fds > 0) { + response_message.msg_control = cmsgbuf; + response_message.msg_controllen = sizeof(cmsgbuf); + + int total_msg_len = 0; + struct cmsghdr *cmsg = NULL; + for(int i = 0; i < num_fds; ++i) { + if(i == 0) + cmsg = CMSG_FIRSTHDR(&response_message); + else + cmsg = CMSG_NXTHDR(&response_message, cmsg); + + cmsg->cmsg_level = SOL_SOCKET; + cmsg->cmsg_type = SCM_RIGHTS; + cmsg->cmsg_len = CMSG_LEN(sizeof(int)); + memcpy(CMSG_DATA(cmsg), &fds[i], sizeof(int)); + total_msg_len += cmsg->cmsg_len; + } + + response_message.msg_controllen = total_msg_len; + } + + 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; + } + + 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; + } + + 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; + } + + 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); + 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); + } + + plane_continue: + drmModeFreePlane(plane); + } + + drmModeFreePlaneResources(planes); + close(drmfd); + + 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; + } + + return 0; +} + +int main(int argc, char **argv) { + if(argc != 2) { + fprintf(stderr, "usage: kms_server \n"); + return 1; + } + + const char *domain_socket_path = argv[1]; + int socket_fd = socket(AF_UNIX, SOCK_STREAM, 0); + if(socket_fd == -1) { + fprintf(stderr, "kms server error: failed to create socket, error: %s\n", strerror(errno)); + return 2; + } + + fprintf(stderr, "kms server info: connecting to the server\n"); + for(;;) { + struct sockaddr_un remote_addr = {0}; + remote_addr.sun_family = AF_UNIX; + strncpy(remote_addr.sun_path, domain_socket_path, sizeof(remote_addr.sun_path)); + // TODO: Check if parent disconnected + if(connect(socket_fd, (struct sockaddr*)&remote_addr, sizeof(remote_addr.sun_family) + strlen(remote_addr.sun_path)) == -1) { + if(errno == ECONNREFUSED || errno == ENOENT) + 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); + return 2; + } + } + fprintf(stderr, "kms server info: connected to the server\n"); + + int res = 0; + for(;;) { + gsr_kms_request request; + struct iovec iov; + iov.iov_base = &request; + iov.iov_len = sizeof(request); + + struct msghdr request_message = {0}; + request_message.msg_iov = &iov; + request_message.msg_iovlen = 1; + const int recv_res = recvmsg(socket_fd, &request_message, MSG_WAITALL); + if(recv_res == 0) { + fprintf(stderr, "kms server info: kms client shutdown, shutting down the server\n"); + res = 3; + goto done; + } else if(recv_res == -1) { + const int err = errno; + fprintf(stderr, "kms server error: failed to read all data in client request (error: %s), ignoring\n", strerror(err)); + if(err == EBADF) { + fprintf(stderr, "kms server error: invalid client fd, shutting down the server\n"); + res = 3; + goto done; + } + 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_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); + if(send_msg_to_client(socket_fd, &response, NULL, 0) == -1) { + fprintf(stderr, "kms server error: failed to respond to client request\n"); + break; + } + break; + } + } + } + + done: + close(socket_fd); + return res; +} diff --git a/kms/server/project.conf b/kms/server/project.conf new file mode 100644 index 0000000..cf863c1 --- /dev/null +++ b/kms/server/project.conf @@ -0,0 +1,8 @@ +[package] +name = "gsr-kms-server" +type = "executable" +version = "1.0.0" +platforms = ["posix"] + +[dependencies] +libdrm = ">=2" diff --git a/project.conf b/project.conf index 3e39072..231ca5d 100644 --- a/project.conf +++ b/project.conf @@ -5,7 +5,7 @@ version = "2.0.0" platforms = ["posix"] [config] -ignore_dirs = ["src/kms"] +ignore_dirs = ["kms/server"] [dependencies] libavcodec = ">=58" diff --git a/src/capture/kms_vaapi.c b/src/capture/kms_vaapi.c index 7e42011..2e970a3 100644 --- a/src/capture/kms_vaapi.c +++ b/src/capture/kms_vaapi.c @@ -1,5 +1,5 @@ #include "../../include/capture/kms_vaapi.h" -#include "../../include/kms/kms_client.h" +#include "../../kms/client/kms_client.h" #include "../../include/egl.h" #include "../../include/utils.h" #include diff --git a/src/kms/kms_client.c b/src/kms/kms_client.c deleted file mode 100644 index cddd8ff..0000000 --- a/src/kms/kms_client.c +++ /dev/null @@ -1,245 +0,0 @@ -#include "../../include/kms/kms_client.h" -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -static bool is_inside_flatpak(void) { - return getenv("FLATPAK_ID") != NULL; -} - -static int send_msg_to_server(int server_fd, gsr_kms_request *request) { - struct iovec iov; - iov.iov_base = request; - iov.iov_len = sizeof(*request); - - struct msghdr request_message = {0}; - request_message.msg_iov = &iov; - request_message.msg_iovlen = 1; - - return sendmsg(server_fd, &request_message, 0); -} - -static int recv_msg_from_server(int server_fd, gsr_kms_response *response) { - struct iovec iov; - iov.iov_base = response; - iov.iov_len = sizeof(*response); - - struct msghdr response_message = {0}; - response_message.msg_iov = &iov; - response_message.msg_iovlen = 1; - - char cmsgbuf[CMSG_SPACE(sizeof(int))]; - memset(cmsgbuf, 0, sizeof(cmsgbuf)); - response_message.msg_control = cmsgbuf; - response_message.msg_controllen = sizeof(cmsgbuf); - - int res = recvmsg(server_fd, &response_message, MSG_WAITALL); - if(res <= 0) - return res; - - if(response->result == KMS_RESULT_OK) - response->data.fd.fd = 0; - - struct cmsghdr *cmsg = CMSG_FIRSTHDR(&response_message); - if(cmsg) { - fprintf(stderr, "got cmsg, %d\n", cmsg->cmsg_type); - if(cmsg->cmsg_type == SCM_RIGHTS) { - int kms_fd = 0; - memcpy(&kms_fd, CMSG_DATA(cmsg), sizeof(int)); - fprintf(stderr, "kms fd: %d\n", kms_fd); - response->data.fd.fd = kms_fd; - } - } - - return res; -} - -int gsr_kms_client_init(gsr_kms_client *self, const char *card_path, const char *program_dir) { - self->kms_server_pid = -1; - self->card_path = NULL; - self->socket_fd = -1; - self->client_fd = -1; - self->socket_path[0] = '\0'; - struct sockaddr_un local_addr = {0}; - struct sockaddr_un remote_addr = {0}; - - bool inside_flatpak = is_inside_flatpak(); - char server_filepath[PATH_MAX]; - snprintf(server_filepath, sizeof(server_filepath), "%s/%s", program_dir, "gsr-kms-server"); - if(access(server_filepath, F_OK) != 0 || inside_flatpak) - snprintf(server_filepath, sizeof(server_filepath), "gsr-kms-server"); // Assume gsr-kms-server is in $PATH - - bool has_perm = 0; - if(geteuid() == 0) { - has_perm = true; - } else { - cap_t kms_server_cap = cap_get_file(server_filepath); - if(kms_server_cap) { - cap_flag_value_t res = 0; - cap_get_flag(kms_server_cap, CAP_SYS_ADMIN, CAP_PERMITTED, &res); - if(res == CAP_SET) { - //fprintf(stderr, "has permission!\n"); - has_perm = true; - } else { - //fprintf(stderr, "No permission:(\n"); - } - cap_free(kms_server_cap); - } else { - if(errno == ENODATA) - fprintf(stderr, "gsr info: gsr_kms_client_init: gsr-kms-server is missing sys_admin cap and will require root authentication. To bypass this automatically, run: sudo setcap cap_sys_admin+ep '%s'\n", server_filepath); - else - fprintf(stderr, "gsr info: gsr_kms_client_init: failed to get cap\n"); - } - } - - fprintf(stderr, "gsr info: gsr server path: %s, exists: %s\n", server_filepath, access(server_filepath, F_OK) == 0 ? "yes" : "no"); - - self->card_path = strdup(card_path); - if(!self->card_path) { - fprintf(stderr, "gsr error: gsr_kms_client_init: failed to duplicate card_path\n"); - goto err; - } - - strcpy(self->socket_path, "/tmp/gsr-kms-socket-XXXXXX"); - if(!tmpnam(self->socket_path)) { - fprintf(stderr, "gsr error: gsr_kms_client_init: mkstemp failed, error: %s\n", strerror(errno)); - goto err; - } - - self->socket_fd = socket(AF_UNIX, SOCK_STREAM, 0); - if(self->socket_fd == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_init: socket failed, error: %s\n", strerror(errno)); - goto err; - } - - local_addr.sun_family = AF_UNIX; - strncpy(local_addr.sun_path, self->socket_path, sizeof(local_addr.sun_path)); - if(bind(self->socket_fd, (struct sockaddr*)&local_addr, sizeof(local_addr.sun_family) + strlen(local_addr.sun_path)) == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_init: failed to bind socket, error: %s\n", strerror(errno)); - goto err; - } - - if(listen(self->socket_fd, 1) == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_init: failed to listen on socket, error: %s\n", strerror(errno)); - goto err; - } - - pid_t pid = fork(); - if(pid == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_init: fork failed, error: %s\n", strerror(errno)); - goto err; - } else if(pid == 0) { /* child */ - if(has_perm) { - const char *args[] = { server_filepath, self->socket_path, NULL }; - execvp(args[0], (char *const*)args); - } else if(inside_flatpak) { - const char *args[] = { "flatpak-spawn", "--host", "pkexec", server_filepath, self->socket_path, NULL }; - execvp(args[0], (char *const*)args); - } else { - const char *args[] = { "pkexec", server_filepath, self->socket_path, NULL }; - execvp(args[0], (char *const*)args); - } - perror("execvp"); - _exit(127); - } else { /* parent */ - self->kms_server_pid = pid; - } - - fprintf(stderr, "gsr info: gsr_kms_client_init: waiting for client to connect\n"); - for(;;) { - struct timeval tv; - fd_set rfds; - FD_ZERO(&rfds); - FD_SET(self->socket_fd, &rfds); - - tv.tv_sec = 0; - tv.tv_usec = 100 * 1000; // 100 ms - - int select_res = select(1 + self->socket_fd, &rfds, NULL, NULL, &tv); - if(select_res > 0) { - socklen_t sock_len = 0; - self->client_fd = accept(self->socket_fd, (struct sockaddr*)&remote_addr, &sock_len); - if(self->client_fd == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_init: accept failed on socket, error: %s\n", strerror(errno)); - goto err; - } - break; - } else { - int status; - int wait_result = waitpid(self->kms_server_pid, &status, WNOHANG); - if(wait_result != 0) { - fprintf(stderr, "gsr error: gsr_kms_client_init: kms server died or never started, error: %s\n", strerror(errno)); - goto err; - } - } - } - fprintf(stderr, "gsr info: gsr_kms_client_init: client connected\n"); - - return 0; - - err: - gsr_kms_client_deinit(self); - return -1; -} - -void gsr_kms_client_deinit(gsr_kms_client *self) { - if(self->card_path) { - free(self->card_path); - self->card_path = NULL; - } - - if(self->client_fd != -1) { - close(self->client_fd); - self->client_fd = -1; - } - - if(self->socket_fd != -1) { - close(self->socket_fd); - self->socket_fd = -1; - } - - if(self->kms_server_pid != -1) { - kill(self->kms_server_pid, SIGINT); - int status; - waitpid(self->kms_server_pid, &status, 0); - self->kms_server_pid = -1; - } - - if(self->socket_path[0] != '\0') { - remove(self->socket_path); - self->socket_path[0] = '\0'; - } -} - -int gsr_kms_client_get_kms(gsr_kms_client *self, gsr_kms_response *response) { - response->result = KMS_RESULT_FAILED_TO_SEND; - strcpy(response->data.err_msg, "failed to send"); - - gsr_kms_request request; - request.type = KMS_REQUEST_TYPE_GET_KMS; - strcpy(request.data.card_path, self->card_path); - if(send_msg_to_server(self->client_fd, &request) == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_get_kms: failed to send request message to server\n"); - return -1; - } - - const int recv_res = recv_msg_from_server(self->client_fd, response); - if(recv_res == 0) { - fprintf(stderr, "gsr warning: gsr_kms_client_get_kms: kms server shut down\n"); - return -1; - } else if(recv_res == -1) { - fprintf(stderr, "gsr error: gsr_kms_client_get_kms: failed to receive response\n"); - return -1; - } - - return 0; -} diff --git a/src/kms/kms_server.c b/src/kms/kms_server.c deleted file mode 100644 index e7ee02f..0000000 --- a/src/kms/kms_server.c +++ /dev/null @@ -1,244 +0,0 @@ -#include "../../include/kms/kms_shared.h" - -#include -#include -#include -#include -#include - -#include -#include -#include -#include - -#include -#include - -#define DRM_CLIENT_CAP_UNIVERSAL_PLANES 2 - -static int max_int(int a, int b) { - return a > b ? a : b; -} - -static int send_msg_to_client(int client_fd, gsr_kms_response *response, int *fds, int num_fds) { - struct iovec iov; - iov.iov_base = response; - iov.iov_len = sizeof(*response); - - struct msghdr response_message = {0}; - response_message.msg_iov = &iov; - response_message.msg_iovlen = 1; - - char cmsgbuf[CMSG_SPACE(sizeof(int)) * max_int(1, num_fds)]; - memset(cmsgbuf, 0, sizeof(cmsgbuf)); - - if(num_fds > 0) { - response_message.msg_control = cmsgbuf; - response_message.msg_controllen = sizeof(cmsgbuf); - - int total_msg_len = 0; - struct cmsghdr *cmsg = NULL; - for(int i = 0; i < num_fds; ++i) { - if(i == 0) - cmsg = CMSG_FIRSTHDR(&response_message); - else - cmsg = CMSG_NXTHDR(&response_message, cmsg); - - cmsg->cmsg_level = SOL_SOCKET; - cmsg->cmsg_type = SCM_RIGHTS; - cmsg->cmsg_len = CMSG_LEN(sizeof(int)); - memcpy(CMSG_DATA(cmsg), &fds[i], sizeof(int)); - total_msg_len += cmsg->cmsg_len; - } - - response_message.msg_controllen = total_msg_len; - } - - 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; - } - - 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; - } - - 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; - } - - 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); - 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); - } - - plane_continue: - drmModeFreePlane(plane); - } - - drmModeFreePlaneResources(planes); - close(drmfd); - - 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; - } - - return 0; -} - -int main(int argc, char **argv) { - if(argc != 2) { - fprintf(stderr, "usage: kms_server \n"); - return 1; - } - - const char *domain_socket_path = argv[1]; - int socket_fd = socket(AF_UNIX, SOCK_STREAM, 0); - if(socket_fd == -1) { - fprintf(stderr, "kms server error: failed to create socket, error: %s\n", strerror(errno)); - return 2; - } - - fprintf(stderr, "kms server info: connecting to the server\n"); - for(;;) { - struct sockaddr_un remote_addr = {0}; - remote_addr.sun_family = AF_UNIX; - strncpy(remote_addr.sun_path, domain_socket_path, sizeof(remote_addr.sun_path)); - // TODO: Check if parent disconnected - if(connect(socket_fd, (struct sockaddr*)&remote_addr, sizeof(remote_addr.sun_family) + strlen(remote_addr.sun_path)) == -1) { - if(errno == ECONNREFUSED || errno == ENOENT) - 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); - return 2; - } - } - fprintf(stderr, "kms server info: connected to the server\n"); - - int res = 0; - for(;;) { - gsr_kms_request request; - struct iovec iov; - iov.iov_base = &request; - iov.iov_len = sizeof(request); - - struct msghdr request_message = {0}; - request_message.msg_iov = &iov; - request_message.msg_iovlen = 1; - const int recv_res = recvmsg(socket_fd, &request_message, MSG_WAITALL); - if(recv_res == 0) { - fprintf(stderr, "kms server info: kms client shutdown, shutting down the server\n"); - res = 3; - goto done; - } else if(recv_res == -1) { - const int err = errno; - fprintf(stderr, "kms server error: failed to read all data in client request (error: %s), ignoring\n", strerror(err)); - if(err == EBADF) { - fprintf(stderr, "kms server error: invalid client fd, shutting down the server\n"); - res = 3; - goto done; - } - 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_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); - if(send_msg_to_client(socket_fd, &response, NULL, 0) == -1) { - fprintf(stderr, "kms server error: failed to respond to client request\n"); - break; - } - break; - } - } - } - - done: - close(socket_fd); - return res; -} -- cgit v1.2.3