aboutsummaryrefslogtreecommitdiff
path: root/lib/init
diff options
context:
space:
mode:
Diffstat (limited to 'lib/init')
-rw-r--r--lib/init/init_socket_recv_status.c88
-rw-r--r--lib/init/init_socket_send_status.c65
2 files changed, 153 insertions, 0 deletions
diff --git a/lib/init/init_socket_recv_status.c b/lib/init/init_socket_recv_status.c
new file mode 100644
index 0000000..95126e2
--- /dev/null
+++ b/lib/init/init_socket_recv_status.c
@@ -0,0 +1,88 @@
+/* SPDX-License-Identifier: ISC */
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <stdint.h>
+#include <unistd.h>
+#include <stdlib.h>
+#include <string.h>
+#include <errno.h>
+
+#include "initsock.h"
+
+static int read_retry(int fd, void *buffer, size_t size)
+{
+ ssize_t ret;
+retry:
+ ret = read(fd, buffer, size);
+
+ if (ret < 0) {
+ if (errno == EINTR)
+ goto retry;
+ return -1;
+ }
+
+ if ((size_t)ret < size) {
+ errno = EPROTO;
+ return 0;
+ }
+
+ return 1;
+}
+
+static char *read_string(int fd)
+{
+ uint8_t size_raw[2];
+ char *buffer;
+ size_t len;
+ int ret;
+
+ ret = read_retry(fd, size_raw, 2);
+ if (ret <= 0)
+ return NULL;
+
+ len = (((size_t)size_raw[0]) << 8) | (size_t)size_raw[1];
+
+ buffer = malloc(len + 1);
+ if (buffer == NULL)
+ return NULL;
+
+ if (len > 0) {
+ ret = read_retry(fd, buffer, len);
+
+ if (ret <= 0) {
+ ret = errno;
+ free(buffer);
+ errno = ret;
+ return NULL;
+ }
+ }
+
+ buffer[len] = '\0';
+ return buffer;
+}
+
+int init_socket_recv_status(int fd, init_status_response_t *resp)
+{
+ uint8_t info[2];
+
+ memset(resp, 0, sizeof(*resp));
+
+ if (read_retry(fd, info, 2) <= 0)
+ return -1;
+
+ resp->state = info[0];
+ resp->exit_status = info[1];
+
+ if (resp->state == ESS_NONE)
+ return 0;
+
+ resp->filename = read_string(fd);
+ if (resp->filename == NULL)
+ return -1;
+
+ resp->service_name = read_string(fd);
+ if (resp->service_name == NULL)
+ return -1;
+
+ return 0;
+}
diff --git a/lib/init/init_socket_send_status.c b/lib/init/init_socket_send_status.c
new file mode 100644
index 0000000..ecad94c
--- /dev/null
+++ b/lib/init/init_socket_send_status.c
@@ -0,0 +1,65 @@
+/* SPDX-License-Identifier: ISC */
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <string.h>
+#include <errno.h>
+
+#include "initsock.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_send_status(int fd, const void *dest_addr, size_t addrlen,
+ E_SERVICE_STATE state, service_t *svc)
+{
+ uint8_t info[2];
+
+ if (svc == NULL || state == ESS_NONE) {
+ info[0] = ESS_NONE;
+ info[1] = 0;
+ } else {
+ info[0] = state;
+ info[1] = svc->status & 0xFF;
+ }
+
+ if (send_retry(fd, dest_addr, addrlen, info, 2))
+ 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;
+}