From 7cfe6e845878d67f578fa846e784c064a178d9c5 Mon Sep 17 00:00:00 2001 From: David Oberhollenzer Date: Thu, 28 Mar 2019 16:33:01 +0100 Subject: cleanup: move init specific stuff of init socket to initd Signed-off-by: David Oberhollenzer --- initd/initsock.c | 91 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 91 insertions(+) create mode 100644 initd/initsock.c (limited to 'initd/initsock.c') diff --git a/initd/initsock.c b/initd/initsock.c new file mode 100644 index 0000000..718ab61 --- /dev/null +++ b/initd/initsock.c @@ -0,0 +1,91 @@ +/* SPDX-License-Identifier: ISC */ +#include "init.h" + +static int send_retry(int fd, const void *dst, size_t addrlen, + const void *buffer, size_t size) +{ + ssize_t ret; +retry: + ret = sendto(fd, buffer, size, MSG_NOSIGNAL, dst, addrlen); + if (ret < 0 && errno == EINTR) + goto retry; + + if (ret < 0 || (size_t)ret < size) + return -1; + + return 0; +} + +static int send_string(int fd, const void *dst, size_t addrlen, + const char *str) +{ + size_t len = strlen(str); + uint8_t raw_len[2]; + + raw_len[0] = (len >> 8) & 0xFF; + raw_len[1] = len & 0xFF; + + if (send_retry(fd, dst, addrlen, raw_len, 2)) + return -1; + + return len > 0 ? send_retry(fd, dst, addrlen, str, len) : 0; +} + +int init_socket_create(void) +{ + struct sockaddr_un un; + int fd; + + fd = socket(AF_UNIX, SOCK_DGRAM | SOCK_CLOEXEC, 0); + if (fd < 0) { + perror("socket"); + return -1; + } + + memset(&un, 0, sizeof(un)); + un.sun_family = AF_UNIX; + + strcpy(un.sun_path, INIT_SOCK_PATH); + unlink(INIT_SOCK_PATH); + + if (bind(fd, (struct sockaddr *)&un, sizeof(un))) { + perror("bind: " INIT_SOCK_PATH); + close(fd); + unlink(INIT_SOCK_PATH); + return -1; + } + + return fd; +} + +int init_socket_send_status(int fd, const void *dest_addr, size_t addrlen, + E_SERVICE_STATE state, service_t *svc) +{ + uint8_t info[8]; + + if (svc == NULL || state == ESS_NONE) { + info[0] = ESS_NONE; + info[1] = 0; + info[2] = info[3] = 0; + info[4] = info[5] = info[6] = info[7] = 0xFF; + } else { + info[0] = state; + info[1] = svc->status & 0xFF; + info[2] = info[3] = 0; + info[4] = (svc->id >> 24) & 0xFF; + info[5] = (svc->id >> 16) & 0xFF; + info[6] = (svc->id >> 8) & 0xFF; + info[7] = svc->id & 0xFF; + } + + if (send_retry(fd, dest_addr, addrlen, info, sizeof(info))) + return -1; + + if (svc != NULL && state != ESS_NONE) { + if (send_string(fd, dest_addr, addrlen, svc->fname)) + return -1; + if (send_string(fd, dest_addr, addrlen, svc->name)) + return -1; + } + return 0; +} -- cgit v1.2.3