rumpuser_sp.c revision 1.27 1 1.27 pooka /* $NetBSD: rumpuser_sp.c,v 1.27 2010/12/16 17:05:44 pooka Exp $ */
2 1.1 pooka
3 1.1 pooka /*
4 1.1 pooka * Copyright (c) 2010 Antti Kantee. All Rights Reserved.
5 1.1 pooka *
6 1.1 pooka * Redistribution and use in source and binary forms, with or without
7 1.1 pooka * modification, are permitted provided that the following conditions
8 1.1 pooka * are met:
9 1.1 pooka * 1. Redistributions of source code must retain the above copyright
10 1.1 pooka * notice, this list of conditions and the following disclaimer.
11 1.1 pooka * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 pooka * notice, this list of conditions and the following disclaimer in the
13 1.1 pooka * documentation and/or other materials provided with the distribution.
14 1.1 pooka *
15 1.1 pooka * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
16 1.1 pooka * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17 1.1 pooka * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 1.1 pooka * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 1.1 pooka * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 1.1 pooka * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 1.1 pooka * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 1.1 pooka * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 1.1 pooka * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 1.1 pooka * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 1.1 pooka * SUCH DAMAGE.
26 1.1 pooka */
27 1.1 pooka
28 1.1 pooka /*
29 1.1 pooka * Sysproxy routines. This provides system RPC support over host sockets.
30 1.1 pooka * The most notable limitation is that the client and server must share
31 1.1 pooka * the same ABI. This does not mean that they have to be the same
32 1.1 pooka * machine or that they need to run the same version of the host OS,
33 1.1 pooka * just that they must agree on the data structures. This even *might*
34 1.1 pooka * work correctly from one hardware architecture to another.
35 1.1 pooka */
36 1.1 pooka
37 1.1 pooka #include <sys/cdefs.h>
38 1.27 pooka __RCSID("$NetBSD: rumpuser_sp.c,v 1.27 2010/12/16 17:05:44 pooka Exp $");
39 1.1 pooka
40 1.1 pooka #include <sys/types.h>
41 1.11 pooka #include <sys/atomic.h>
42 1.1 pooka #include <sys/mman.h>
43 1.1 pooka #include <sys/socket.h>
44 1.1 pooka
45 1.1 pooka #include <arpa/inet.h>
46 1.1 pooka #include <netinet/in.h>
47 1.1 pooka #include <netinet/tcp.h>
48 1.1 pooka
49 1.1 pooka #include <assert.h>
50 1.1 pooka #include <errno.h>
51 1.1 pooka #include <fcntl.h>
52 1.1 pooka #include <poll.h>
53 1.1 pooka #include <pthread.h>
54 1.1 pooka #include <stdarg.h>
55 1.1 pooka #include <stdio.h>
56 1.1 pooka #include <stdlib.h>
57 1.1 pooka #include <string.h>
58 1.1 pooka #include <unistd.h>
59 1.1 pooka
60 1.1 pooka #include <rump/rumpuser.h>
61 1.13 pooka #include "rumpuser_int.h"
62 1.1 pooka
63 1.5 pooka #include "sp_common.c"
64 1.1 pooka
65 1.20 pooka #ifndef MAXCLI
66 1.18 pooka #define MAXCLI 256
67 1.20 pooka #endif
68 1.20 pooka #ifndef MAXWORKER
69 1.20 pooka #define MAXWORKER 128
70 1.20 pooka #endif
71 1.20 pooka #ifndef IDLEWORKER
72 1.20 pooka #define IDLEWORKER 16
73 1.20 pooka #endif
74 1.20 pooka int rumpsp_maxworker = MAXWORKER;
75 1.20 pooka int rumpsp_idleworker = IDLEWORKER;
76 1.1 pooka
77 1.1 pooka static struct pollfd pfdlist[MAXCLI];
78 1.1 pooka static struct spclient spclist[MAXCLI];
79 1.11 pooka static unsigned int disco;
80 1.24 pooka static volatile int spfini;
81 1.1 pooka
82 1.3 pooka static struct rumpuser_sp_ops spops;
83 1.3 pooka
84 1.26 pooka static char banner[MAXBANNER];
85 1.26 pooka
86 1.26 pooka #define PROTOMAJOR 0
87 1.26 pooka #define PROTOMINOR 0
88 1.26 pooka
89 1.3 pooka /*
90 1.3 pooka * Manual wrappers, since librump does not have access to the
91 1.3 pooka * user namespace wrapped interfaces.
92 1.3 pooka */
93 1.3 pooka
94 1.3 pooka static void
95 1.3 pooka lwproc_switch(struct lwp *l)
96 1.3 pooka {
97 1.3 pooka
98 1.4 pooka spops.spop_schedule();
99 1.3 pooka spops.spop_lwproc_switch(l);
100 1.4 pooka spops.spop_unschedule();
101 1.3 pooka }
102 1.3 pooka
103 1.3 pooka static void
104 1.3 pooka lwproc_release(void)
105 1.3 pooka {
106 1.3 pooka
107 1.4 pooka spops.spop_schedule();
108 1.3 pooka spops.spop_lwproc_release();
109 1.4 pooka spops.spop_unschedule();
110 1.3 pooka }
111 1.3 pooka
112 1.3 pooka static int
113 1.10 pooka lwproc_newproc(struct spclient *spc)
114 1.3 pooka {
115 1.3 pooka int rv;
116 1.3 pooka
117 1.4 pooka spops.spop_schedule();
118 1.10 pooka rv = spops.spop_lwproc_newproc(spc);
119 1.4 pooka spops.spop_unschedule();
120 1.3 pooka
121 1.3 pooka return rv;
122 1.3 pooka }
123 1.3 pooka
124 1.8 pooka static int
125 1.8 pooka lwproc_newlwp(pid_t pid)
126 1.8 pooka {
127 1.8 pooka int rv;
128 1.8 pooka
129 1.8 pooka spops.spop_schedule();
130 1.8 pooka rv = spops.spop_lwproc_newlwp(pid);
131 1.8 pooka spops.spop_unschedule();
132 1.8 pooka
133 1.8 pooka return rv;
134 1.8 pooka }
135 1.8 pooka
136 1.3 pooka static struct lwp *
137 1.3 pooka lwproc_curlwp(void)
138 1.3 pooka {
139 1.3 pooka struct lwp *l;
140 1.3 pooka
141 1.4 pooka spops.spop_schedule();
142 1.3 pooka l = spops.spop_lwproc_curlwp();
143 1.4 pooka spops.spop_unschedule();
144 1.3 pooka
145 1.3 pooka return l;
146 1.3 pooka }
147 1.3 pooka
148 1.8 pooka static pid_t
149 1.8 pooka lwproc_getpid(void)
150 1.8 pooka {
151 1.8 pooka pid_t p;
152 1.8 pooka
153 1.8 pooka spops.spop_schedule();
154 1.8 pooka p = spops.spop_getpid();
155 1.8 pooka spops.spop_unschedule();
156 1.8 pooka
157 1.8 pooka return p;
158 1.8 pooka }
159 1.8 pooka
160 1.3 pooka static int
161 1.3 pooka rumpsyscall(int sysnum, void *data, register_t *retval)
162 1.3 pooka {
163 1.3 pooka int rv;
164 1.3 pooka
165 1.4 pooka spops.spop_schedule();
166 1.3 pooka rv = spops.spop_syscall(sysnum, data, retval);
167 1.4 pooka spops.spop_unschedule();
168 1.3 pooka
169 1.3 pooka return rv;
170 1.3 pooka }
171 1.1 pooka
172 1.7 pooka static uint64_t
173 1.7 pooka nextreq(struct spclient *spc)
174 1.7 pooka {
175 1.7 pooka uint64_t nw;
176 1.7 pooka
177 1.7 pooka pthread_mutex_lock(&spc->spc_mtx);
178 1.7 pooka nw = spc->spc_nextreq++;
179 1.7 pooka pthread_mutex_unlock(&spc->spc_mtx);
180 1.7 pooka
181 1.7 pooka return nw;
182 1.7 pooka }
183 1.7 pooka
184 1.21 pooka static void
185 1.21 pooka send_error_resp(struct spclient *spc, uint64_t reqno, int error)
186 1.21 pooka {
187 1.21 pooka struct rsp_hdr rhdr;
188 1.21 pooka
189 1.21 pooka rhdr.rsp_len = sizeof(rhdr);
190 1.21 pooka rhdr.rsp_reqno = reqno;
191 1.21 pooka rhdr.rsp_class = RUMPSP_ERROR;
192 1.21 pooka rhdr.rsp_type = 0;
193 1.21 pooka rhdr.rsp_error = error;
194 1.21 pooka
195 1.21 pooka sendlock(spc);
196 1.21 pooka (void)dosend(spc, &rhdr, sizeof(rhdr));
197 1.21 pooka sendunlock(spc);
198 1.21 pooka }
199 1.21 pooka
200 1.1 pooka static int
201 1.27 pooka send_handshake_resp(struct spclient *spc, uint64_t reqno, int error)
202 1.27 pooka {
203 1.27 pooka struct rsp_hdr rhdr;
204 1.27 pooka int rv;
205 1.27 pooka
206 1.27 pooka rhdr.rsp_len = sizeof(rhdr) + sizeof(error);
207 1.27 pooka rhdr.rsp_reqno = reqno;
208 1.27 pooka rhdr.rsp_class = RUMPSP_RESP;
209 1.27 pooka rhdr.rsp_type = RUMPSP_HANDSHAKE;
210 1.27 pooka rhdr.rsp_error = 0;
211 1.27 pooka
212 1.27 pooka sendlock(spc);
213 1.27 pooka rv = dosend(spc, &rhdr, sizeof(rhdr));
214 1.27 pooka rv = dosend(spc, &error, sizeof(error));
215 1.27 pooka sendunlock(spc);
216 1.27 pooka
217 1.27 pooka return rv;
218 1.27 pooka }
219 1.27 pooka
220 1.27 pooka static int
221 1.1 pooka send_syscall_resp(struct spclient *spc, uint64_t reqno, int error,
222 1.7 pooka register_t *retval)
223 1.1 pooka {
224 1.1 pooka struct rsp_hdr rhdr;
225 1.1 pooka struct rsp_sysresp sysresp;
226 1.7 pooka int rv;
227 1.1 pooka
228 1.1 pooka rhdr.rsp_len = sizeof(rhdr) + sizeof(sysresp);
229 1.1 pooka rhdr.rsp_reqno = reqno;
230 1.7 pooka rhdr.rsp_class = RUMPSP_RESP;
231 1.7 pooka rhdr.rsp_type = RUMPSP_SYSCALL;
232 1.1 pooka rhdr.rsp_sysnum = 0;
233 1.1 pooka
234 1.1 pooka sysresp.rsys_error = error;
235 1.7 pooka memcpy(sysresp.rsys_retval, retval, sizeof(sysresp.rsys_retval));
236 1.1 pooka
237 1.7 pooka sendlock(spc);
238 1.7 pooka rv = dosend(spc, &rhdr, sizeof(rhdr));
239 1.7 pooka rv = dosend(spc, &sysresp, sizeof(sysresp));
240 1.7 pooka sendunlock(spc);
241 1.1 pooka
242 1.7 pooka return rv;
243 1.1 pooka }
244 1.1 pooka
245 1.1 pooka static int
246 1.15 pooka copyin_req(struct spclient *spc, const void *remaddr, size_t *dlen,
247 1.15 pooka int wantstr, void **resp)
248 1.1 pooka {
249 1.1 pooka struct rsp_hdr rhdr;
250 1.1 pooka struct rsp_copydata copydata;
251 1.7 pooka struct respwait rw;
252 1.7 pooka int rv;
253 1.7 pooka
254 1.15 pooka DPRINTF(("copyin_req: %zu bytes from %p\n", *dlen, remaddr));
255 1.1 pooka
256 1.1 pooka rhdr.rsp_len = sizeof(rhdr) + sizeof(copydata);
257 1.7 pooka rhdr.rsp_class = RUMPSP_REQ;
258 1.15 pooka if (wantstr)
259 1.15 pooka rhdr.rsp_type = RUMPSP_COPYINSTR;
260 1.15 pooka else
261 1.15 pooka rhdr.rsp_type = RUMPSP_COPYIN;
262 1.1 pooka rhdr.rsp_sysnum = 0;
263 1.1 pooka
264 1.1 pooka copydata.rcp_addr = __UNCONST(remaddr);
265 1.15 pooka copydata.rcp_len = *dlen;
266 1.1 pooka
267 1.7 pooka putwait(spc, &rw, &rhdr);
268 1.7 pooka rv = dosend(spc, &rhdr, sizeof(rhdr));
269 1.7 pooka rv = dosend(spc, ©data, sizeof(copydata));
270 1.13 pooka if (rv) {
271 1.13 pooka unputwait(spc, &rw);
272 1.13 pooka return rv;
273 1.13 pooka }
274 1.7 pooka
275 1.7 pooka rv = waitresp(spc, &rw);
276 1.7 pooka
277 1.7 pooka DPRINTF(("copyin: response %d\n", rv));
278 1.7 pooka
279 1.7 pooka *resp = rw.rw_data;
280 1.15 pooka if (wantstr)
281 1.15 pooka *dlen = rw.rw_dlen;
282 1.15 pooka
283 1.7 pooka return rv;
284 1.1 pooka
285 1.1 pooka }
286 1.1 pooka
287 1.1 pooka static int
288 1.1 pooka send_copyout_req(struct spclient *spc, const void *remaddr,
289 1.1 pooka const void *data, size_t dlen)
290 1.1 pooka {
291 1.1 pooka struct rsp_hdr rhdr;
292 1.1 pooka struct rsp_copydata copydata;
293 1.7 pooka int rv;
294 1.7 pooka
295 1.7 pooka DPRINTF(("copyout_req (async): %zu bytes to %p\n", dlen, remaddr));
296 1.1 pooka
297 1.1 pooka rhdr.rsp_len = sizeof(rhdr) + sizeof(copydata) + dlen;
298 1.7 pooka rhdr.rsp_reqno = nextreq(spc);
299 1.7 pooka rhdr.rsp_class = RUMPSP_REQ;
300 1.7 pooka rhdr.rsp_type = RUMPSP_COPYOUT;
301 1.1 pooka rhdr.rsp_sysnum = 0;
302 1.1 pooka
303 1.1 pooka copydata.rcp_addr = __UNCONST(remaddr);
304 1.1 pooka copydata.rcp_len = dlen;
305 1.1 pooka
306 1.7 pooka sendlock(spc);
307 1.7 pooka rv = dosend(spc, &rhdr, sizeof(rhdr));
308 1.7 pooka rv = dosend(spc, ©data, sizeof(copydata));
309 1.7 pooka rv = dosend(spc, data, dlen);
310 1.7 pooka sendunlock(spc);
311 1.1 pooka
312 1.7 pooka return rv;
313 1.1 pooka }
314 1.1 pooka
315 1.1 pooka static int
316 1.7 pooka anonmmap_req(struct spclient *spc, size_t howmuch, void **resp)
317 1.1 pooka {
318 1.1 pooka struct rsp_hdr rhdr;
319 1.7 pooka struct respwait rw;
320 1.7 pooka int rv;
321 1.7 pooka
322 1.7 pooka DPRINTF(("anonmmap_req: %zu bytes\n", howmuch));
323 1.1 pooka
324 1.1 pooka rhdr.rsp_len = sizeof(rhdr) + sizeof(howmuch);
325 1.7 pooka rhdr.rsp_class = RUMPSP_REQ;
326 1.7 pooka rhdr.rsp_type = RUMPSP_ANONMMAP;
327 1.1 pooka rhdr.rsp_sysnum = 0;
328 1.1 pooka
329 1.7 pooka putwait(spc, &rw, &rhdr);
330 1.7 pooka rv = dosend(spc, &rhdr, sizeof(rhdr));
331 1.7 pooka rv = dosend(spc, &howmuch, sizeof(howmuch));
332 1.13 pooka if (rv) {
333 1.13 pooka unputwait(spc, &rw);
334 1.13 pooka return rv;
335 1.13 pooka }
336 1.1 pooka
337 1.7 pooka rv = waitresp(spc, &rw);
338 1.13 pooka
339 1.7 pooka *resp = rw.rw_data;
340 1.7 pooka
341 1.7 pooka DPRINTF(("anonmmap: mapped at %p\n", **(void ***)resp));
342 1.7 pooka
343 1.7 pooka return rv;
344 1.1 pooka }
345 1.1 pooka
346 1.1 pooka static void
347 1.11 pooka spcref(struct spclient *spc)
348 1.11 pooka {
349 1.11 pooka
350 1.11 pooka pthread_mutex_lock(&spc->spc_mtx);
351 1.11 pooka spc->spc_refcnt++;
352 1.11 pooka pthread_mutex_unlock(&spc->spc_mtx);
353 1.11 pooka }
354 1.11 pooka
355 1.11 pooka static void
356 1.11 pooka spcrelease(struct spclient *spc)
357 1.11 pooka {
358 1.11 pooka int ref;
359 1.11 pooka
360 1.11 pooka pthread_mutex_lock(&spc->spc_mtx);
361 1.11 pooka ref = --spc->spc_refcnt;
362 1.11 pooka pthread_mutex_unlock(&spc->spc_mtx);
363 1.11 pooka
364 1.11 pooka if (ref > 0)
365 1.11 pooka return;
366 1.11 pooka
367 1.12 pooka DPRINTF(("spcrelease: spc %p fd %d\n", spc, spc->spc_fd));
368 1.12 pooka
369 1.13 pooka _DIAGASSERT(TAILQ_EMPTY(&spc->spc_respwait));
370 1.11 pooka _DIAGASSERT(spc->spc_buf == NULL);
371 1.11 pooka
372 1.11 pooka lwproc_switch(spc->spc_mainlwp);
373 1.11 pooka lwproc_release();
374 1.11 pooka spc->spc_mainlwp = NULL;
375 1.11 pooka
376 1.11 pooka close(spc->spc_fd);
377 1.11 pooka spc->spc_fd = -1;
378 1.27 pooka spc->spc_state = SPCSTATE_NEW;
379 1.11 pooka
380 1.11 pooka atomic_inc_uint(&disco);
381 1.11 pooka }
382 1.11 pooka
383 1.11 pooka static void
384 1.2 pooka serv_handledisco(unsigned int idx)
385 1.1 pooka {
386 1.1 pooka struct spclient *spc = &spclist[idx];
387 1.1 pooka
388 1.1 pooka DPRINTF(("rump_sp: disconnecting [%u]\n", idx));
389 1.1 pooka
390 1.12 pooka pfdlist[idx].fd = -1;
391 1.12 pooka pfdlist[idx].revents = 0;
392 1.12 pooka pthread_mutex_lock(&spc->spc_mtx);
393 1.27 pooka spc->spc_state = SPCSTATE_DYING;
394 1.12 pooka kickall(spc);
395 1.12 pooka pthread_mutex_unlock(&spc->spc_mtx);
396 1.17 pooka
397 1.17 pooka /*
398 1.17 pooka * Nobody's going to attempt to send/receive anymore,
399 1.17 pooka * so reinit info relevant to that.
400 1.17 pooka */
401 1.22 pooka /*LINTED:pointer casts may be ok*/
402 1.17 pooka memset((char *)spc + SPC_ZEROFF, 0, sizeof(*spc) - SPC_ZEROFF);
403 1.17 pooka
404 1.11 pooka spcrelease(spc);
405 1.1 pooka }
406 1.1 pooka
407 1.24 pooka static void
408 1.24 pooka serv_shutdown(void)
409 1.24 pooka {
410 1.24 pooka struct spclient *spc;
411 1.24 pooka unsigned int i;
412 1.24 pooka
413 1.24 pooka for (i = 1; i < MAXCLI; i++) {
414 1.24 pooka spc = &spclist[i];
415 1.24 pooka if (spc->spc_fd == -1)
416 1.24 pooka continue;
417 1.24 pooka
418 1.24 pooka shutdown(spc->spc_fd, SHUT_RDWR);
419 1.24 pooka serv_handledisco(i);
420 1.24 pooka
421 1.24 pooka spcrelease(spc);
422 1.24 pooka }
423 1.24 pooka }
424 1.24 pooka
425 1.11 pooka static unsigned
426 1.11 pooka serv_handleconn(int fd, connecthook_fn connhook, int busy)
427 1.1 pooka {
428 1.1 pooka struct sockaddr_storage ss;
429 1.1 pooka socklen_t sl = sizeof(ss);
430 1.11 pooka int newfd, flags;
431 1.1 pooka unsigned i;
432 1.1 pooka
433 1.1 pooka /*LINTED: cast ok */
434 1.1 pooka newfd = accept(fd, (struct sockaddr *)&ss, &sl);
435 1.1 pooka if (newfd == -1)
436 1.11 pooka return 0;
437 1.1 pooka
438 1.11 pooka if (busy) {
439 1.1 pooka close(newfd); /* EBUSY */
440 1.11 pooka return 0;
441 1.1 pooka }
442 1.1 pooka
443 1.1 pooka flags = fcntl(newfd, F_GETFL, 0);
444 1.1 pooka if (fcntl(newfd, F_SETFL, flags | O_NONBLOCK) == -1) {
445 1.1 pooka close(newfd);
446 1.11 pooka return 0;
447 1.1 pooka }
448 1.1 pooka
449 1.11 pooka if (connhook(newfd) != 0) {
450 1.1 pooka close(newfd);
451 1.11 pooka return 0;
452 1.1 pooka }
453 1.1 pooka
454 1.26 pooka /* write out a banner for the client */
455 1.26 pooka if (write(newfd, banner, strlen(banner)) != (ssize_t)strlen(banner)) {
456 1.26 pooka close(newfd);
457 1.26 pooka return 0;
458 1.26 pooka }
459 1.26 pooka
460 1.1 pooka /* find empty slot the simple way */
461 1.1 pooka for (i = 0; i < MAXCLI; i++) {
462 1.27 pooka if (pfdlist[i].fd == -1 && spclist[i].spc_state == SPCSTATE_NEW)
463 1.2 pooka break;
464 1.1 pooka }
465 1.1 pooka
466 1.11 pooka if (lwproc_newproc(&spclist[i]) != 0) {
467 1.10 pooka close(newfd);
468 1.11 pooka return 0;
469 1.10 pooka }
470 1.10 pooka
471 1.1 pooka assert(i < MAXCLI);
472 1.1 pooka
473 1.1 pooka pfdlist[i].fd = newfd;
474 1.1 pooka spclist[i].spc_fd = newfd;
475 1.8 pooka spclist[i].spc_mainlwp = lwproc_curlwp();
476 1.7 pooka spclist[i].spc_istatus = SPCSTATUS_BUSY; /* dedicated receiver */
477 1.8 pooka spclist[i].spc_pid = lwproc_getpid();
478 1.11 pooka spclist[i].spc_refcnt = 1;
479 1.7 pooka
480 1.7 pooka TAILQ_INIT(&spclist[i].spc_respwait);
481 1.1 pooka
482 1.13 pooka DPRINTF(("rump_sp: added new connection fd %d at idx %u, pid %d\n",
483 1.13 pooka newfd, i, lwproc_getpid()));
484 1.2 pooka
485 1.3 pooka lwproc_switch(NULL);
486 1.1 pooka
487 1.11 pooka return i;
488 1.1 pooka }
489 1.1 pooka
490 1.1 pooka static void
491 1.1 pooka serv_handlesyscall(struct spclient *spc, struct rsp_hdr *rhdr, uint8_t *data)
492 1.1 pooka {
493 1.7 pooka register_t retval[2] = {0, 0};
494 1.1 pooka int rv, sysnum;
495 1.1 pooka
496 1.1 pooka sysnum = (int)rhdr->rsp_sysnum;
497 1.1 pooka DPRINTF(("rump_sp: handling syscall %d from client %d\n",
498 1.1 pooka sysnum, 0));
499 1.1 pooka
500 1.8 pooka lwproc_newlwp(spc->spc_pid);
501 1.3 pooka rv = rumpsyscall(sysnum, data, retval);
502 1.16 pooka lwproc_release();
503 1.1 pooka
504 1.7 pooka DPRINTF(("rump_sp: got return value %d & %d/%d\n",
505 1.7 pooka rv, retval[0], retval[1]));
506 1.5 pooka
507 1.1 pooka send_syscall_resp(spc, rhdr->rsp_reqno, rv, retval);
508 1.1 pooka }
509 1.1 pooka
510 1.7 pooka struct sysbouncearg {
511 1.7 pooka struct spclient *sba_spc;
512 1.7 pooka struct rsp_hdr sba_hdr;
513 1.7 pooka uint8_t *sba_data;
514 1.20 pooka
515 1.20 pooka TAILQ_ENTRY(sysbouncearg) sba_entries;
516 1.7 pooka };
517 1.20 pooka static pthread_mutex_t sbamtx;
518 1.20 pooka static pthread_cond_t sbacv;
519 1.20 pooka static int nworker, idleworker;
520 1.20 pooka static TAILQ_HEAD(, sysbouncearg) syslist = TAILQ_HEAD_INITIALIZER(syslist);
521 1.20 pooka
522 1.20 pooka /*ARGSUSED*/
523 1.7 pooka static void *
524 1.7 pooka serv_syscallbouncer(void *arg)
525 1.7 pooka {
526 1.20 pooka struct sysbouncearg *sba;
527 1.20 pooka
528 1.20 pooka for (;;) {
529 1.20 pooka pthread_mutex_lock(&sbamtx);
530 1.20 pooka if (idleworker >= rumpsp_idleworker) {
531 1.20 pooka nworker--;
532 1.20 pooka pthread_mutex_unlock(&sbamtx);
533 1.20 pooka break;
534 1.20 pooka }
535 1.20 pooka idleworker++;
536 1.20 pooka while (TAILQ_EMPTY(&syslist)) {
537 1.20 pooka pthread_cond_wait(&sbacv, &sbamtx);
538 1.20 pooka }
539 1.20 pooka
540 1.20 pooka sba = TAILQ_FIRST(&syslist);
541 1.20 pooka TAILQ_REMOVE(&syslist, sba, sba_entries);
542 1.20 pooka idleworker--;
543 1.20 pooka pthread_mutex_unlock(&sbamtx);
544 1.20 pooka
545 1.20 pooka serv_handlesyscall(sba->sba_spc,
546 1.20 pooka &sba->sba_hdr, sba->sba_data);
547 1.20 pooka spcrelease(sba->sba_spc);
548 1.20 pooka free(sba->sba_data);
549 1.20 pooka free(sba);
550 1.20 pooka }
551 1.7 pooka
552 1.7 pooka return NULL;
553 1.7 pooka }
554 1.7 pooka
555 1.15 pooka static int
556 1.15 pooka sp_copyin(void *arg, const void *raddr, void *laddr, size_t *len, int wantstr)
557 1.1 pooka {
558 1.10 pooka struct spclient *spc = arg;
559 1.9 pooka void *rdata = NULL; /* XXXuninit */
560 1.13 pooka int rv, nlocks;
561 1.13 pooka
562 1.13 pooka rumpuser__kunlock(0, &nlocks, NULL);
563 1.1 pooka
564 1.15 pooka rv = copyin_req(spc, raddr, len, wantstr, &rdata);
565 1.12 pooka if (rv)
566 1.13 pooka goto out;
567 1.1 pooka
568 1.15 pooka memcpy(laddr, rdata, *len);
569 1.7 pooka free(rdata);
570 1.1 pooka
571 1.13 pooka out:
572 1.13 pooka rumpuser__klock(nlocks, NULL);
573 1.13 pooka if (rv)
574 1.13 pooka return EFAULT;
575 1.1 pooka return 0;
576 1.1 pooka }
577 1.1 pooka
578 1.1 pooka int
579 1.15 pooka rumpuser_sp_copyin(void *arg, const void *raddr, void *laddr, size_t len)
580 1.15 pooka {
581 1.15 pooka
582 1.15 pooka return sp_copyin(arg, raddr, laddr, &len, 0);
583 1.15 pooka }
584 1.15 pooka
585 1.15 pooka int
586 1.15 pooka rumpuser_sp_copyinstr(void *arg, const void *raddr, void *laddr, size_t *len)
587 1.15 pooka {
588 1.15 pooka
589 1.15 pooka return sp_copyin(arg, raddr, laddr, len, 1);
590 1.15 pooka }
591 1.15 pooka
592 1.15 pooka static int
593 1.15 pooka sp_copyout(void *arg, const void *laddr, void *raddr, size_t dlen)
594 1.1 pooka {
595 1.10 pooka struct spclient *spc = arg;
596 1.13 pooka int nlocks, rv;
597 1.13 pooka
598 1.13 pooka rumpuser__kunlock(0, &nlocks, NULL);
599 1.15 pooka rv = send_copyout_req(spc, raddr, laddr, dlen);
600 1.13 pooka rumpuser__klock(nlocks, NULL);
601 1.1 pooka
602 1.13 pooka if (rv)
603 1.7 pooka return EFAULT;
604 1.1 pooka return 0;
605 1.1 pooka }
606 1.1 pooka
607 1.1 pooka int
608 1.15 pooka rumpuser_sp_copyout(void *arg, const void *laddr, void *raddr, size_t dlen)
609 1.15 pooka {
610 1.15 pooka
611 1.15 pooka return sp_copyout(arg, laddr, raddr, dlen);
612 1.15 pooka }
613 1.15 pooka
614 1.15 pooka int
615 1.15 pooka rumpuser_sp_copyoutstr(void *arg, const void *laddr, void *raddr, size_t *dlen)
616 1.15 pooka {
617 1.15 pooka
618 1.15 pooka return sp_copyout(arg, laddr, raddr, *dlen);
619 1.15 pooka }
620 1.15 pooka
621 1.15 pooka int
622 1.10 pooka rumpuser_sp_anonmmap(void *arg, size_t howmuch, void **addr)
623 1.1 pooka {
624 1.10 pooka struct spclient *spc = arg;
625 1.7 pooka void *resp, *rdata;
626 1.13 pooka int nlocks, rv;
627 1.13 pooka
628 1.13 pooka rumpuser__kunlock(0, &nlocks, NULL);
629 1.1 pooka
630 1.7 pooka rv = anonmmap_req(spc, howmuch, &rdata);
631 1.13 pooka if (rv) {
632 1.13 pooka rv = EFAULT;
633 1.13 pooka goto out;
634 1.13 pooka }
635 1.1 pooka
636 1.7 pooka resp = *(void **)rdata;
637 1.7 pooka free(rdata);
638 1.1 pooka
639 1.7 pooka if (resp == NULL) {
640 1.13 pooka rv = ENOMEM;
641 1.1 pooka }
642 1.1 pooka
643 1.1 pooka *addr = resp;
644 1.13 pooka
645 1.13 pooka out:
646 1.13 pooka rumpuser__klock(nlocks, NULL);
647 1.13 pooka
648 1.13 pooka if (rv)
649 1.13 pooka return rv;
650 1.1 pooka return 0;
651 1.1 pooka }
652 1.1 pooka
653 1.1 pooka /*
654 1.1 pooka *
655 1.1 pooka * Startup routines and mainloop for server.
656 1.1 pooka *
657 1.1 pooka */
658 1.1 pooka
659 1.1 pooka struct spservarg {
660 1.1 pooka int sps_sock;
661 1.1 pooka connecthook_fn sps_connhook;
662 1.1 pooka };
663 1.1 pooka
664 1.14 pooka static pthread_attr_t pattr_detached;
665 1.7 pooka static void
666 1.7 pooka handlereq(struct spclient *spc)
667 1.7 pooka {
668 1.7 pooka struct sysbouncearg *sba;
669 1.7 pooka pthread_t pt;
670 1.27 pooka int retries, rv;
671 1.27 pooka
672 1.27 pooka if (__predict_false(spc->spc_state == SPCSTATE_NEW)) {
673 1.27 pooka if (spc->spc_hdr.rsp_type != RUMPSP_HANDSHAKE) {
674 1.27 pooka send_error_resp(spc, spc->spc_hdr.rsp_reqno, EAUTH);
675 1.27 pooka spcfreebuf(spc);
676 1.27 pooka return;
677 1.27 pooka }
678 1.27 pooka
679 1.27 pooka rv = send_handshake_resp(spc, spc->spc_hdr.rsp_reqno, 0);
680 1.27 pooka spcfreebuf(spc);
681 1.27 pooka if (rv) {
682 1.27 pooka shutdown(spc->spc_fd, SHUT_RDWR);
683 1.27 pooka return;
684 1.27 pooka }
685 1.27 pooka spc->spc_state = SPCSTATE_RUNNING;
686 1.27 pooka return;
687 1.27 pooka }
688 1.7 pooka
689 1.21 pooka if (__predict_false(spc->spc_hdr.rsp_type != RUMPSP_SYSCALL)) {
690 1.21 pooka send_error_resp(spc, spc->spc_hdr.rsp_reqno, EINVAL);
691 1.21 pooka spcfreebuf(spc);
692 1.21 pooka return;
693 1.21 pooka }
694 1.7 pooka
695 1.21 pooka retries = 0;
696 1.21 pooka while ((sba = malloc(sizeof(*sba))) == NULL) {
697 1.21 pooka if (nworker == 0 || retries > 10) {
698 1.21 pooka send_error_resp(spc, spc->spc_hdr.rsp_reqno, EAGAIN);
699 1.21 pooka spcfreebuf(spc);
700 1.21 pooka return;
701 1.21 pooka }
702 1.21 pooka /* slim chance of more memory? */
703 1.21 pooka usleep(10000);
704 1.7 pooka }
705 1.7 pooka
706 1.7 pooka sba->sba_spc = spc;
707 1.7 pooka sba->sba_hdr = spc->spc_hdr;
708 1.7 pooka sba->sba_data = spc->spc_buf;
709 1.21 pooka spcresetbuf(spc);
710 1.7 pooka
711 1.11 pooka spcref(spc);
712 1.20 pooka
713 1.20 pooka pthread_mutex_lock(&sbamtx);
714 1.20 pooka TAILQ_INSERT_TAIL(&syslist, sba, sba_entries);
715 1.20 pooka if (idleworker > 0) {
716 1.20 pooka /* do we have a daemon's tool (i.e. idle threads)? */
717 1.20 pooka pthread_cond_signal(&sbacv);
718 1.20 pooka } else if (nworker < rumpsp_maxworker) {
719 1.20 pooka /*
720 1.20 pooka * Else, need to create one
721 1.20 pooka * (if we can, otherwise just expect another
722 1.20 pooka * worker to pick up the syscall)
723 1.20 pooka */
724 1.20 pooka if (pthread_create(&pt, &pattr_detached,
725 1.20 pooka serv_syscallbouncer, NULL) == 0)
726 1.20 pooka nworker++;
727 1.7 pooka }
728 1.20 pooka pthread_mutex_unlock(&sbamtx);
729 1.7 pooka }
730 1.7 pooka
731 1.1 pooka static void *
732 1.1 pooka spserver(void *arg)
733 1.1 pooka {
734 1.1 pooka struct spservarg *sarg = arg;
735 1.11 pooka struct spclient *spc;
736 1.1 pooka unsigned idx;
737 1.1 pooka int seen;
738 1.1 pooka int rv;
739 1.11 pooka unsigned int nfds, maxidx;
740 1.1 pooka
741 1.11 pooka for (idx = 0; idx < MAXCLI; idx++) {
742 1.1 pooka pfdlist[idx].fd = -1;
743 1.1 pooka pfdlist[idx].events = POLLIN;
744 1.11 pooka
745 1.11 pooka spc = &spclist[idx];
746 1.11 pooka pthread_mutex_init(&spc->spc_mtx, NULL);
747 1.11 pooka pthread_cond_init(&spc->spc_cv, NULL);
748 1.24 pooka spc->spc_fd = -1;
749 1.1 pooka }
750 1.24 pooka pfdlist[0].fd = spclist[0].spc_fd = sarg->sps_sock;
751 1.1 pooka pfdlist[0].events = POLLIN;
752 1.1 pooka nfds = 1;
753 1.1 pooka maxidx = 0;
754 1.1 pooka
755 1.14 pooka pthread_attr_init(&pattr_detached);
756 1.14 pooka pthread_attr_setdetachstate(&pattr_detached, PTHREAD_CREATE_DETACHED);
757 1.19 pooka /* XXX: doesn't stacksize currently work on NetBSD */
758 1.19 pooka pthread_attr_setstacksize(&pattr_detached, 32*1024);
759 1.14 pooka
760 1.20 pooka pthread_mutex_init(&sbamtx, NULL);
761 1.20 pooka pthread_cond_init(&sbacv, NULL);
762 1.20 pooka
763 1.1 pooka DPRINTF(("rump_sp: server mainloop\n"));
764 1.1 pooka
765 1.1 pooka for (;;) {
766 1.18 pooka int discoed;
767 1.18 pooka
768 1.11 pooka /* g/c hangarounds (eventually) */
769 1.18 pooka discoed = atomic_swap_uint(&disco, 0);
770 1.18 pooka while (discoed--) {
771 1.18 pooka nfds--;
772 1.18 pooka idx = maxidx;
773 1.18 pooka while (idx) {
774 1.18 pooka if (pfdlist[idx].fd != -1) {
775 1.18 pooka maxidx = idx;
776 1.18 pooka break;
777 1.11 pooka }
778 1.18 pooka idx--;
779 1.11 pooka }
780 1.18 pooka DPRINTF(("rump_sp: set maxidx to [%u]\n",
781 1.18 pooka maxidx));
782 1.11 pooka }
783 1.11 pooka
784 1.1 pooka DPRINTF(("rump_sp: loop nfd %d\n", maxidx+1));
785 1.1 pooka seen = 0;
786 1.1 pooka rv = poll(pfdlist, maxidx+1, INFTIM);
787 1.1 pooka assert(maxidx+1 <= MAXCLI);
788 1.1 pooka assert(rv != 0);
789 1.1 pooka if (rv == -1) {
790 1.1 pooka if (errno == EINTR)
791 1.1 pooka continue;
792 1.1 pooka fprintf(stderr, "rump_spserver: poll returned %d\n",
793 1.1 pooka errno);
794 1.1 pooka break;
795 1.1 pooka }
796 1.1 pooka
797 1.12 pooka for (idx = 0; seen < rv && idx < MAXCLI; idx++) {
798 1.1 pooka if ((pfdlist[idx].revents & POLLIN) == 0)
799 1.1 pooka continue;
800 1.1 pooka
801 1.1 pooka seen++;
802 1.1 pooka DPRINTF(("rump_sp: activity at [%u] %d/%d\n",
803 1.1 pooka idx, seen, rv));
804 1.1 pooka if (idx > 0) {
805 1.11 pooka spc = &spclist[idx];
806 1.1 pooka DPRINTF(("rump_sp: mainloop read [%u]\n", idx));
807 1.1 pooka switch (readframe(spc)) {
808 1.1 pooka case 0:
809 1.1 pooka break;
810 1.1 pooka case -1:
811 1.2 pooka serv_handledisco(idx);
812 1.1 pooka break;
813 1.1 pooka default:
814 1.7 pooka switch (spc->spc_hdr.rsp_class) {
815 1.7 pooka case RUMPSP_RESP:
816 1.7 pooka kickwaiter(spc);
817 1.7 pooka break;
818 1.7 pooka case RUMPSP_REQ:
819 1.7 pooka handlereq(spc);
820 1.7 pooka break;
821 1.7 pooka default:
822 1.21 pooka send_error_resp(spc,
823 1.21 pooka spc->spc_hdr.rsp_reqno,
824 1.21 pooka ENOENT);
825 1.21 pooka spcfreebuf(spc);
826 1.7 pooka break;
827 1.7 pooka }
828 1.1 pooka break;
829 1.1 pooka }
830 1.11 pooka
831 1.1 pooka } else {
832 1.1 pooka DPRINTF(("rump_sp: mainloop new connection\n"));
833 1.11 pooka
834 1.24 pooka if (__predict_false(spfini)) {
835 1.24 pooka close(spclist[0].spc_fd);
836 1.24 pooka serv_shutdown();
837 1.24 pooka goto out;
838 1.24 pooka }
839 1.24 pooka
840 1.11 pooka idx = serv_handleconn(pfdlist[0].fd,
841 1.11 pooka sarg->sps_connhook, nfds == MAXCLI);
842 1.11 pooka if (idx)
843 1.11 pooka nfds++;
844 1.11 pooka if (idx > maxidx)
845 1.11 pooka maxidx = idx;
846 1.12 pooka DPRINTF(("rump_sp: maxid now %d\n", maxidx));
847 1.1 pooka }
848 1.1 pooka }
849 1.1 pooka }
850 1.1 pooka
851 1.24 pooka out:
852 1.1 pooka return NULL;
853 1.1 pooka }
854 1.1 pooka
855 1.25 pooka static unsigned cleanupidx;
856 1.25 pooka static struct sockaddr *cleanupsa;
857 1.1 pooka int
858 1.26 pooka rumpuser_sp_init(const char *url, const struct rumpuser_sp_ops *spopsp,
859 1.26 pooka const char *ostype, const char *osrelease, const char *machine)
860 1.1 pooka {
861 1.5 pooka pthread_t pt;
862 1.1 pooka struct spservarg *sarg;
863 1.1 pooka struct sockaddr *sap;
864 1.5 pooka char *p;
865 1.5 pooka unsigned idx;
866 1.5 pooka int error, s;
867 1.5 pooka
868 1.5 pooka p = strdup(url);
869 1.5 pooka if (p == NULL)
870 1.5 pooka return ENOMEM;
871 1.5 pooka error = parseurl(p, &sap, &idx, 1);
872 1.5 pooka free(p);
873 1.5 pooka if (error)
874 1.5 pooka return error;
875 1.5 pooka
876 1.26 pooka snprintf(banner, sizeof(banner), "RUMPSP-%d.%d-%s-%s/%s\n",
877 1.26 pooka PROTOMAJOR, PROTOMINOR, ostype, osrelease, machine);
878 1.26 pooka
879 1.5 pooka s = socket(parsetab[idx].domain, SOCK_STREAM, 0);
880 1.5 pooka if (s == -1)
881 1.5 pooka return errno;
882 1.1 pooka
883 1.3 pooka spops = *spopsp;
884 1.5 pooka sarg = malloc(sizeof(*sarg));
885 1.5 pooka if (sarg == NULL) {
886 1.5 pooka close(s);
887 1.5 pooka return ENOMEM;
888 1.5 pooka }
889 1.5 pooka
890 1.5 pooka sarg->sps_sock = s;
891 1.5 pooka sarg->sps_connhook = parsetab[idx].connhook;
892 1.1 pooka
893 1.25 pooka cleanupidx = idx;
894 1.25 pooka cleanupsa = sap;
895 1.25 pooka
896 1.5 pooka /* sloppy error recovery */
897 1.1 pooka
898 1.5 pooka /*LINTED*/
899 1.5 pooka if (bind(s, sap, sap->sa_len) == -1) {
900 1.5 pooka fprintf(stderr, "rump_sp: server bind failed\n");
901 1.5 pooka return errno;
902 1.1 pooka }
903 1.25 pooka
904 1.18 pooka if (listen(s, MAXCLI) == -1) {
905 1.5 pooka fprintf(stderr, "rump_sp: server listen failed\n");
906 1.5 pooka return errno;
907 1.1 pooka }
908 1.1 pooka
909 1.5 pooka if ((error = pthread_create(&pt, NULL, spserver, sarg)) != 0) {
910 1.5 pooka fprintf(stderr, "rump_sp: cannot create wrkr thread\n");
911 1.1 pooka return errno;
912 1.1 pooka }
913 1.5 pooka pthread_detach(pt);
914 1.1 pooka
915 1.1 pooka return 0;
916 1.1 pooka }
917 1.24 pooka
918 1.24 pooka void
919 1.24 pooka rumpuser_sp_fini()
920 1.24 pooka {
921 1.24 pooka
922 1.24 pooka if (spclist[0].spc_fd) {
923 1.25 pooka parsetab[cleanupidx].cleanup(cleanupsa);
924 1.24 pooka shutdown(spclist[0].spc_fd, SHUT_RDWR);
925 1.24 pooka spfini = 1;
926 1.24 pooka }
927 1.24 pooka }
928