1 files changed, 91 insertions, 0 deletions
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;
+}