aboutsummaryrefslogtreecommitdiff
path: root/lib/init/init_socket_recv_status.c
blob: b812819068a76f880a12bf8439d23893a492cf01 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
/* 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[8];

	memset(resp, 0, sizeof(*resp));

	if (read_retry(fd, info, sizeof(info)) <= 0)
		return -1;

	resp->state = info[0];
	resp->exit_status = info[1];

	resp->id = ((int)info[4] << 24) | ((int)info[5] << 16) |
		((int)info[6] << 8) | (int)info[7];

	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;
}