1 8623abea 2024-01-20 op /*	$OpenBSD: imsg-buffer.c,v 1.18 2023/12/12 15:47:41 claudio Exp $	*/
  2 b0003f58 2021-03-08 op 
  3 b0003f58 2021-03-08 op /*
  4 8623abea 2024-01-20 op  * Copyright (c) 2023 Claudio Jeker <claudio@openbsd.org>
  5 b0003f58 2021-03-08 op  * Copyright (c) 2003, 2004 Henning Brauer <henning@openbsd.org>
  6 b0003f58 2021-03-08 op  *
  7 b0003f58 2021-03-08 op  * Permission to use, copy, modify, and distribute this software for any
  8 b0003f58 2021-03-08 op  * purpose with or without fee is hereby granted, provided that the above
  9 b0003f58 2021-03-08 op  * copyright notice and this permission notice appear in all copies.
 10 b0003f58 2021-03-08 op  *
 11 b0003f58 2021-03-08 op  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 12 b0003f58 2021-03-08 op  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 13 b0003f58 2021-03-08 op  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 14 b0003f58 2021-03-08 op  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 15 b0003f58 2021-03-08 op  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 16 b0003f58 2021-03-08 op  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 17 b0003f58 2021-03-08 op  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 18 b0003f58 2021-03-08 op  */
 19 a625907c 2021-03-19 op 
 20 a625907c 2021-03-19 op #include "compat.h"
 21 b0003f58 2021-03-08 op 
 22 b0003f58 2021-03-08 op #include <sys/types.h>
 23 b0003f58 2021-03-08 op #include <sys/socket.h>
 24 b0003f58 2021-03-08 op #include <sys/uio.h>
 25 b0003f58 2021-03-08 op 
 26 b0003f58 2021-03-08 op #include <limits.h>
 27 b0003f58 2021-03-08 op #include <errno.h>
 28 8623abea 2024-01-20 op #include <stdint.h>
 29 b0003f58 2021-03-08 op #include <stdlib.h>
 30 b0003f58 2021-03-08 op #include <string.h>
 31 b0003f58 2021-03-08 op #include <unistd.h>
 32 b0003f58 2021-03-08 op 
 33 b0003f58 2021-03-08 op #include "imsg.h"
 34 b0003f58 2021-03-08 op 
 35 b0003f58 2021-03-08 op static int	ibuf_realloc(struct ibuf *, size_t);
 36 b0003f58 2021-03-08 op static void	ibuf_enqueue(struct msgbuf *, struct ibuf *);
 37 b0003f58 2021-03-08 op static void	ibuf_dequeue(struct msgbuf *, struct ibuf *);
 38 ef16f8f6 2023-07-02 op static void	msgbuf_drain(struct msgbuf *, size_t);
 39 b0003f58 2021-03-08 op 
 40 b0003f58 2021-03-08 op struct ibuf *
 41 b0003f58 2021-03-08 op ibuf_open(size_t len)
 42 b0003f58 2021-03-08 op {
 43 b0003f58 2021-03-08 op 	struct ibuf	*buf;
 44 b0003f58 2021-03-08 op 
 45 ef16f8f6 2023-07-02 op 	if (len == 0) {
 46 ef16f8f6 2023-07-02 op 		errno = EINVAL;
 47 ef16f8f6 2023-07-02 op 		return (NULL);
 48 ef16f8f6 2023-07-02 op 	}
 49 b0003f58 2021-03-08 op 	if ((buf = calloc(1, sizeof(struct ibuf))) == NULL)
 50 b0003f58 2021-03-08 op 		return (NULL);
 51 ef16f8f6 2023-07-02 op 	if ((buf->buf = calloc(len, 1)) == NULL) {
 52 b0003f58 2021-03-08 op 		free(buf);
 53 b0003f58 2021-03-08 op 		return (NULL);
 54 b0003f58 2021-03-08 op 	}
 55 b0003f58 2021-03-08 op 	buf->size = buf->max = len;
 56 b0003f58 2021-03-08 op 	buf->fd = -1;
 57 b0003f58 2021-03-08 op 
 58 b0003f58 2021-03-08 op 	return (buf);
 59 b0003f58 2021-03-08 op }
 60 b0003f58 2021-03-08 op 
 61 b0003f58 2021-03-08 op struct ibuf *
 62 b0003f58 2021-03-08 op ibuf_dynamic(size_t len, size_t max)
 63 b0003f58 2021-03-08 op {
 64 b0003f58 2021-03-08 op 	struct ibuf	*buf;
 65 b0003f58 2021-03-08 op 
 66 8623abea 2024-01-20 op 	if (max == 0 || max < len) {
 67 ef16f8f6 2023-07-02 op 		errno = EINVAL;
 68 b0003f58 2021-03-08 op 		return (NULL);
 69 ef16f8f6 2023-07-02 op 	}
 70 b0003f58 2021-03-08 op 
 71 ef16f8f6 2023-07-02 op 	if ((buf = calloc(1, sizeof(struct ibuf))) == NULL)
 72 b0003f58 2021-03-08 op 		return (NULL);
 73 ef16f8f6 2023-07-02 op 	if (len > 0) {
 74 ef16f8f6 2023-07-02 op 		if ((buf->buf = calloc(len, 1)) == NULL) {
 75 ef16f8f6 2023-07-02 op 			free(buf);
 76 ef16f8f6 2023-07-02 op 			return (NULL);
 77 ef16f8f6 2023-07-02 op 		}
 78 ef16f8f6 2023-07-02 op 	}
 79 ef16f8f6 2023-07-02 op 	buf->size = len;
 80 ef16f8f6 2023-07-02 op 	buf->max = max;
 81 ef16f8f6 2023-07-02 op 	buf->fd = -1;
 82 b0003f58 2021-03-08 op 
 83 b0003f58 2021-03-08 op 	return (buf);
 84 b0003f58 2021-03-08 op }
 85 b0003f58 2021-03-08 op 
 86 b0003f58 2021-03-08 op static int
 87 b0003f58 2021-03-08 op ibuf_realloc(struct ibuf *buf, size_t len)
 88 b0003f58 2021-03-08 op {
 89 b0003f58 2021-03-08 op 	unsigned char	*b;
 90 b0003f58 2021-03-08 op 
 91 b0003f58 2021-03-08 op 	/* on static buffers max is eq size and so the following fails */
 92 ef16f8f6 2023-07-02 op 	if (len > SIZE_MAX - buf->wpos || buf->wpos + len > buf->max) {
 93 b0003f58 2021-03-08 op 		errno = ERANGE;
 94 b0003f58 2021-03-08 op 		return (-1);
 95 b0003f58 2021-03-08 op 	}
 96 b0003f58 2021-03-08 op 
 97 b0003f58 2021-03-08 op 	b = recallocarray(buf->buf, buf->size, buf->wpos + len, 1);
 98 b0003f58 2021-03-08 op 	if (b == NULL)
 99 b0003f58 2021-03-08 op 		return (-1);
100 b0003f58 2021-03-08 op 	buf->buf = b;
101 b0003f58 2021-03-08 op 	buf->size = buf->wpos + len;
102 b0003f58 2021-03-08 op 
103 b0003f58 2021-03-08 op 	return (0);
104 b0003f58 2021-03-08 op }
105 b0003f58 2021-03-08 op 
106 b0003f58 2021-03-08 op void *
107 b0003f58 2021-03-08 op ibuf_reserve(struct ibuf *buf, size_t len)
108 b0003f58 2021-03-08 op {
109 b0003f58 2021-03-08 op 	void	*b;
110 b0003f58 2021-03-08 op 
111 8623abea 2024-01-20 op 	if (len > SIZE_MAX - buf->wpos || buf->max == 0) {
112 ef16f8f6 2023-07-02 op 		errno = ERANGE;
113 ef16f8f6 2023-07-02 op 		return (NULL);
114 ef16f8f6 2023-07-02 op 	}
115 ef16f8f6 2023-07-02 op 
116 b0003f58 2021-03-08 op 	if (buf->wpos + len > buf->size)
117 b0003f58 2021-03-08 op 		if (ibuf_realloc(buf, len) == -1)
118 b0003f58 2021-03-08 op 			return (NULL);
119 b0003f58 2021-03-08 op 
120 b0003f58 2021-03-08 op 	b = buf->buf + buf->wpos;
121 b0003f58 2021-03-08 op 	buf->wpos += len;
122 b0003f58 2021-03-08 op 	return (b);
123 b0003f58 2021-03-08 op }
124 b0003f58 2021-03-08 op 
125 ef16f8f6 2023-07-02 op int
126 ef16f8f6 2023-07-02 op ibuf_add(struct ibuf *buf, const void *data, size_t len)
127 ef16f8f6 2023-07-02 op {
128 ef16f8f6 2023-07-02 op 	void *b;
129 ef16f8f6 2023-07-02 op 
130 ef16f8f6 2023-07-02 op 	if ((b = ibuf_reserve(buf, len)) == NULL)
131 ef16f8f6 2023-07-02 op 		return (-1);
132 ef16f8f6 2023-07-02 op 
133 ef16f8f6 2023-07-02 op 	memcpy(b, data, len);
134 ef16f8f6 2023-07-02 op 	return (0);
135 ef16f8f6 2023-07-02 op }
136 ef16f8f6 2023-07-02 op 
137 ef16f8f6 2023-07-02 op int
138 8623abea 2024-01-20 op ibuf_add_ibuf(struct ibuf *buf, const struct ibuf *from)
139 8623abea 2024-01-20 op {
140 8623abea 2024-01-20 op 	return ibuf_add(buf, ibuf_data(from), ibuf_size(from));
141 8623abea 2024-01-20 op }
142 8623abea 2024-01-20 op 
143 8623abea 2024-01-20 op /* remove after tree is converted */
144 8623abea 2024-01-20 op int
145 ef16f8f6 2023-07-02 op ibuf_add_buf(struct ibuf *buf, const struct ibuf *from)
146 ef16f8f6 2023-07-02 op {
147 8623abea 2024-01-20 op 	return ibuf_add_ibuf(buf, from);
148 ef16f8f6 2023-07-02 op }
149 ef16f8f6 2023-07-02 op 
150 ef16f8f6 2023-07-02 op int
151 ef16f8f6 2023-07-02 op ibuf_add_n8(struct ibuf *buf, uint64_t value)
152 ef16f8f6 2023-07-02 op {
153 ef16f8f6 2023-07-02 op 	uint8_t v;
154 ef16f8f6 2023-07-02 op 
155 ef16f8f6 2023-07-02 op 	if (value > UINT8_MAX) {
156 ef16f8f6 2023-07-02 op 		errno = EINVAL;
157 ef16f8f6 2023-07-02 op 		return (-1);
158 ef16f8f6 2023-07-02 op 	}
159 ef16f8f6 2023-07-02 op 	v = value;
160 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
161 ef16f8f6 2023-07-02 op }
162 ef16f8f6 2023-07-02 op 
163 ef16f8f6 2023-07-02 op int
164 ef16f8f6 2023-07-02 op ibuf_add_n16(struct ibuf *buf, uint64_t value)
165 ef16f8f6 2023-07-02 op {
166 ef16f8f6 2023-07-02 op 	uint16_t v;
167 ef16f8f6 2023-07-02 op 
168 ef16f8f6 2023-07-02 op 	if (value > UINT16_MAX) {
169 ef16f8f6 2023-07-02 op 		errno = EINVAL;
170 ef16f8f6 2023-07-02 op 		return (-1);
171 ef16f8f6 2023-07-02 op 	}
172 ef16f8f6 2023-07-02 op 	v = htobe16(value);
173 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
174 ef16f8f6 2023-07-02 op }
175 ef16f8f6 2023-07-02 op 
176 ef16f8f6 2023-07-02 op int
177 ef16f8f6 2023-07-02 op ibuf_add_n32(struct ibuf *buf, uint64_t value)
178 ef16f8f6 2023-07-02 op {
179 ef16f8f6 2023-07-02 op 	uint32_t v;
180 ef16f8f6 2023-07-02 op 
181 ef16f8f6 2023-07-02 op 	if (value > UINT32_MAX) {
182 ef16f8f6 2023-07-02 op 		errno = EINVAL;
183 ef16f8f6 2023-07-02 op 		return (-1);
184 ef16f8f6 2023-07-02 op 	}
185 ef16f8f6 2023-07-02 op 	v = htobe32(value);
186 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &v, sizeof(v));
187 ef16f8f6 2023-07-02 op }
188 ef16f8f6 2023-07-02 op 
189 ef16f8f6 2023-07-02 op int
190 ef16f8f6 2023-07-02 op ibuf_add_n64(struct ibuf *buf, uint64_t value)
191 ef16f8f6 2023-07-02 op {
192 ef16f8f6 2023-07-02 op 	value = htobe64(value);
193 8623abea 2024-01-20 op 	return ibuf_add(buf, &value, sizeof(value));
194 8623abea 2024-01-20 op }
195 8623abea 2024-01-20 op 
196 8623abea 2024-01-20 op int
197 8623abea 2024-01-20 op ibuf_add_h16(struct ibuf *buf, uint64_t value)
198 8623abea 2024-01-20 op {
199 8623abea 2024-01-20 op 	uint16_t v;
200 8623abea 2024-01-20 op 
201 8623abea 2024-01-20 op 	if (value > UINT16_MAX) {
202 8623abea 2024-01-20 op 		errno = EINVAL;
203 8623abea 2024-01-20 op 		return (-1);
204 8623abea 2024-01-20 op 	}
205 8623abea 2024-01-20 op 	v = value;
206 8623abea 2024-01-20 op 	return ibuf_add(buf, &v, sizeof(v));
207 8623abea 2024-01-20 op }
208 8623abea 2024-01-20 op 
209 8623abea 2024-01-20 op int
210 8623abea 2024-01-20 op ibuf_add_h32(struct ibuf *buf, uint64_t value)
211 8623abea 2024-01-20 op {
212 8623abea 2024-01-20 op 	uint32_t v;
213 8623abea 2024-01-20 op 
214 8623abea 2024-01-20 op 	if (value > UINT32_MAX) {
215 8623abea 2024-01-20 op 		errno = EINVAL;
216 8623abea 2024-01-20 op 		return (-1);
217 8623abea 2024-01-20 op 	}
218 8623abea 2024-01-20 op 	v = value;
219 8623abea 2024-01-20 op 	return ibuf_add(buf, &v, sizeof(v));
220 8623abea 2024-01-20 op }
221 8623abea 2024-01-20 op 
222 8623abea 2024-01-20 op int
223 8623abea 2024-01-20 op ibuf_add_h64(struct ibuf *buf, uint64_t value)
224 8623abea 2024-01-20 op {
225 ef16f8f6 2023-07-02 op 	return ibuf_add(buf, &value, sizeof(value));
226 ef16f8f6 2023-07-02 op }
227 ef16f8f6 2023-07-02 op 
228 ef16f8f6 2023-07-02 op int
229 ef16f8f6 2023-07-02 op ibuf_add_zero(struct ibuf *buf, size_t len)
230 ef16f8f6 2023-07-02 op {
231 ef16f8f6 2023-07-02 op 	void *b;
232 ef16f8f6 2023-07-02 op 
233 ef16f8f6 2023-07-02 op 	if ((b = ibuf_reserve(buf, len)) == NULL)
234 ef16f8f6 2023-07-02 op 		return (-1);
235 8623abea 2024-01-20 op 	memset(b, 0, len);
236 ef16f8f6 2023-07-02 op 	return (0);
237 ef16f8f6 2023-07-02 op }
238 ef16f8f6 2023-07-02 op 
239 b0003f58 2021-03-08 op void *
240 b0003f58 2021-03-08 op ibuf_seek(struct ibuf *buf, size_t pos, size_t len)
241 b0003f58 2021-03-08 op {
242 8623abea 2024-01-20 op 	/* only allow seeking between rpos and wpos */
243 8623abea 2024-01-20 op 	if (ibuf_size(buf) < pos || SIZE_MAX - pos < len ||
244 8623abea 2024-01-20 op 	    ibuf_size(buf) < pos + len) {
245 ef16f8f6 2023-07-02 op 		errno = ERANGE;
246 b0003f58 2021-03-08 op 		return (NULL);
247 ef16f8f6 2023-07-02 op 	}
248 b0003f58 2021-03-08 op 
249 8623abea 2024-01-20 op 	return (buf->buf + buf->rpos + pos);
250 b0003f58 2021-03-08 op }
251 b0003f58 2021-03-08 op 
252 ef16f8f6 2023-07-02 op int
253 ef16f8f6 2023-07-02 op ibuf_set(struct ibuf *buf, size_t pos, const void *data, size_t len)
254 ef16f8f6 2023-07-02 op {
255 ef16f8f6 2023-07-02 op 	void *b;
256 ef16f8f6 2023-07-02 op 
257 ef16f8f6 2023-07-02 op 	if ((b = ibuf_seek(buf, pos, len)) == NULL)
258 ef16f8f6 2023-07-02 op 		return (-1);
259 ef16f8f6 2023-07-02 op 
260 ef16f8f6 2023-07-02 op 	memcpy(b, data, len);
261 ef16f8f6 2023-07-02 op 	return (0);
262 ef16f8f6 2023-07-02 op }
263 ef16f8f6 2023-07-02 op 
264 ef16f8f6 2023-07-02 op int
265 ef16f8f6 2023-07-02 op ibuf_set_n8(struct ibuf *buf, size_t pos, uint64_t value)
266 ef16f8f6 2023-07-02 op {
267 ef16f8f6 2023-07-02 op 	uint8_t v;
268 ef16f8f6 2023-07-02 op 
269 ef16f8f6 2023-07-02 op 	if (value > UINT8_MAX) {
270 ef16f8f6 2023-07-02 op 		errno = EINVAL;
271 ef16f8f6 2023-07-02 op 		return (-1);
272 ef16f8f6 2023-07-02 op 	}
273 ef16f8f6 2023-07-02 op 	v = value;
274 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
275 ef16f8f6 2023-07-02 op }
276 ef16f8f6 2023-07-02 op 
277 ef16f8f6 2023-07-02 op int
278 ef16f8f6 2023-07-02 op ibuf_set_n16(struct ibuf *buf, size_t pos, uint64_t value)
279 ef16f8f6 2023-07-02 op {
280 ef16f8f6 2023-07-02 op 	uint16_t v;
281 ef16f8f6 2023-07-02 op 
282 ef16f8f6 2023-07-02 op 	if (value > UINT16_MAX) {
283 ef16f8f6 2023-07-02 op 		errno = EINVAL;
284 ef16f8f6 2023-07-02 op 		return (-1);
285 ef16f8f6 2023-07-02 op 	}
286 ef16f8f6 2023-07-02 op 	v = htobe16(value);
287 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
288 ef16f8f6 2023-07-02 op }
289 ef16f8f6 2023-07-02 op 
290 ef16f8f6 2023-07-02 op int
291 ef16f8f6 2023-07-02 op ibuf_set_n32(struct ibuf *buf, size_t pos, uint64_t value)
292 ef16f8f6 2023-07-02 op {
293 ef16f8f6 2023-07-02 op 	uint32_t v;
294 ef16f8f6 2023-07-02 op 
295 ef16f8f6 2023-07-02 op 	if (value > UINT32_MAX) {
296 ef16f8f6 2023-07-02 op 		errno = EINVAL;
297 ef16f8f6 2023-07-02 op 		return (-1);
298 ef16f8f6 2023-07-02 op 	}
299 ef16f8f6 2023-07-02 op 	v = htobe32(value);
300 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
301 ef16f8f6 2023-07-02 op }
302 ef16f8f6 2023-07-02 op 
303 ef16f8f6 2023-07-02 op int
304 ef16f8f6 2023-07-02 op ibuf_set_n64(struct ibuf *buf, size_t pos, uint64_t value)
305 ef16f8f6 2023-07-02 op {
306 ef16f8f6 2023-07-02 op 	value = htobe64(value);
307 ef16f8f6 2023-07-02 op 	return (ibuf_set(buf, pos, &value, sizeof(value)));
308 ef16f8f6 2023-07-02 op }
309 ef16f8f6 2023-07-02 op 
310 8623abea 2024-01-20 op int
311 8623abea 2024-01-20 op ibuf_set_h16(struct ibuf *buf, size_t pos, uint64_t value)
312 ef16f8f6 2023-07-02 op {
313 8623abea 2024-01-20 op 	uint16_t v;
314 ef16f8f6 2023-07-02 op 
315 8623abea 2024-01-20 op 	if (value > UINT16_MAX) {
316 8623abea 2024-01-20 op 		errno = EINVAL;
317 8623abea 2024-01-20 op 		return (-1);
318 8623abea 2024-01-20 op 	}
319 8623abea 2024-01-20 op 	v = value;
320 8623abea 2024-01-20 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
321 b0003f58 2021-03-08 op }
322 b0003f58 2021-03-08 op 
323 8623abea 2024-01-20 op int
324 8623abea 2024-01-20 op ibuf_set_h32(struct ibuf *buf, size_t pos, uint64_t value)
325 8623abea 2024-01-20 op {
326 8623abea 2024-01-20 op 	uint32_t v;
327 8623abea 2024-01-20 op 
328 8623abea 2024-01-20 op 	if (value > UINT32_MAX) {
329 8623abea 2024-01-20 op 		errno = EINVAL;
330 8623abea 2024-01-20 op 		return (-1);
331 8623abea 2024-01-20 op 	}
332 8623abea 2024-01-20 op 	v = value;
333 8623abea 2024-01-20 op 	return (ibuf_set(buf, pos, &v, sizeof(v)));
334 8623abea 2024-01-20 op }
335 8623abea 2024-01-20 op 
336 8623abea 2024-01-20 op int
337 8623abea 2024-01-20 op ibuf_set_h64(struct ibuf *buf, size_t pos, uint64_t value)
338 8623abea 2024-01-20 op {
339 8623abea 2024-01-20 op 	return (ibuf_set(buf, pos, &value, sizeof(value)));
340 8623abea 2024-01-20 op }
341 8623abea 2024-01-20 op 
342 8623abea 2024-01-20 op void *
343 8623abea 2024-01-20 op ibuf_data(const struct ibuf *buf)
344 8623abea 2024-01-20 op {
345 8623abea 2024-01-20 op 	return (buf->buf + buf->rpos);
346 8623abea 2024-01-20 op }
347 8623abea 2024-01-20 op 
348 b0003f58 2021-03-08 op size_t
349 8623abea 2024-01-20 op ibuf_size(const struct ibuf *buf)
350 b0003f58 2021-03-08 op {
351 8623abea 2024-01-20 op 	return (buf->wpos - buf->rpos);
352 8623abea 2024-01-20 op }
353 8623abea 2024-01-20 op 
354 8623abea 2024-01-20 op size_t
355 8623abea 2024-01-20 op ibuf_left(const struct ibuf *buf)
356 8623abea 2024-01-20 op {
357 8623abea 2024-01-20 op 	if (buf->max == 0)
358 8623abea 2024-01-20 op 		return (0);
359 b0003f58 2021-03-08 op 	return (buf->max - buf->wpos);
360 b0003f58 2021-03-08 op }
361 b0003f58 2021-03-08 op 
362 8623abea 2024-01-20 op int
363 8623abea 2024-01-20 op ibuf_truncate(struct ibuf *buf, size_t len)
364 8623abea 2024-01-20 op {
365 8623abea 2024-01-20 op 	if (ibuf_size(buf) >= len) {
366 8623abea 2024-01-20 op 		buf->wpos = buf->rpos + len;
367 8623abea 2024-01-20 op 		return (0);
368 8623abea 2024-01-20 op 	}
369 8623abea 2024-01-20 op 	if (buf->max == 0) {
370 8623abea 2024-01-20 op 		/* only allow to truncate down */
371 8623abea 2024-01-20 op 		errno = ERANGE;
372 8623abea 2024-01-20 op 		return (-1);
373 8623abea 2024-01-20 op 	}
374 8623abea 2024-01-20 op 	return ibuf_add_zero(buf, len - ibuf_size(buf));
375 8623abea 2024-01-20 op }
376 8623abea 2024-01-20 op 
377 b0003f58 2021-03-08 op void
378 8623abea 2024-01-20 op ibuf_rewind(struct ibuf *buf)
379 8623abea 2024-01-20 op {
380 8623abea 2024-01-20 op 	buf->rpos = 0;
381 8623abea 2024-01-20 op }
382 8623abea 2024-01-20 op 
383 8623abea 2024-01-20 op void
384 b0003f58 2021-03-08 op ibuf_close(struct msgbuf *msgbuf, struct ibuf *buf)
385 b0003f58 2021-03-08 op {
386 b0003f58 2021-03-08 op 	ibuf_enqueue(msgbuf, buf);
387 8623abea 2024-01-20 op }
388 8623abea 2024-01-20 op 
389 8623abea 2024-01-20 op void
390 8623abea 2024-01-20 op ibuf_from_buffer(struct ibuf *buf, void *data, size_t len)
391 8623abea 2024-01-20 op {
392 8623abea 2024-01-20 op 	memset(buf, 0, sizeof(*buf));
393 8623abea 2024-01-20 op 	buf->buf = data;
394 8623abea 2024-01-20 op 	buf->size = buf->wpos = len;
395 8623abea 2024-01-20 op 	buf->fd = -1;
396 8623abea 2024-01-20 op }
397 8623abea 2024-01-20 op 
398 8623abea 2024-01-20 op void
399 8623abea 2024-01-20 op ibuf_from_ibuf(struct ibuf *buf, const struct ibuf *from)
400 8623abea 2024-01-20 op {
401 8623abea 2024-01-20 op 	ibuf_from_buffer(buf, ibuf_data(from), ibuf_size(from));
402 b0003f58 2021-03-08 op }
403 b0003f58 2021-03-08 op 
404 8623abea 2024-01-20 op int
405 8623abea 2024-01-20 op ibuf_get(struct ibuf *buf, void *data, size_t len)
406 8623abea 2024-01-20 op {
407 8623abea 2024-01-20 op 	if (ibuf_size(buf) < len) {
408 8623abea 2024-01-20 op 		errno = EBADMSG;
409 8623abea 2024-01-20 op 		return (-1);
410 8623abea 2024-01-20 op 	}
411 8623abea 2024-01-20 op 
412 8623abea 2024-01-20 op 	memcpy(data, ibuf_data(buf), len);
413 8623abea 2024-01-20 op 	buf->rpos += len;
414 8623abea 2024-01-20 op 	return (0);
415 8623abea 2024-01-20 op }
416 8623abea 2024-01-20 op 
417 8623abea 2024-01-20 op int
418 8623abea 2024-01-20 op ibuf_get_ibuf(struct ibuf *buf, size_t len, struct ibuf *new)
419 8623abea 2024-01-20 op {
420 8623abea 2024-01-20 op 	if (ibuf_size(buf) < len) {
421 8623abea 2024-01-20 op 		errno = EBADMSG;
422 8623abea 2024-01-20 op 		return (-1);
423 8623abea 2024-01-20 op 	}
424 8623abea 2024-01-20 op 
425 8623abea 2024-01-20 op 	ibuf_from_buffer(new, ibuf_data(buf), len);
426 8623abea 2024-01-20 op 	buf->rpos += len;
427 8623abea 2024-01-20 op 	return (0);
428 8623abea 2024-01-20 op }
429 8623abea 2024-01-20 op 
430 8623abea 2024-01-20 op int
431 8623abea 2024-01-20 op ibuf_get_n8(struct ibuf *buf, uint8_t *value)
432 8623abea 2024-01-20 op {
433 8623abea 2024-01-20 op 	return ibuf_get(buf, value, sizeof(*value));
434 8623abea 2024-01-20 op }
435 8623abea 2024-01-20 op 
436 8623abea 2024-01-20 op int
437 8623abea 2024-01-20 op ibuf_get_n16(struct ibuf *buf, uint16_t *value)
438 8623abea 2024-01-20 op {
439 8623abea 2024-01-20 op 	int rv;
440 8623abea 2024-01-20 op 
441 8623abea 2024-01-20 op 	rv = ibuf_get(buf, value, sizeof(*value));
442 8623abea 2024-01-20 op 	*value = be16toh(*value);
443 8623abea 2024-01-20 op 	return (rv);
444 8623abea 2024-01-20 op }
445 8623abea 2024-01-20 op 
446 8623abea 2024-01-20 op int
447 8623abea 2024-01-20 op ibuf_get_n32(struct ibuf *buf, uint32_t *value)
448 8623abea 2024-01-20 op {
449 8623abea 2024-01-20 op 	int rv;
450 8623abea 2024-01-20 op 
451 8623abea 2024-01-20 op 	rv = ibuf_get(buf, value, sizeof(*value));
452 8623abea 2024-01-20 op 	*value = be32toh(*value);
453 8623abea 2024-01-20 op 	return (rv);
454 8623abea 2024-01-20 op }
455 8623abea 2024-01-20 op 
456 8623abea 2024-01-20 op int
457 8623abea 2024-01-20 op ibuf_get_n64(struct ibuf *buf, uint64_t *value)
458 8623abea 2024-01-20 op {
459 8623abea 2024-01-20 op 	int rv;
460 8623abea 2024-01-20 op 
461 8623abea 2024-01-20 op 	rv = ibuf_get(buf, value, sizeof(*value));
462 8623abea 2024-01-20 op 	*value = be64toh(*value);
463 8623abea 2024-01-20 op 	return (rv);
464 8623abea 2024-01-20 op }
465 8623abea 2024-01-20 op 
466 8623abea 2024-01-20 op int
467 8623abea 2024-01-20 op ibuf_get_h16(struct ibuf *buf, uint16_t *value)
468 8623abea 2024-01-20 op {
469 8623abea 2024-01-20 op 	return ibuf_get(buf, value, sizeof(*value));
470 8623abea 2024-01-20 op }
471 8623abea 2024-01-20 op 
472 8623abea 2024-01-20 op int
473 8623abea 2024-01-20 op ibuf_get_h32(struct ibuf *buf, uint32_t *value)
474 8623abea 2024-01-20 op {
475 8623abea 2024-01-20 op 	return ibuf_get(buf, value, sizeof(*value));
476 8623abea 2024-01-20 op }
477 8623abea 2024-01-20 op 
478 8623abea 2024-01-20 op int
479 8623abea 2024-01-20 op ibuf_get_h64(struct ibuf *buf, uint64_t *value)
480 8623abea 2024-01-20 op {
481 8623abea 2024-01-20 op 	return ibuf_get(buf, value, sizeof(*value));
482 8623abea 2024-01-20 op }
483 8623abea 2024-01-20 op 
484 8623abea 2024-01-20 op int
485 8623abea 2024-01-20 op ibuf_skip(struct ibuf *buf, size_t len)
486 8623abea 2024-01-20 op {
487 8623abea 2024-01-20 op 	if (ibuf_size(buf) < len) {
488 8623abea 2024-01-20 op 		errno = EBADMSG;
489 8623abea 2024-01-20 op 		return (-1);
490 8623abea 2024-01-20 op 	}
491 8623abea 2024-01-20 op 
492 8623abea 2024-01-20 op 	buf->rpos += len;
493 8623abea 2024-01-20 op 	return (0);
494 8623abea 2024-01-20 op }
495 8623abea 2024-01-20 op 
496 ef16f8f6 2023-07-02 op void
497 ef16f8f6 2023-07-02 op ibuf_free(struct ibuf *buf)
498 ef16f8f6 2023-07-02 op {
499 ef16f8f6 2023-07-02 op 	if (buf == NULL)
500 ef16f8f6 2023-07-02 op 		return;
501 8623abea 2024-01-20 op 	if (buf->max == 0)	/* if buf lives on the stack */
502 8623abea 2024-01-20 op 		abort();	/* abort before causing more harm */
503 ef16f8f6 2023-07-02 op 	if (buf->fd != -1)
504 ef16f8f6 2023-07-02 op 		close(buf->fd);
505 ef16f8f6 2023-07-02 op 	freezero(buf->buf, buf->size);
506 ef16f8f6 2023-07-02 op 	free(buf);
507 ef16f8f6 2023-07-02 op }
508 ef16f8f6 2023-07-02 op 
509 b0003f58 2021-03-08 op int
510 ef16f8f6 2023-07-02 op ibuf_fd_avail(struct ibuf *buf)
511 ef16f8f6 2023-07-02 op {
512 ef16f8f6 2023-07-02 op 	return (buf->fd != -1);
513 ef16f8f6 2023-07-02 op }
514 ef16f8f6 2023-07-02 op 
515 ef16f8f6 2023-07-02 op int
516 ef16f8f6 2023-07-02 op ibuf_fd_get(struct ibuf *buf)
517 ef16f8f6 2023-07-02 op {
518 ef16f8f6 2023-07-02 op 	int fd;
519 ef16f8f6 2023-07-02 op 
520 ef16f8f6 2023-07-02 op 	fd = buf->fd;
521 ef16f8f6 2023-07-02 op 	buf->fd = -1;
522 ef16f8f6 2023-07-02 op 	return (fd);
523 ef16f8f6 2023-07-02 op }
524 ef16f8f6 2023-07-02 op 
525 ef16f8f6 2023-07-02 op void
526 ef16f8f6 2023-07-02 op ibuf_fd_set(struct ibuf *buf, int fd)
527 ef16f8f6 2023-07-02 op {
528 8623abea 2024-01-20 op 	if (buf->max == 0)	/* if buf lives on the stack */
529 8623abea 2024-01-20 op 		abort();	/* abort before causing more harm */
530 ef16f8f6 2023-07-02 op 	if (buf->fd != -1)
531 ef16f8f6 2023-07-02 op 		close(buf->fd);
532 ef16f8f6 2023-07-02 op 	buf->fd = fd;
533 ef16f8f6 2023-07-02 op }
534 ef16f8f6 2023-07-02 op 
535 ef16f8f6 2023-07-02 op int
536 b0003f58 2021-03-08 op ibuf_write(struct msgbuf *msgbuf)
537 b0003f58 2021-03-08 op {
538 b0003f58 2021-03-08 op 	struct iovec	 iov[IOV_MAX];
539 b0003f58 2021-03-08 op 	struct ibuf	*buf;
540 b0003f58 2021-03-08 op 	unsigned int	 i = 0;
541 b0003f58 2021-03-08 op 	ssize_t	n;
542 b0003f58 2021-03-08 op 
543 b0003f58 2021-03-08 op 	memset(&iov, 0, sizeof(iov));
544 b0003f58 2021-03-08 op 	TAILQ_FOREACH(buf, &msgbuf->bufs, entry) {
545 b0003f58 2021-03-08 op 		if (i >= IOV_MAX)
546 b0003f58 2021-03-08 op 			break;
547 8623abea 2024-01-20 op 		iov[i].iov_base = ibuf_data(buf);
548 8623abea 2024-01-20 op 		iov[i].iov_len = ibuf_size(buf);
549 b0003f58 2021-03-08 op 		i++;
550 b0003f58 2021-03-08 op 	}
551 b0003f58 2021-03-08 op 
552 b0003f58 2021-03-08 op again:
553 b0003f58 2021-03-08 op 	if ((n = writev(msgbuf->fd, iov, i)) == -1) {
554 b0003f58 2021-03-08 op 		if (errno == EINTR)
555 b0003f58 2021-03-08 op 			goto again;
556 b0003f58 2021-03-08 op 		if (errno == ENOBUFS)
557 b0003f58 2021-03-08 op 			errno = EAGAIN;
558 b0003f58 2021-03-08 op 		return (-1);
559 b0003f58 2021-03-08 op 	}
560 b0003f58 2021-03-08 op 
561 b0003f58 2021-03-08 op 	if (n == 0) {			/* connection closed */
562 b0003f58 2021-03-08 op 		errno = 0;
563 b0003f58 2021-03-08 op 		return (0);
564 b0003f58 2021-03-08 op 	}
565 b0003f58 2021-03-08 op 
566 b0003f58 2021-03-08 op 	msgbuf_drain(msgbuf, n);
567 b0003f58 2021-03-08 op 
568 b0003f58 2021-03-08 op 	return (1);
569 b0003f58 2021-03-08 op }
570 b0003f58 2021-03-08 op 
571 b0003f58 2021-03-08 op void
572 b0003f58 2021-03-08 op msgbuf_init(struct msgbuf *msgbuf)
573 b0003f58 2021-03-08 op {
574 b0003f58 2021-03-08 op 	msgbuf->queued = 0;
575 b0003f58 2021-03-08 op 	msgbuf->fd = -1;
576 b0003f58 2021-03-08 op 	TAILQ_INIT(&msgbuf->bufs);
577 b0003f58 2021-03-08 op }
578 b0003f58 2021-03-08 op 
579 ef16f8f6 2023-07-02 op static void
580 b0003f58 2021-03-08 op msgbuf_drain(struct msgbuf *msgbuf, size_t n)
581 b0003f58 2021-03-08 op {
582 b0003f58 2021-03-08 op 	struct ibuf	*buf, *next;
583 b0003f58 2021-03-08 op 
584 b0003f58 2021-03-08 op 	for (buf = TAILQ_FIRST(&msgbuf->bufs); buf != NULL && n > 0;
585 b0003f58 2021-03-08 op 	    buf = next) {
586 b0003f58 2021-03-08 op 		next = TAILQ_NEXT(buf, entry);
587 8623abea 2024-01-20 op 		if (n >= ibuf_size(buf)) {
588 8623abea 2024-01-20 op 			n -= ibuf_size(buf);
589 b0003f58 2021-03-08 op 			ibuf_dequeue(msgbuf, buf);
590 b0003f58 2021-03-08 op 		} else {
591 b0003f58 2021-03-08 op 			buf->rpos += n;
592 b0003f58 2021-03-08 op 			n = 0;
593 b0003f58 2021-03-08 op 		}
594 b0003f58 2021-03-08 op 	}
595 b0003f58 2021-03-08 op }
596 b0003f58 2021-03-08 op 
597 b0003f58 2021-03-08 op void
598 b0003f58 2021-03-08 op msgbuf_clear(struct msgbuf *msgbuf)
599 b0003f58 2021-03-08 op {
600 b0003f58 2021-03-08 op 	struct ibuf	*buf;
601 b0003f58 2021-03-08 op 
602 b0003f58 2021-03-08 op 	while ((buf = TAILQ_FIRST(&msgbuf->bufs)) != NULL)
603 b0003f58 2021-03-08 op 		ibuf_dequeue(msgbuf, buf);
604 b0003f58 2021-03-08 op }
605 b0003f58 2021-03-08 op 
606 b0003f58 2021-03-08 op int
607 b0003f58 2021-03-08 op msgbuf_write(struct msgbuf *msgbuf)
608 b0003f58 2021-03-08 op {
609 b0003f58 2021-03-08 op 	struct iovec	 iov[IOV_MAX];
610 e445acd1 2022-03-19 op 	struct ibuf	*buf, *buf0 = NULL;
611 b0003f58 2021-03-08 op 	unsigned int	 i = 0;
612 b0003f58 2021-03-08 op 	ssize_t		 n;
613 b0003f58 2021-03-08 op 	struct msghdr	 msg;
614 b0003f58 2021-03-08 op 	struct cmsghdr	*cmsg;
615 b0003f58 2021-03-08 op 	union {
616 b0003f58 2021-03-08 op 		struct cmsghdr	hdr;
617 b0003f58 2021-03-08 op 		char		buf[CMSG_SPACE(sizeof(int))];
618 b0003f58 2021-03-08 op 	} cmsgbuf;
619 b0003f58 2021-03-08 op 
620 b0003f58 2021-03-08 op 	memset(&iov, 0, sizeof(iov));
621 b0003f58 2021-03-08 op 	memset(&msg, 0, sizeof(msg));
622 b0003f58 2021-03-08 op 	memset(&cmsgbuf, 0, sizeof(cmsgbuf));
623 b0003f58 2021-03-08 op 	TAILQ_FOREACH(buf, &msgbuf->bufs, entry) {
624 b0003f58 2021-03-08 op 		if (i >= IOV_MAX)
625 b0003f58 2021-03-08 op 			break;
626 e445acd1 2022-03-19 op 		if (i > 0 && buf->fd != -1)
627 e445acd1 2022-03-19 op 			break;
628 8623abea 2024-01-20 op 		iov[i].iov_base = ibuf_data(buf);
629 8623abea 2024-01-20 op 		iov[i].iov_len = ibuf_size(buf);
630 b0003f58 2021-03-08 op 		i++;
631 b0003f58 2021-03-08 op 		if (buf->fd != -1)
632 e445acd1 2022-03-19 op 			buf0 = buf;
633 b0003f58 2021-03-08 op 	}
634 b0003f58 2021-03-08 op 
635 b0003f58 2021-03-08 op 	msg.msg_iov = iov;
636 b0003f58 2021-03-08 op 	msg.msg_iovlen = i;
637 b0003f58 2021-03-08 op 
638 e445acd1 2022-03-19 op 	if (buf0 != NULL) {
639 b0003f58 2021-03-08 op 		msg.msg_control = (caddr_t)&cmsgbuf.buf;
640 b0003f58 2021-03-08 op 		msg.msg_controllen = sizeof(cmsgbuf.buf);
641 b0003f58 2021-03-08 op 		cmsg = CMSG_FIRSTHDR(&msg);
642 b0003f58 2021-03-08 op 		cmsg->cmsg_len = CMSG_LEN(sizeof(int));
643 b0003f58 2021-03-08 op 		cmsg->cmsg_level = SOL_SOCKET;
644 b0003f58 2021-03-08 op 		cmsg->cmsg_type = SCM_RIGHTS;
645 e445acd1 2022-03-19 op 		*(int *)CMSG_DATA(cmsg) = buf0->fd;
646 b0003f58 2021-03-08 op 	}
647 b0003f58 2021-03-08 op 
648 b0003f58 2021-03-08 op again:
649 b0003f58 2021-03-08 op 	if ((n = sendmsg(msgbuf->fd, &msg, 0)) == -1) {
650 b0003f58 2021-03-08 op 		if (errno == EINTR)
651 b0003f58 2021-03-08 op 			goto again;
652 b0003f58 2021-03-08 op 		if (errno == ENOBUFS)
653 b0003f58 2021-03-08 op 			errno = EAGAIN;
654 b0003f58 2021-03-08 op 		return (-1);
655 b0003f58 2021-03-08 op 	}
656 b0003f58 2021-03-08 op 
657 b0003f58 2021-03-08 op 	if (n == 0) {			/* connection closed */
658 b0003f58 2021-03-08 op 		errno = 0;
659 b0003f58 2021-03-08 op 		return (0);
660 b0003f58 2021-03-08 op 	}
661 b0003f58 2021-03-08 op 
662 b0003f58 2021-03-08 op 	/*
663 b0003f58 2021-03-08 op 	 * assumption: fd got sent if sendmsg sent anything
664 b0003f58 2021-03-08 op 	 * this works because fds are passed one at a time
665 b0003f58 2021-03-08 op 	 */
666 e445acd1 2022-03-19 op 	if (buf0 != NULL) {
667 e445acd1 2022-03-19 op 		close(buf0->fd);
668 e445acd1 2022-03-19 op 		buf0->fd = -1;
669 b0003f58 2021-03-08 op 	}
670 b0003f58 2021-03-08 op 
671 b0003f58 2021-03-08 op 	msgbuf_drain(msgbuf, n);
672 b0003f58 2021-03-08 op 
673 b0003f58 2021-03-08 op 	return (1);
674 b0003f58 2021-03-08 op }
675 b0003f58 2021-03-08 op 
676 8623abea 2024-01-20 op uint32_t
677 8623abea 2024-01-20 op msgbuf_queuelen(struct msgbuf *msgbuf)
678 8623abea 2024-01-20 op {
679 8623abea 2024-01-20 op 	return (msgbuf->queued);
680 8623abea 2024-01-20 op }
681 8623abea 2024-01-20 op 
682 b0003f58 2021-03-08 op static void
683 b0003f58 2021-03-08 op ibuf_enqueue(struct msgbuf *msgbuf, struct ibuf *buf)
684 b0003f58 2021-03-08 op {
685 8623abea 2024-01-20 op 	if (buf->max == 0)	/* if buf lives on the stack */
686 8623abea 2024-01-20 op 		abort();	/* abort before causing more harm */
687 b0003f58 2021-03-08 op 	TAILQ_INSERT_TAIL(&msgbuf->bufs, buf, entry);
688 b0003f58 2021-03-08 op 	msgbuf->queued++;
689 b0003f58 2021-03-08 op }
690 b0003f58 2021-03-08 op 
691 b0003f58 2021-03-08 op static void
692 b0003f58 2021-03-08 op ibuf_dequeue(struct msgbuf *msgbuf, struct ibuf *buf)
693 b0003f58 2021-03-08 op {
694 b0003f58 2021-03-08 op 	TAILQ_REMOVE(&msgbuf->bufs, buf, entry);
695 b0003f58 2021-03-08 op 	msgbuf->queued--;
696 b0003f58 2021-03-08 op 	ibuf_free(buf);
697 b0003f58 2021-03-08 op }