Update OpenBIOS images to r771
[qemu/aliguori-queue.git] / slirp / misc.c
blob1aeb401082d5955f11692787c2f198dd9276b3c6
1 /*
2 * Copyright (c) 1995 Danny Gasparovski.
4 * Please read the file COPYRIGHT for the
5 * terms and conditions of the copyright.
6 */
8 #include <slirp.h>
9 #include <libslirp.h>
11 #include "monitor.h"
13 #ifdef DEBUG
14 int slirp_debug = DBG_CALL|DBG_MISC|DBG_ERROR;
15 #endif
17 struct quehead {
18 struct quehead *qh_link;
19 struct quehead *qh_rlink;
22 inline void
23 insque(void *a, void *b)
25 register struct quehead *element = (struct quehead *) a;
26 register struct quehead *head = (struct quehead *) b;
27 element->qh_link = head->qh_link;
28 head->qh_link = (struct quehead *)element;
29 element->qh_rlink = (struct quehead *)head;
30 ((struct quehead *)(element->qh_link))->qh_rlink
31 = (struct quehead *)element;
34 inline void
35 remque(void *a)
37 register struct quehead *element = (struct quehead *) a;
38 ((struct quehead *)(element->qh_link))->qh_rlink = element->qh_rlink;
39 ((struct quehead *)(element->qh_rlink))->qh_link = element->qh_link;
40 element->qh_rlink = NULL;
43 int add_exec(struct ex_list **ex_ptr, int do_pty, char *exec,
44 struct in_addr addr, int port)
46 struct ex_list *tmp_ptr;
48 /* First, check if the port is "bound" */
49 for (tmp_ptr = *ex_ptr; tmp_ptr; tmp_ptr = tmp_ptr->ex_next) {
50 if (port == tmp_ptr->ex_fport &&
51 addr.s_addr == tmp_ptr->ex_addr.s_addr)
52 return -1;
55 tmp_ptr = *ex_ptr;
56 *ex_ptr = (struct ex_list *)malloc(sizeof(struct ex_list));
57 (*ex_ptr)->ex_fport = port;
58 (*ex_ptr)->ex_addr = addr;
59 (*ex_ptr)->ex_pty = do_pty;
60 (*ex_ptr)->ex_exec = (do_pty == 3) ? exec : strdup(exec);
61 (*ex_ptr)->ex_next = tmp_ptr;
62 return 0;
65 #ifndef HAVE_STRERROR
68 * For systems with no strerror
71 extern int sys_nerr;
72 extern char *sys_errlist[];
74 char *
75 strerror(error)
76 int error;
78 if (error < sys_nerr)
79 return sys_errlist[error];
80 else
81 return "Unknown error.";
84 #endif
87 #ifdef _WIN32
89 int
90 fork_exec(struct socket *so, const char *ex, int do_pty)
92 /* not implemented */
93 return 0;
96 #else
99 * XXX This is ugly
100 * We create and bind a socket, then fork off to another
101 * process, which connects to this socket, after which we
102 * exec the wanted program. If something (strange) happens,
103 * the accept() call could block us forever.
105 * do_pty = 0 Fork/exec inetd style
106 * do_pty = 1 Fork/exec using slirp.telnetd
107 * do_ptr = 2 Fork/exec using pty
110 fork_exec(struct socket *so, const char *ex, int do_pty)
112 int s;
113 struct sockaddr_in addr;
114 socklen_t addrlen = sizeof(addr);
115 int opt;
116 int master = -1;
117 const char *argv[256];
118 /* don't want to clobber the original */
119 char *bptr;
120 const char *curarg;
121 int c, i, ret;
123 DEBUG_CALL("fork_exec");
124 DEBUG_ARG("so = %lx", (long)so);
125 DEBUG_ARG("ex = %lx", (long)ex);
126 DEBUG_ARG("do_pty = %lx", (long)do_pty);
128 if (do_pty == 2) {
129 return 0;
130 } else {
131 addr.sin_family = AF_INET;
132 addr.sin_port = 0;
133 addr.sin_addr.s_addr = INADDR_ANY;
135 if ((s = qemu_socket(AF_INET, SOCK_STREAM, 0)) < 0 ||
136 bind(s, (struct sockaddr *)&addr, addrlen) < 0 ||
137 listen(s, 1) < 0) {
138 lprint("Error: inet socket: %s\n", strerror(errno));
139 closesocket(s);
141 return 0;
145 switch(fork()) {
146 case -1:
147 lprint("Error: fork failed: %s\n", strerror(errno));
148 close(s);
149 if (do_pty == 2)
150 close(master);
151 return 0;
153 case 0:
154 /* Set the DISPLAY */
155 if (do_pty == 2) {
156 (void) close(master);
157 #ifdef TIOCSCTTY /* XXXXX */
158 (void) setsid();
159 ioctl(s, TIOCSCTTY, (char *)NULL);
160 #endif
161 } else {
162 getsockname(s, (struct sockaddr *)&addr, &addrlen);
163 close(s);
165 * Connect to the socket
166 * XXX If any of these fail, we're in trouble!
168 s = qemu_socket(AF_INET, SOCK_STREAM, 0);
169 addr.sin_addr = loopback_addr;
170 do {
171 ret = connect(s, (struct sockaddr *)&addr, addrlen);
172 } while (ret < 0 && errno == EINTR);
175 dup2(s, 0);
176 dup2(s, 1);
177 dup2(s, 2);
178 for (s = getdtablesize() - 1; s >= 3; s--)
179 close(s);
181 i = 0;
182 bptr = qemu_strdup(ex); /* No need to free() this */
183 if (do_pty == 1) {
184 /* Setup "slirp.telnetd -x" */
185 argv[i++] = "slirp.telnetd";
186 argv[i++] = "-x";
187 argv[i++] = bptr;
188 } else
189 do {
190 /* Change the string into argv[] */
191 curarg = bptr;
192 while (*bptr != ' ' && *bptr != (char)0)
193 bptr++;
194 c = *bptr;
195 *bptr++ = (char)0;
196 argv[i++] = strdup(curarg);
197 } while (c);
199 argv[i] = NULL;
200 execvp(argv[0], (char **)argv);
202 /* Ooops, failed, let's tell the user why */
203 fprintf(stderr, "Error: execvp of %s failed: %s\n",
204 argv[0], strerror(errno));
205 close(0); close(1); close(2); /* XXX */
206 exit(1);
208 default:
209 if (do_pty == 2) {
210 close(s);
211 so->s = master;
212 } else {
214 * XXX this could block us...
215 * XXX Should set a timer here, and if accept() doesn't
216 * return after X seconds, declare it a failure
217 * The only reason this will block forever is if socket()
218 * of connect() fail in the child process
220 do {
221 so->s = accept(s, (struct sockaddr *)&addr, &addrlen);
222 } while (so->s < 0 && errno == EINTR);
223 closesocket(s);
224 opt = 1;
225 setsockopt(so->s,SOL_SOCKET,SO_REUSEADDR,(char *)&opt,sizeof(int));
226 opt = 1;
227 setsockopt(so->s,SOL_SOCKET,SO_OOBINLINE,(char *)&opt,sizeof(int));
229 fd_nonblock(so->s);
231 /* Append the telnet options now */
232 if (so->so_m != NULL && do_pty == 1) {
233 sbappend(so, so->so_m);
234 so->so_m = NULL;
237 return 1;
240 #endif
242 #ifndef HAVE_STRDUP
243 char *
244 strdup(str)
245 const char *str;
247 char *bptr;
249 bptr = (char *)malloc(strlen(str)+1);
250 strcpy(bptr, str);
252 return bptr;
254 #endif
256 #include "monitor.h"
258 void lprint(const char *format, ...)
260 va_list args;
262 va_start(args, format);
263 monitor_vprintf(default_mon, format, args);
264 va_end(args);
267 #ifdef BAD_SPRINTF
269 #undef vsprintf
270 #undef sprintf
273 * Some BSD-derived systems have a sprintf which returns char *
277 vsprintf_len(string, format, args)
278 char *string;
279 const char *format;
280 va_list args;
282 vsprintf(string, format, args);
283 return strlen(string);
287 #ifdef __STDC__
288 sprintf_len(char *string, const char *format, ...)
289 #else
290 sprintf_len(va_alist) va_dcl
291 #endif
293 va_list args;
294 #ifdef __STDC__
295 va_start(args, format);
296 #else
297 char *string;
298 char *format;
299 va_start(args);
300 string = va_arg(args, char *);
301 format = va_arg(args, char *);
302 #endif
303 vsprintf(string, format, args);
304 return strlen(string);
307 #endif
309 void
310 u_sleep(int usec)
312 struct timeval t;
313 fd_set fdset;
315 FD_ZERO(&fdset);
317 t.tv_sec = 0;
318 t.tv_usec = usec * 1000;
320 select(0, &fdset, &fdset, &fdset, &t);
324 * Set fd blocking and non-blocking
327 void
328 fd_nonblock(int fd)
330 #ifdef FIONBIO
331 #ifdef _WIN32
332 unsigned long opt = 1;
333 #else
334 int opt = 1;
335 #endif
337 ioctlsocket(fd, FIONBIO, &opt);
338 #else
339 int opt;
341 opt = fcntl(fd, F_GETFL, 0);
342 opt |= O_NONBLOCK;
343 fcntl(fd, F_SETFL, opt);
344 #endif
347 void
348 fd_block(int fd)
350 #ifdef FIONBIO
351 #ifdef _WIN32
352 unsigned long opt = 0;
353 #else
354 int opt = 0;
355 #endif
357 ioctlsocket(fd, FIONBIO, &opt);
358 #else
359 int opt;
361 opt = fcntl(fd, F_GETFL, 0);
362 opt &= ~O_NONBLOCK;
363 fcntl(fd, F_SETFL, opt);
364 #endif
367 void slirp_connection_info(Slirp *slirp, Monitor *mon)
369 const char * const tcpstates[] = {
370 [TCPS_CLOSED] = "CLOSED",
371 [TCPS_LISTEN] = "LISTEN",
372 [TCPS_SYN_SENT] = "SYN_SENT",
373 [TCPS_SYN_RECEIVED] = "SYN_RCVD",
374 [TCPS_ESTABLISHED] = "ESTABLISHED",
375 [TCPS_CLOSE_WAIT] = "CLOSE_WAIT",
376 [TCPS_FIN_WAIT_1] = "FIN_WAIT_1",
377 [TCPS_CLOSING] = "CLOSING",
378 [TCPS_LAST_ACK] = "LAST_ACK",
379 [TCPS_FIN_WAIT_2] = "FIN_WAIT_2",
380 [TCPS_TIME_WAIT] = "TIME_WAIT",
382 struct in_addr dst_addr;
383 struct sockaddr_in src;
384 socklen_t src_len;
385 uint16_t dst_port;
386 struct socket *so;
387 const char *state;
388 char buf[20];
389 int n;
391 monitor_printf(mon, " Protocol[State] FD Source Address Port "
392 "Dest. Address Port RecvQ SendQ\n");
394 for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) {
395 if (so->so_state & SS_HOSTFWD) {
396 state = "HOST_FORWARD";
397 } else if (so->so_tcpcb) {
398 state = tcpstates[so->so_tcpcb->t_state];
399 } else {
400 state = "NONE";
402 if (so->so_state & (SS_HOSTFWD | SS_INCOMING)) {
403 src_len = sizeof(src);
404 getsockname(so->s, (struct sockaddr *)&src, &src_len);
405 dst_addr = so->so_laddr;
406 dst_port = so->so_lport;
407 } else {
408 src.sin_addr = so->so_laddr;
409 src.sin_port = so->so_lport;
410 dst_addr = so->so_faddr;
411 dst_port = so->so_fport;
413 n = snprintf(buf, sizeof(buf), " TCP[%s]", state);
414 memset(&buf[n], ' ', 19 - n);
415 buf[19] = 0;
416 monitor_printf(mon, "%s %3d %15s %5d ", buf, so->s,
417 src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
418 ntohs(src.sin_port));
419 monitor_printf(mon, "%15s %5d %5d %5d\n",
420 inet_ntoa(dst_addr), ntohs(dst_port),
421 so->so_rcv.sb_cc, so->so_snd.sb_cc);
424 for (so = slirp->udb.so_next; so != &slirp->udb; so = so->so_next) {
425 if (so->so_state & SS_HOSTFWD) {
426 n = snprintf(buf, sizeof(buf), " UDP[HOST_FORWARD]");
427 src_len = sizeof(src);
428 getsockname(so->s, (struct sockaddr *)&src, &src_len);
429 dst_addr = so->so_laddr;
430 dst_port = so->so_lport;
431 } else {
432 n = snprintf(buf, sizeof(buf), " UDP[%d sec]",
433 (so->so_expire - curtime) / 1000);
434 src.sin_addr = so->so_laddr;
435 src.sin_port = so->so_lport;
436 dst_addr = so->so_faddr;
437 dst_port = so->so_fport;
439 memset(&buf[n], ' ', 19 - n);
440 buf[19] = 0;
441 monitor_printf(mon, "%s %3d %15s %5d ", buf, so->s,
442 src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
443 ntohs(src.sin_port));
444 monitor_printf(mon, "%15s %5d %5d %5d\n",
445 inet_ntoa(dst_addr), ntohs(dst_port),
446 so->so_rcv.sb_cc, so->so_snd.sb_cc);