1 ef16f8f6 2023-07-02 op /*	$OpenBSD: imsg-buffer.c,v 1.16 2023/06/19 17:19:50 claudio Exp $	*/
  2 b0003f58 2021-03-08 op 
  3 b0003f58 2021-03-08 op /*
  4 b0003f58 2021-03-08 op  * Copyright (c) 2003, 2004 Henning Brauer <henning@openbsd.org>
  5 b0003f58 2021-03-08 op  *
  6 b0003f58 2021-03-08 op  * Permission to use, copy, modify, and distribute this software for any
  7 b0003f58 2021-03-08 op  * purpose with or without fee is hereby granted, provided that the above
  8 b0003f58 2021-03-08 op  * copyright notice and this permission notice appear in all copies.
  9 b0003f58 2021-03-08 op  *
 10 b0003f58 2021-03-08 op  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 11 b0003f58 2021-03-08 op  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 12 b0003f58 2021-03-08 op  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 13 b0003f58 2021-03-08 op  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 14 b0003f58 2021-03-08 op  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 15 b0003f58 2021-03-08 op  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 16 b0003f58 2021-03-08 op  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 17 b0003f58 2021-03-08 op  */
 18 a625907c 2021-03-19 op 
 19 a625907c 2021-03-19 op #include "compat.h"
 20 b0003f58 2021-03-08 op 
 21 b0003f58 2021-03-08 op #include <sys/types.h>
 22 b0003f58 2021-03-08 op #include <sys/socket.h>
 23 b0003f58 2021-03-08 op #include <sys/uio.h>
 24 b0003f58 2021-03-08 op 
 25 b0003f58 2021-03-08 op #include <limits.h>
 26 b0003f58 2021-03-08 op #include <errno.h>
 27 b0003f58 2021-03-08 op #include <stdlib.h>
 28 b0003f58 2021-03-08 op #include <string.h>
 29 b0003f58 2021-03-08 op #include <unistd.h>
 30 b0003f58 2021-03-08 op 
 31 b0003f58 2021-03-08 op #include "imsg.h"
 32 b0003f58 2021-03-08 op 
 33 b0003f58 2021-03-08 op static int	ibuf_realloc(struct ibuf *, size_t);
 34 b0003f58 2021-03-08 op static void	ibuf_enqueue(struct msgbuf *, struct ibuf *);
 35 b0003f58 2021-03-08 op static void	ibuf_dequeue(struct msgbuf *, struct ibuf *);
 36 ef16f8f6 2023-07-02 op static void	msgbuf_drain(struct msgbuf *, size_t);
 37 b0003f58 2021-03-08 op 
 38 b0003f58 2021-03-08 op struct ibuf *
 39 b0003f58 2021-03-08 op ibuf_open(size_t len)
 40 b0003f58 2021-03-08 op {
 41 b0003f58 2021-03-08 op 	struct ibuf	*buf;
 42 b0003f58 2021-03-08 op 
 43 ef16f8f6 2023-07-02 op 	if (len == 0) {
 44 ef16f8f6 2023-07-02 op 		errno = EINVAL;
 45 ef16f8f6 2023-07-02 op 		return (NULL);
 46 ef16f8f6 2023-07-02 op 	}
 47 b0003f58 2021-03-08 op 	if ((buf = calloc(1, sizeof(struct ibuf))) == NULL)
 48 b0003f58 2021-03-08 op 		return (NULL);
 49 ef16f8f6 2023-07-02 op 	if ((buf->buf = calloc(len, 1)) == NULL) {
 50 b0003f58 2021-03-08 op 		free(buf);
 51 b0003f58 2021-03-08 op 		return (NULL);
 52 b0003f58 2021-03-08 op 	}
 53 b0003f58 2021-03-08 op 	buf->size = buf->max = len;
 54 b0003f58 2021-03-08 op 	buf->fd = -1;
 55 b0003f58 2021-03-08 op 
 56 b0003f58 2021-03-08 op 	return (buf);
 57 b0003f58 2021-03-08 op }
 58 b0003f58 2021-03-08 op 
 59 b0003f58 2021-03-08 op struct ibuf *
 60 b0003f58 2021-03-08 op ibuf_dynamic(size_t len, size_t max)
 61 b0003f58 2021-03-08 op {
 62 b0003f58 2021-03-08 op 	struct ibuf	*buf;
 63 b0003f58 2021-03-08 op 
 64 ef16f8f6 2023-07-02 op 	if (max < len) {
 65 ef16f8f6 2023-07-02 op 		errno = EINVAL;
 66 b0003f58 2021-03-08 op 		return (NULL);
 67 ef16f8f6 2023-07-02 op 	}
 68 b0003f58 2021-03-08 op 
 69 ef16f8f6 2023-07-02 op 	if ((buf = calloc(1, sizeof(struct ibuf))) == NULL)
 70 b0003f58 2021-03-08 op 		return (NULL);
 71 ef16f8f6 2023-07-02 op 	if (len > 0) {
 72 ef16f8f6 2023-07-02 op 		if ((buf->buf = calloc(len, 1)) == NULL) {
 73 ef16f8f6 2023-07-02 op 			free(buf);
 74 ef16f8f6 2023-07-02 op 			return (NULL);
 75 ef16f8f6 2023-07-02 op 		}
 76 ef16f8f6 2023-07-02 op 	}
 77 ef16f8f6 2023-07-02 op 	buf->size = len;
 78 ef16f8f6 2023-07-02 op 	buf->max = max;
 79 ef16f8f6 2023-07-02 op 	buf->fd = -1;
 80 b0003f58 2021-03-08 op 
 81 b0003f58 2021-03-08 op 	return (buf);
 82 b0003f58 2021-03-08 op }
 83 b0003f58 2021-03-08 op 
 84 b0003f58 2021-03-08 op static int
 85 b0003f58 2021-03-08 op ibuf_realloc(struct ibuf *buf, size_t len)
 86 b0003f58 2021-03-08 op {
 87 b0003f58 2021-03-08 op 	unsigned char	*b;
 88 b0003f58 2021-03-08 op 
 89 b0003f58 2021-03-08 op 	/* on static buffers max is eq size and so the following fails */
 90 ef16f8f6 2023-07-02 op 	if (len > SIZE_MAX - buf->wpos || buf->wpos + len > buf->max) {
 91 b0003f58 2021-03-08 op 		errno = ERANGE;
 92 b0003f58 2021-03-08 op 		return (-1);
 93 b0003f58 2021-03-08 op 	}
 94 b0003f58 2021-03-08 op 
 95 b0003f58 2021-03-08 op 	b = recallocarray(buf->buf, buf->size, buf->wpos + len, 1);
 96 b0003f58 2021-03-08 op 	if (b == NULL)
 97 b0003f58 2021-03-08 op 		return (-1);
 98 b0003f58 2021-03-08 op 	buf->buf = b;
 99 b0003f58 2021-03-08 op 	buf->size = buf->wpos + len;
100 b0003f58 2021-03-08 op 
101 b0003f58 2021-03-08 op 	return (0);
102 b0003f58 2021-03-08 op }
103 b0003f58 2021-03-08 op 
104 b0003f58 2021-03-08 op void *
105 b0003f58 2021-03-08 op ibuf_reserve(struct ibuf *buf, size_t len)
106 b0003f58 2021-03-08 op {
107 b0003f58 2021-03-08 op 	void	*b;
108 b0003f58 2021-03-08 op 
109 ef16f8f6 2023-07-02 op 	if (len > SIZE_MAX - buf->wpos) {
110 ef16f8f6 2023-07-02 op 		errno = ERANGE;
111 ef16f8f6 2023-07-02 op 		return (NULL);
112 ef16f8f6 2023-07-02 op 	}
113 ef16f8f6 2023-07-02 op 
114 b0003f58 2021-03-08 op 	if (buf->wpos + len > buf->size)
115 b0003f58 2021-03-08 op 		if (ibuf_realloc(buf, len) == -1)
116 b0003f58 2021-03-08 op 			return (NULL);
117 b0003f58 2021-03-08 op 
118 b0003f58 2021-03-08 op 	b = buf->buf + buf->wpos;
119 b0003f58 2021-03-08 op 	buf->wpos += len;
120 ef16f8f6 2023-07-02 op 	memset(b, 0, len);
121 b0003f58 2021-03-08 op 	return (b);
122 b0003f58 2021-03-08 op }
123 b0003f58 2021-03-08 op 
124 ef16f8f6 2023-07-02 op int
125 ef16f8f6 2023-07-02 op ibuf_add(struct ibuf *buf, const void *data, size_t len)
126 ef16f8f6 2023-07-02 op {
127 ef16f8f6 2023-07-02 op 	void *b;
128 ef16f8f6 2023-07-02 op 
129 ef16f8f6 2023-07-02 op 	if ((b = ibuf_reserve(buf, len)) == NULL)
130 ef16f8f6 2023-07-02 op 		return (-1);
131 ef16f8f6 2023-07-02 op 
132 ef16f8f6 2023-07-02 op 	memcpy(b, data, len);
133 ef16f8f6 2023-07-02 op 	return (0);
134 ef16f8f6 2023-07-02 op }
135 ef16f8f6 2023-07-02 op 
136 ef16f8f6 2023-07-02 op int
137 ef16f8f6 2023-07-02 op ibuf_add_buf(struct ibuf *buf, const struct ibuf *from)
138 ef16f8f6 2023-07-02 op {
139 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, from->buf, from->wpos);
140 ef16f8f6 2023-07-02 op }
141 ef16f8f6 2023-07-02 op 
142 ef16f8f6 2023-07-02 op int
143 ef16f8f6 2023-07-02 op ibuf_add_n8(struct ibuf *buf, uint64_t value)
144 ef16f8f6 2023-07-02 op {
145 ef16f8f6 2023-07-02 op 	uint8_t v;
146 ef16f8f6 2023-07-02 op 
147 ef16f8f6 2023-07-02 op 	if (value > UINT8_MAX) {
148 ef16f8f6 2023-07-02 op 		errno = EINVAL;
149 ef16f8f6 2023-07-02 op 		return (-1);
150 ef16f8f6 2023-07-02 op 	}
151 ef16f8f6 2023-07-02 op 	v = value;
152 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
153 ef16f8f6 2023-07-02 op }
154 ef16f8f6 2023-07-02 op 
155 ef16f8f6 2023-07-02 op int
156 ef16f8f6 2023-07-02 op ibuf_add_n16(struct ibuf *buf, uint64_t value)
157 ef16f8f6 2023-07-02 op {
158 ef16f8f6 2023-07-02 op 	uint16_t v;
159 ef16f8f6 2023-07-02 op 
160 ef16f8f6 2023-07-02 op 	if (value > UINT16_MAX) {
161 ef16f8f6 2023-07-02 op 		errno = EINVAL;
162 ef16f8f6 2023-07-02 op 		return (-1);
163 ef16f8f6 2023-07-02 op 	}
164 ef16f8f6 2023-07-02 op 	v = htobe16(value);
165 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
166 ef16f8f6 2023-07-02 op }
167 ef16f8f6 2023-07-02 op 
168 ef16f8f6 2023-07-02 op int
169 ef16f8f6 2023-07-02 op ibuf_add_n32(struct ibuf *buf, uint64_t value)
170 ef16f8f6 2023-07-02 op {
171 ef16f8f6 2023-07-02 op 	uint32_t v;
172 ef16f8f6 2023-07-02 op 
173 ef16f8f6 2023-07-02 op 	if (value > UINT32_MAX) {
174 ef16f8f6 2023-07-02 op 		errno = EINVAL;
175 ef16f8f6 2023-07-02 op 		return (-1);
176 ef16f8f6 2023-07-02 op 	}
177 ef16f8f6 2023-07-02 op 	v = htobe32(value);
178 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
179 ef16f8f6 2023-07-02 op }
180 ef16f8f6 2023-07-02 op 
181 ef16f8f6 2023-07-02 op int
182 ef16f8f6 2023-07-02 op ibuf_add_n64(struct ibuf *buf, uint64_t value)
183 ef16f8f6 2023-07-02 op {
184 ef16f8f6 2023-07-02 op 	value = htobe64(value);
185 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &value, sizeof(value));
186 ef16f8f6 2023-07-02 op }
187 ef16f8f6 2023-07-02 op 
188 ef16f8f6 2023-07-02 op int
189 ef16f8f6 2023-07-02 op ibuf_add_zero(struct ibuf *buf, size_t len)
190 ef16f8f6 2023-07-02 op {
191 ef16f8f6 2023-07-02 op 	void *b;
192 ef16f8f6 2023-07-02 op 
193 ef16f8f6 2023-07-02 op 	if ((b = ibuf_reserve(buf, len)) == NULL)
194 ef16f8f6 2023-07-02 op 		return (-1);
195 ef16f8f6 2023-07-02 op 	return (0);
196 ef16f8f6 2023-07-02 op }
197 ef16f8f6 2023-07-02 op 
198 b0003f58 2021-03-08 op void *
199 b0003f58 2021-03-08 op ibuf_seek(struct ibuf *buf, size_t pos, size_t len)
200 b0003f58 2021-03-08 op {
201 b0003f58 2021-03-08 op 	/* only allowed to seek in already written parts */
202 ef16f8f6 2023-07-02 op 	if (len > SIZE_MAX - pos || pos + len > buf->wpos) {
203 ef16f8f6 2023-07-02 op 		errno = ERANGE;
204 b0003f58 2021-03-08 op 		return (NULL);
205 ef16f8f6 2023-07-02 op 	}
206 b0003f58 2021-03-08 op 
207 b0003f58 2021-03-08 op 	return (buf->buf + pos);
208 b0003f58 2021-03-08 op }
209 b0003f58 2021-03-08 op 
210 ef16f8f6 2023-07-02 op int
211 ef16f8f6 2023-07-02 op ibuf_set(struct ibuf *buf, size_t pos, const void *data, size_t len)
212 ef16f8f6 2023-07-02 op {
213 ef16f8f6 2023-07-02 op 	void *b;
214 ef16f8f6 2023-07-02 op 
215 ef16f8f6 2023-07-02 op 	if ((b = ibuf_seek(buf, pos, len)) == NULL)
216 ef16f8f6 2023-07-02 op 		return (-1);
217 ef16f8f6 2023-07-02 op 
218 ef16f8f6 2023-07-02 op 	memcpy(b, data, len);
219 ef16f8f6 2023-07-02 op 	return (0);
220 ef16f8f6 2023-07-02 op }
221 ef16f8f6 2023-07-02 op 
222 ef16f8f6 2023-07-02 op int
223 ef16f8f6 2023-07-02 op ibuf_set_n8(struct ibuf *buf, size_t pos, uint64_t value)
224 ef16f8f6 2023-07-02 op {
225 ef16f8f6 2023-07-02 op 	uint8_t v;
226 ef16f8f6 2023-07-02 op 
227 ef16f8f6 2023-07-02 op 	if (value > UINT8_MAX) {
228 ef16f8f6 2023-07-02 op 		errno = EINVAL;
229 ef16f8f6 2023-07-02 op 		return (-1);
230 ef16f8f6 2023-07-02 op 	}
231 ef16f8f6 2023-07-02 op 	v = value;
232 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
233 ef16f8f6 2023-07-02 op }
234 ef16f8f6 2023-07-02 op 
235 ef16f8f6 2023-07-02 op int
236 ef16f8f6 2023-07-02 op ibuf_set_n16(struct ibuf *buf, size_t pos, uint64_t value)
237 ef16f8f6 2023-07-02 op {
238 ef16f8f6 2023-07-02 op 	uint16_t v;
239 ef16f8f6 2023-07-02 op 
240 ef16f8f6 2023-07-02 op 	if (value > UINT16_MAX) {
241 ef16f8f6 2023-07-02 op 		errno = EINVAL;
242 ef16f8f6 2023-07-02 op 		return (-1);
243 ef16f8f6 2023-07-02 op 	}
244 ef16f8f6 2023-07-02 op 	v = htobe16(value);
245 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
246 ef16f8f6 2023-07-02 op }
247 ef16f8f6 2023-07-02 op 
248 ef16f8f6 2023-07-02 op int
249 ef16f8f6 2023-07-02 op ibuf_set_n32(struct ibuf *buf, size_t pos, uint64_t value)
250 ef16f8f6 2023-07-02 op {
251 ef16f8f6 2023-07-02 op 	uint32_t v;
252 ef16f8f6 2023-07-02 op 
253 ef16f8f6 2023-07-02 op 	if (value > UINT32_MAX) {
254 ef16f8f6 2023-07-02 op 		errno = EINVAL;
255 ef16f8f6 2023-07-02 op 		return (-1);
256 ef16f8f6 2023-07-02 op 	}
257 ef16f8f6 2023-07-02 op 	v = htobe32(value);
258 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
259 ef16f8f6 2023-07-02 op }
260 ef16f8f6 2023-07-02 op 
261 ef16f8f6 2023-07-02 op int
262 ef16f8f6 2023-07-02 op ibuf_set_n64(struct ibuf *buf, size_t pos, uint64_t value)
263 ef16f8f6 2023-07-02 op {
264 ef16f8f6 2023-07-02 op 	value = htobe64(value);
265 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &value, sizeof(value)));
266 ef16f8f6 2023-07-02 op }
267 ef16f8f6 2023-07-02 op 
268 ef16f8f6 2023-07-02 op void *
269 ef16f8f6 2023-07-02 op ibuf_data(struct ibuf *buf)
270 ef16f8f6 2023-07-02 op {
271 ef16f8f6 2023-07-02 op 	return (buf->buf);
272 ef16f8f6 2023-07-02 op }
273 ef16f8f6 2023-07-02 op 
274 b0003f58 2021-03-08 op size_t
275 b0003f58 2021-03-08 op ibuf_size(struct ibuf *buf)
276 b0003f58 2021-03-08 op {
277 b0003f58 2021-03-08 op 	return (buf->wpos);
278 b0003f58 2021-03-08 op }
279 b0003f58 2021-03-08 op 
280 b0003f58 2021-03-08 op size_t
281 b0003f58 2021-03-08 op ibuf_left(struct ibuf *buf)
282 b0003f58 2021-03-08 op {
283 b0003f58 2021-03-08 op 	return (buf->max - buf->wpos);
284 b0003f58 2021-03-08 op }
285 b0003f58 2021-03-08 op 
286 b0003f58 2021-03-08 op void
287 b0003f58 2021-03-08 op ibuf_close(struct msgbuf *msgbuf, struct ibuf *buf)
288 b0003f58 2021-03-08 op {
289 b0003f58 2021-03-08 op 	ibuf_enqueue(msgbuf, buf);
290 b0003f58 2021-03-08 op }
291 b0003f58 2021-03-08 op 
292 ef16f8f6 2023-07-02 op void
293 ef16f8f6 2023-07-02 op ibuf_free(struct ibuf *buf)
294 ef16f8f6 2023-07-02 op {
295 ef16f8f6 2023-07-02 op 	if (buf == NULL)
296 ef16f8f6 2023-07-02 op 		return;
297 ef16f8f6 2023-07-02 op #ifdef NOTYET
298 ef16f8f6 2023-07-02 op 	if (buf->fd != -1)
299 ef16f8f6 2023-07-02 op 		close(buf->fd);
300 ef16f8f6 2023-07-02 op #endif
301 ef16f8f6 2023-07-02 op 	freezero(buf->buf, buf->size);
302 ef16f8f6 2023-07-02 op 	free(buf);
303 ef16f8f6 2023-07-02 op }
304 ef16f8f6 2023-07-02 op 
305 b0003f58 2021-03-08 op int
306 ef16f8f6 2023-07-02 op ibuf_fd_avail(struct ibuf *buf)
307 ef16f8f6 2023-07-02 op {
308 ef16f8f6 2023-07-02 op 	return (buf->fd != -1);
309 ef16f8f6 2023-07-02 op }
310 ef16f8f6 2023-07-02 op 
311 ef16f8f6 2023-07-02 op int
312 ef16f8f6 2023-07-02 op ibuf_fd_get(struct ibuf *buf)
313 ef16f8f6 2023-07-02 op {
314 ef16f8f6 2023-07-02 op 	int fd;
315 ef16f8f6 2023-07-02 op 
316 ef16f8f6 2023-07-02 op 	fd = buf->fd;
317 ef16f8f6 2023-07-02 op #ifdef NOTYET
318 ef16f8f6 2023-07-02 op 	buf->fd = -1;
319 ef16f8f6 2023-07-02 op #endif
320 ef16f8f6 2023-07-02 op 	return (fd);
321 ef16f8f6 2023-07-02 op }
322 ef16f8f6 2023-07-02 op 
323 ef16f8f6 2023-07-02 op void
324 ef16f8f6 2023-07-02 op ibuf_fd_set(struct ibuf *buf, int fd)
325 ef16f8f6 2023-07-02 op {
326 ef16f8f6 2023-07-02 op 	if (buf->fd != -1)
327 ef16f8f6 2023-07-02 op 		close(buf->fd);
328 ef16f8f6 2023-07-02 op 	buf->fd = fd;
329 ef16f8f6 2023-07-02 op }
330 ef16f8f6 2023-07-02 op 
331 ef16f8f6 2023-07-02 op int
332 b0003f58 2021-03-08 op ibuf_write(struct msgbuf *msgbuf)
333 b0003f58 2021-03-08 op {
334 b0003f58 2021-03-08 op 	struct iovec	 iov[IOV_MAX];
335 b0003f58 2021-03-08 op 	struct ibuf	*buf;
336 b0003f58 2021-03-08 op 	unsigned int	 i = 0;
337 b0003f58 2021-03-08 op 	ssize_t	n;
338 b0003f58 2021-03-08 op 
339 b0003f58 2021-03-08 op 	memset(&iov, 0, sizeof(iov));
340 b0003f58 2021-03-08 op 	TAILQ_FOREACH(buf, &msgbuf->bufs, entry) {
341 b0003f58 2021-03-08 op 		if (i >= IOV_MAX)
342 b0003f58 2021-03-08 op 			break;
343 b0003f58 2021-03-08 op 		iov[i].iov_base = buf->buf + buf->rpos;
344 b0003f58 2021-03-08 op 		iov[i].iov_len = buf->wpos - buf->rpos;
345 b0003f58 2021-03-08 op 		i++;
346 b0003f58 2021-03-08 op 	}
347 b0003f58 2021-03-08 op 
348 b0003f58 2021-03-08 op again:
349 b0003f58 2021-03-08 op 	if ((n = writev(msgbuf->fd, iov, i)) == -1) {
350 b0003f58 2021-03-08 op 		if (errno == EINTR)
351 b0003f58 2021-03-08 op 			goto again;
352 b0003f58 2021-03-08 op 		if (errno == ENOBUFS)
353 b0003f58 2021-03-08 op 			errno = EAGAIN;
354 b0003f58 2021-03-08 op 		return (-1);
355 b0003f58 2021-03-08 op 	}
356 b0003f58 2021-03-08 op 
357 b0003f58 2021-03-08 op 	if (n == 0) {			/* connection closed */
358 b0003f58 2021-03-08 op 		errno = 0;
359 b0003f58 2021-03-08 op 		return (0);
360 b0003f58 2021-03-08 op 	}
361 b0003f58 2021-03-08 op 
362 b0003f58 2021-03-08 op 	msgbuf_drain(msgbuf, n);
363 b0003f58 2021-03-08 op 
364 b0003f58 2021-03-08 op 	return (1);
365 b0003f58 2021-03-08 op }
366 b0003f58 2021-03-08 op 
367 b0003f58 2021-03-08 op void
368 b0003f58 2021-03-08 op msgbuf_init(struct msgbuf *msgbuf)
369 b0003f58 2021-03-08 op {
370 b0003f58 2021-03-08 op 	msgbuf->queued = 0;
371 b0003f58 2021-03-08 op 	msgbuf->fd = -1;
372 b0003f58 2021-03-08 op 	TAILQ_INIT(&msgbuf->bufs);
373 b0003f58 2021-03-08 op }
374 b0003f58 2021-03-08 op 
375 ef16f8f6 2023-07-02 op static void
376 b0003f58 2021-03-08 op msgbuf_drain(struct msgbuf *msgbuf, size_t n)
377 b0003f58 2021-03-08 op {
378 b0003f58 2021-03-08 op 	struct ibuf	*buf, *next;
379 b0003f58 2021-03-08 op 
380 b0003f58 2021-03-08 op 	for (buf = TAILQ_FIRST(&msgbuf->bufs); buf != NULL && n > 0;
381 b0003f58 2021-03-08 op 	    buf = next) {
382 b0003f58 2021-03-08 op 		next = TAILQ_NEXT(buf, entry);
383 ef16f8f6 2023-07-02 op 		if (n >= buf->wpos - buf->rpos) {
384 b0003f58 2021-03-08 op 			n -= buf->wpos - buf->rpos;
385 b0003f58 2021-03-08 op 			ibuf_dequeue(msgbuf, buf);
386 b0003f58 2021-03-08 op 		} else {
387 b0003f58 2021-03-08 op 			buf->rpos += n;
388 b0003f58 2021-03-08 op 			n = 0;
389 b0003f58 2021-03-08 op 		}
390 b0003f58 2021-03-08 op 	}
391 b0003f58 2021-03-08 op }
392 b0003f58 2021-03-08 op 
393 b0003f58 2021-03-08 op void
394 b0003f58 2021-03-08 op msgbuf_clear(struct msgbuf *msgbuf)
395 b0003f58 2021-03-08 op {
396 b0003f58 2021-03-08 op 	struct ibuf	*buf;
397 b0003f58 2021-03-08 op 
398 b0003f58 2021-03-08 op 	while ((buf = TAILQ_FIRST(&msgbuf->bufs)) != NULL)
399 b0003f58 2021-03-08 op 		ibuf_dequeue(msgbuf, buf);
400 b0003f58 2021-03-08 op }
401 b0003f58 2021-03-08 op 
402 b0003f58 2021-03-08 op int
403 b0003f58 2021-03-08 op msgbuf_write(struct msgbuf *msgbuf)
404 b0003f58 2021-03-08 op {
405 b0003f58 2021-03-08 op 	struct iovec	 iov[IOV_MAX];
406 e445acd1 2022-03-19 op 	struct ibuf	*buf, *buf0 = NULL;
407 b0003f58 2021-03-08 op 	unsigned int	 i = 0;
408 b0003f58 2021-03-08 op 	ssize_t		 n;
409 b0003f58 2021-03-08 op 	struct msghdr	 msg;
410 b0003f58 2021-03-08 op 	struct cmsghdr	*cmsg;
411 b0003f58 2021-03-08 op 	union {
412 b0003f58 2021-03-08 op 		struct cmsghdr	hdr;
413 b0003f58 2021-03-08 op 		char		buf[CMSG_SPACE(sizeof(int))];
414 b0003f58 2021-03-08 op 	} cmsgbuf;
415 b0003f58 2021-03-08 op 
416 b0003f58 2021-03-08 op 	memset(&iov, 0, sizeof(iov));
417 b0003f58 2021-03-08 op 	memset(&msg, 0, sizeof(msg));
418 b0003f58 2021-03-08 op 	memset(&cmsgbuf, 0, sizeof(cmsgbuf));
419 b0003f58 2021-03-08 op 	TAILQ_FOREACH(buf, &msgbuf->bufs, entry) {
420 b0003f58 2021-03-08 op 		if (i >= IOV_MAX)
421 b0003f58 2021-03-08 op 			break;
422 e445acd1 2022-03-19 op 		if (i > 0 && buf->fd != -1)
423 e445acd1 2022-03-19 op 			break;
424 b0003f58 2021-03-08 op 		iov[i].iov_base = buf->buf + buf->rpos;
425 b0003f58 2021-03-08 op 		iov[i].iov_len = buf->wpos - buf->rpos;
426 b0003f58 2021-03-08 op 		i++;
427 b0003f58 2021-03-08 op 		if (buf->fd != -1)
428 e445acd1 2022-03-19 op 			buf0 = buf;
429 b0003f58 2021-03-08 op 	}
430 b0003f58 2021-03-08 op 
431 b0003f58 2021-03-08 op 	msg.msg_iov = iov;
432 b0003f58 2021-03-08 op 	msg.msg_iovlen = i;
433 b0003f58 2021-03-08 op 
434 e445acd1 2022-03-19 op 	if (buf0 != NULL) {
435 b0003f58 2021-03-08 op 		msg.msg_control = (caddr_t)&cmsgbuf.buf;
436 b0003f58 2021-03-08 op 		msg.msg_controllen = sizeof(cmsgbuf.buf);
437 b0003f58 2021-03-08 op 		cmsg = CMSG_FIRSTHDR(&msg);
438 b0003f58 2021-03-08 op 		cmsg->cmsg_len = CMSG_LEN(sizeof(int));
439 b0003f58 2021-03-08 op 		cmsg->cmsg_level = SOL_SOCKET;
440 b0003f58 2021-03-08 op 		cmsg->cmsg_type = SCM_RIGHTS;
441 e445acd1 2022-03-19 op 		*(int *)CMSG_DATA(cmsg) = buf0->fd;
442 b0003f58 2021-03-08 op 	}
443 b0003f58 2021-03-08 op 
444 b0003f58 2021-03-08 op again:
445 b0003f58 2021-03-08 op 	if ((n = sendmsg(msgbuf->fd, &msg, 0)) == -1) {
446 b0003f58 2021-03-08 op 		if (errno == EINTR)
447 b0003f58 2021-03-08 op 			goto again;
448 b0003f58 2021-03-08 op 		if (errno == ENOBUFS)
449 b0003f58 2021-03-08 op 			errno = EAGAIN;
450 b0003f58 2021-03-08 op 		return (-1);
451 b0003f58 2021-03-08 op 	}
452 b0003f58 2021-03-08 op 
453 b0003f58 2021-03-08 op 	if (n == 0) {			/* connection closed */
454 b0003f58 2021-03-08 op 		errno = 0;
455 b0003f58 2021-03-08 op 		return (0);
456 b0003f58 2021-03-08 op 	}
457 b0003f58 2021-03-08 op 
458 b0003f58 2021-03-08 op 	/*
459 b0003f58 2021-03-08 op 	 * assumption: fd got sent if sendmsg sent anything
460 b0003f58 2021-03-08 op 	 * this works because fds are passed one at a time
461 b0003f58 2021-03-08 op 	 */
462 e445acd1 2022-03-19 op 	if (buf0 != NULL) {
463 e445acd1 2022-03-19 op 		close(buf0->fd);
464 e445acd1 2022-03-19 op 		buf0->fd = -1;
465 b0003f58 2021-03-08 op 	}
466 b0003f58 2021-03-08 op 
467 b0003f58 2021-03-08 op 	msgbuf_drain(msgbuf, n);
468 b0003f58 2021-03-08 op 
469 b0003f58 2021-03-08 op 	return (1);
470 b0003f58 2021-03-08 op }
471 b0003f58 2021-03-08 op 
472 b0003f58 2021-03-08 op static void
473 b0003f58 2021-03-08 op ibuf_enqueue(struct msgbuf *msgbuf, struct ibuf *buf)
474 b0003f58 2021-03-08 op {
475 b0003f58 2021-03-08 op 	TAILQ_INSERT_TAIL(&msgbuf->bufs, buf, entry);
476 b0003f58 2021-03-08 op 	msgbuf->queued++;
477 b0003f58 2021-03-08 op }
478 b0003f58 2021-03-08 op 
479 b0003f58 2021-03-08 op static void
480 b0003f58 2021-03-08 op ibuf_dequeue(struct msgbuf *msgbuf, struct ibuf *buf)
481 b0003f58 2021-03-08 op {
482 b0003f58 2021-03-08 op 	TAILQ_REMOVE(&msgbuf->bufs, buf, entry);
483 b0003f58 2021-03-08 op 
484 ef16f8f6 2023-07-02 op 	if (buf->fd != -1) {
485 b0003f58 2021-03-08 op 		close(buf->fd);
486 ef16f8f6 2023-07-02 op 		buf->fd = -1;
487 ef16f8f6 2023-07-02 op 	}
488 b0003f58 2021-03-08 op 
489 b0003f58 2021-03-08 op 	msgbuf->queued--;
490 b0003f58 2021-03-08 op 	ibuf_free(buf);
491 b0003f58 2021-03-08 op }