[mirror_qemu.git] / slirp / misc.c

/*
 * Copyright (c) 1995 Danny Gasparovski.
 *
 * Please read the file COPYRIGHT for the
 * terms and conditions of the copyright.
 */

#include "qemu/osdep.h"
#include "slirp.h"
#include "libslirp.h"
#include "monitor/monitor.h"
#include "qemu/error-report.h"
#include "qemu/main-loop.h"

#ifdef DEBUG
int slirp_debug = DBG_CALL|DBG_MISC|DBG_ERROR;
#endif

inline void
insque(void *a, void *b)
{
	register struct quehead *element = (struct quehead *) a;
	register struct quehead *head = (struct quehead *) b;
	element->qh_link = head->qh_link;
	head->qh_link = (struct quehead *)element;
	element->qh_rlink = (struct quehead *)head;
	((struct quehead *)(element->qh_link))->qh_rlink
	= (struct quehead *)element;
}

inline void
remque(void *a)
{
  register struct quehead *element = (struct quehead *) a;
  ((struct quehead *)(element->qh_link))->qh_rlink = element->qh_rlink;
  ((struct quehead *)(element->qh_rlink))->qh_link = element->qh_link;
  element->qh_rlink = NULL;
}

int add_exec(struct ex_list **ex_ptr, int do_pty, char *exec,
             struct in_addr addr, int port)
{
	struct ex_list *tmp_ptr;

	/* First, check if the port is "bound" */
	for (tmp_ptr = *ex_ptr; tmp_ptr; tmp_ptr = tmp_ptr->ex_next) {
		if (port == tmp_ptr->ex_fport &&
		    addr.s_addr == tmp_ptr->ex_addr.s_addr)
			return -1;
	}

	tmp_ptr = *ex_ptr;
	*ex_ptr = g_new(struct ex_list, 1);
	(*ex_ptr)->ex_fport = port;
	(*ex_ptr)->ex_addr = addr;
	(*ex_ptr)->ex_pty = do_pty;
	(*ex_ptr)->ex_exec = (do_pty == 3) ? exec : g_strdup(exec);
	(*ex_ptr)->ex_next = tmp_ptr;
	return 0;
}


#ifdef _WIN32

int
fork_exec(struct socket *so, const char *ex, int do_pty)
{
    /* not implemented */
    return 0;
}

#else

/*
 * XXX This is ugly
 * We create and bind a socket, then fork off to another
 * process, which connects to this socket, after which we
 * exec the wanted program.  If something (strange) happens,
 * the accept() call could block us forever.
 *
 * do_pty = 0   Fork/exec inetd style
 * do_pty = 1   Fork/exec using slirp.telnetd
 * do_ptr = 2   Fork/exec using pty
 */
int
fork_exec(struct socket *so, const char *ex, int do_pty)
{
	int s;
	struct sockaddr_in addr;
	socklen_t addrlen = sizeof(addr);
	int opt;
	const char *argv[256];
	/* don't want to clobber the original */
	char *bptr;
	const char *curarg;
	int c, i, ret;
	pid_t pid;

	DEBUG_CALL("fork_exec");
	DEBUG_ARG("so = %p", so);
	DEBUG_ARG("ex = %p", ex);
	DEBUG_ARG("do_pty = %x", do_pty);

	if (do_pty == 2) {
                return 0;
	} else {
		addr.sin_family = AF_INET;
		addr.sin_port = 0;
		addr.sin_addr.s_addr = INADDR_ANY;

		if ((s = qemu_socket(AF_INET, SOCK_STREAM, 0)) < 0 ||
		    bind(s, (struct sockaddr *)&addr, addrlen) < 0 ||
		    listen(s, 1) < 0) {
			error_report("Error: inet socket: %s", strerror(errno));
			closesocket(s);

			return 0;
		}
	}

	pid = fork();
	switch(pid) {
	 case -1:
		error_report("Error: fork failed: %s", strerror(errno));
		close(s);
		return 0;

	 case 0:
                setsid();

		/* Set the DISPLAY */
                getsockname(s, (struct sockaddr *)&addr, &addrlen);
                close(s);
                /*
                 * Connect to the socket
                 * XXX If any of these fail, we're in trouble!
                 */
                s = qemu_socket(AF_INET, SOCK_STREAM, 0);
                addr.sin_addr = loopback_addr;
                do {
                    ret = connect(s, (struct sockaddr *)&addr, addrlen);
                } while (ret < 0 && errno == EINTR);

		dup2(s, 0);
		dup2(s, 1);
		dup2(s, 2);
		for (s = getdtablesize() - 1; s >= 3; s--)
		   close(s);

		i = 0;
		bptr = g_strdup(ex); /* No need to free() this */
		if (do_pty == 1) {
			/* Setup "slirp.telnetd -x" */
			argv[i++] = "slirp.telnetd";
			argv[i++] = "-x";
			argv[i++] = bptr;
		} else
		   do {
			/* Change the string into argv[] */
			curarg = bptr;
			while (*bptr != ' ' && *bptr != (char)0)
			   bptr++;
			c = *bptr;
			*bptr++ = (char)0;
			argv[i++] = g_strdup(curarg);
		   } while (c);

                argv[i] = NULL;
		execvp(argv[0], (char **)argv);

		/* Ooops, failed, let's tell the user why */
        fprintf(stderr, "Error: execvp of %s failed: %s\n",
                argv[0], strerror(errno));
		close(0); close(1); close(2); /* XXX */
		exit(1);

	 default:
		qemu_add_child_watch(pid);
                /*
                 * XXX this could block us...
                 * XXX Should set a timer here, and if accept() doesn't
                 * return after X seconds, declare it a failure
                 * The only reason this will block forever is if socket()
                 * of connect() fail in the child process
                 */
                do {
                    so->s = accept(s, (struct sockaddr *)&addr, &addrlen);
                } while (so->s < 0 && errno == EINTR);
                closesocket(s);
                socket_set_fast_reuse(so->s);
                opt = 1;
                qemu_setsockopt(so->s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(int));
		qemu_set_nonblock(so->s);

		/* Append the telnet options now */
                if (so->so_m != NULL && do_pty == 1)  {
			sbappend(so, so->so_m);
                        so->so_m = NULL;
		}

		return 1;
	}
}
#endif

void slirp_connection_info(Slirp *slirp, Monitor *mon)
{
    const char * const tcpstates[] = {
        [TCPS_CLOSED]       = "CLOSED",
        [TCPS_LISTEN]       = "LISTEN",
        [TCPS_SYN_SENT]     = "SYN_SENT",
        [TCPS_SYN_RECEIVED] = "SYN_RCVD",
        [TCPS_ESTABLISHED]  = "ESTABLISHED",
        [TCPS_CLOSE_WAIT]   = "CLOSE_WAIT",
        [TCPS_FIN_WAIT_1]   = "FIN_WAIT_1",
        [TCPS_CLOSING]      = "CLOSING",
        [TCPS_LAST_ACK]     = "LAST_ACK",
        [TCPS_FIN_WAIT_2]   = "FIN_WAIT_2",
        [TCPS_TIME_WAIT]    = "TIME_WAIT",
    };
    struct in_addr dst_addr;
    struct sockaddr_in src;
    socklen_t src_len;
    uint16_t dst_port;
    struct socket *so;
    const char *state;
    char buf[20];

    monitor_printf(mon, "  Protocol[State]    FD  Source Address  Port   "
                        "Dest. Address  Port RecvQ SendQ\n");

    for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) {
        if (so->so_state & SS_HOSTFWD) {
            state = "HOST_FORWARD";
        } else if (so->so_tcpcb) {
            state = tcpstates[so->so_tcpcb->t_state];
        } else {
            state = "NONE";
        }
        if (so->so_state & (SS_HOSTFWD | SS_INCOMING)) {
            src_len = sizeof(src);
            getsockname(so->s, (struct sockaddr *)&src, &src_len);
            dst_addr = so->so_laddr;
            dst_port = so->so_lport;
        } else {
            src.sin_addr = so->so_laddr;
            src.sin_port = so->so_lport;
            dst_addr = so->so_faddr;
            dst_port = so->so_fport;
        }
        snprintf(buf, sizeof(buf), "  TCP[%s]", state);
        monitor_printf(mon, "%-19s %3d %15s %5d ", buf, so->s,
                       src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
                       ntohs(src.sin_port));
        monitor_printf(mon, "%15s %5d %5d %5d\n",
                       inet_ntoa(dst_addr), ntohs(dst_port),
                       so->so_rcv.sb_cc, so->so_snd.sb_cc);
    }

    for (so = slirp->udb.so_next; so != &slirp->udb; so = so->so_next) {
        if (so->so_state & SS_HOSTFWD) {
            snprintf(buf, sizeof(buf), "  UDP[HOST_FORWARD]");
            src_len = sizeof(src);
            getsockname(so->s, (struct sockaddr *)&src, &src_len);
            dst_addr = so->so_laddr;
            dst_port = so->so_lport;
        } else {
            snprintf(buf, sizeof(buf), "  UDP[%d sec]",
                         (so->so_expire - curtime) / 1000);
            src.sin_addr = so->so_laddr;
            src.sin_port = so->so_lport;
            dst_addr = so->so_faddr;
            dst_port = so->so_fport;
        }
        monitor_printf(mon, "%-19s %3d %15s %5d ", buf, so->s,
                       src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
                       ntohs(src.sin_port));
        monitor_printf(mon, "%15s %5d %5d %5d\n",
                       inet_ntoa(dst_addr), ntohs(dst_port),
                       so->so_rcv.sb_cc, so->so_snd.sb_cc);
    }

    for (so = slirp->icmp.so_next; so != &slirp->icmp; so = so->so_next) {
        snprintf(buf, sizeof(buf), "  ICMP[%d sec]",
                     (so->so_expire - curtime) / 1000);
        src.sin_addr = so->so_laddr;
        dst_addr = so->so_faddr;
        monitor_printf(mon, "%-19s %3d %15s  -    ", buf, so->s,
                       src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*");
        monitor_printf(mon, "%15s  -    %5d %5d\n", inet_ntoa(dst_addr),
                       so->so_rcv.sb_cc, so->so_snd.sb_cc);
    }
}
Commit	Line	Data
f0cbd3ec FB	1	/*
f0cbd3ec FB	2	* Copyright (c) 1995 Danny Gasparovski.
5fafdf24	3	*
f0cbd3ec FB	4	* Please read the file COPYRIGHT for the
	5	* terms and conditions of the copyright.
	6	*/
	7
7df7482b	8	#include "qemu/osdep.h"
a9c94277 MA	9	#include "slirp.h"
a9c94277 MA	10	#include "libslirp.h"
83c9089e	11	#include "monitor/monitor.h"
d49b6836	12	#include "qemu/error-report.h"
6a1751b7	13	#include "qemu/main-loop.h"
f0cbd3ec	14
9f349498 JK	15	#ifdef DEBUG
	16	int slirp_debug = DBG_CALL\|DBG_MISC\|DBG_ERROR;
	17	#endif
	18
f0cbd3ec	19	inline void
511d2b14	20	insque(void a, void b)
f0cbd3ec FB	21	{
	22	register struct quehead element = (struct quehead ) a;
	23	register struct quehead head = (struct quehead ) b;
	24	element->qh_link = head->qh_link;
	25	head->qh_link = (struct quehead *)element;
	26	element->qh_rlink = (struct quehead *)head;
	27	((struct quehead *)(element->qh_link))->qh_rlink
	28	= (struct quehead *)element;
	29	}
	30
	31	inline void
511d2b14	32	remque(void *a)
f0cbd3ec FB	33	{
	34	register struct quehead element = (struct quehead ) a;
	35	((struct quehead *)(element->qh_link))->qh_rlink = element->qh_rlink;
	36	((struct quehead *)(element->qh_rlink))->qh_link = element->qh_link;
	37	element->qh_rlink = NULL;
f0cbd3ec FB	38	}
f0cbd3ec FB	39
a13a4126 JK	40	int add_exec(struct ex_list *ex_ptr, int do_pty, char exec,
a13a4126 JK	41	struct in_addr addr, int port)
f0cbd3ec FB	42	{
f0cbd3ec FB	43	struct ex_list *tmp_ptr;
5fafdf24	44
f0cbd3ec FB	45	/* First, check if the port is "bound" */
f0cbd3ec FB	46	for (tmp_ptr = *ex_ptr; tmp_ptr; tmp_ptr = tmp_ptr->ex_next) {
a13a4126 JK	47	if (port == tmp_ptr->ex_fport &&
	48	addr.s_addr == tmp_ptr->ex_addr.s_addr)
	49	return -1;
f0cbd3ec	50	}
5fafdf24	51
f0cbd3ec	52	tmp_ptr = *ex_ptr;
2fd5d864	53	*ex_ptr = g_new(struct ex_list, 1);
f0cbd3ec FB	54	(*ex_ptr)->ex_fport = port;
	55	(*ex_ptr)->ex_addr = addr;
	56	(*ex_ptr)->ex_pty = do_pty;
2fd5d864	57	(*ex_ptr)->ex_exec = (do_pty == 3) ? exec : g_strdup(exec);
f0cbd3ec FB	58	(*ex_ptr)->ex_next = tmp_ptr;
	59	return 0;
	60	}
	61
f0cbd3ec	62
a3d4af03 FB	63	#ifdef _WIN32
	64
	65	int
9634d903	66	fork_exec(struct socket so, const char ex, int do_pty)
a3d4af03 FB	67	{
	68	/* not implemented */
	69	return 0;
	70	}
	71
	72	#else
	73
f0cbd3ec FB	74	/*
	75	* XXX This is ugly
	76	* We create and bind a socket, then fork off to another
	77	* process, which connects to this socket, after which we
	78	* exec the wanted program. If something (strange) happens,
	79	* the accept() call could block us forever.
5fafdf24	80	*
f0cbd3ec FB	81	* do_pty = 0 Fork/exec inetd style
	82	* do_pty = 1 Fork/exec using slirp.telnetd
	83	* do_ptr = 2 Fork/exec using pty
	84	*/
	85	int
9634d903	86	fork_exec(struct socket so, const char ex, int do_pty)
f0cbd3ec FB	87	{
	88	int s;
	89	struct sockaddr_in addr;
242acf3a	90	socklen_t addrlen = sizeof(addr);
f0cbd3ec	91	int opt;
7ccfb2eb	92	const char *argv[256];
f0cbd3ec FB	93	/* don't want to clobber the original */
f0cbd3ec FB	94	char *bptr;
9634d903	95	const char *curarg;
7b91a172	96	int c, i, ret;
4d54ec78	97	pid_t pid;
5fafdf24	98
f0cbd3ec	99	DEBUG_CALL("fork_exec");
ecc804ca SW	100	DEBUG_ARG("so = %p", so);
	101	DEBUG_ARG("ex = %p", ex);
	102	DEBUG_ARG("do_pty = %x", do_pty);
5fafdf24	103
f0cbd3ec	104	if (do_pty == 2) {
3f9b2b1f	105	return 0;
f0cbd3ec FB	106	} else {
	107	addr.sin_family = AF_INET;
	108	addr.sin_port = 0;
	109	addr.sin_addr.s_addr = INADDR_ANY;
3b46e624	110
40ff6d7e	111	if ((s = qemu_socket(AF_INET, SOCK_STREAM, 0)) < 0 \|\|
f0cbd3ec FB	112	bind(s, (struct sockaddr *)&addr, addrlen) < 0 \|\|
f0cbd3ec FB	113	listen(s, 1) < 0) {
02d16089	114	error_report("Error: inet socket: %s", strerror(errno));
379ff53d	115	closesocket(s);
3b46e624	116
f0cbd3ec FB	117	return 0;
	118	}
	119	}
5fafdf24	120
4d54ec78 PB	121	pid = fork();
4d54ec78 PB	122	switch(pid) {
f0cbd3ec	123	case -1:
02d16089	124	error_report("Error: fork failed: %s", strerror(errno));
f0cbd3ec	125	close(s);
f0cbd3ec	126	return 0;
3b46e624	127
f0cbd3ec	128	case 0:
565465fc JK	129	setsid();
565465fc JK	130
f0cbd3ec	131	/* Set the DISPLAY */
9f1134d4 SW	132	getsockname(s, (struct sockaddr *)&addr, &addrlen);
	133	close(s);
	134	/*
	135	* Connect to the socket
	136	* XXX If any of these fail, we're in trouble!
	137	*/
	138	s = qemu_socket(AF_INET, SOCK_STREAM, 0);
	139	addr.sin_addr = loopback_addr;
	140	do {
	141	ret = connect(s, (struct sockaddr *)&addr, addrlen);
	142	} while (ret < 0 && errno == EINTR);
3b46e624	143
f0cbd3ec FB	144	dup2(s, 0);
	145	dup2(s, 1);
	146	dup2(s, 2);
9634d903	147	for (s = getdtablesize() - 1; s >= 3; s--)
f0cbd3ec	148	close(s);
3b46e624	149
f0cbd3ec	150	i = 0;
7267c094	151	bptr = g_strdup(ex); /* No need to free() this */
f0cbd3ec FB	152	if (do_pty == 1) {
	153	/* Setup "slirp.telnetd -x" */
	154	argv[i++] = "slirp.telnetd";
	155	argv[i++] = "-x";
	156	argv[i++] = bptr;
	157	} else
	158	do {
	159	/* Change the string into argv[] */
	160	curarg = bptr;
	161	while (bptr != ' ' && bptr != (char)0)
	162	bptr++;
	163	c = *bptr;
	164	*bptr++ = (char)0;
2fd5d864	165	argv[i++] = g_strdup(curarg);
f0cbd3ec	166	} while (c);
3b46e624	167
511d2b14	168	argv[i] = NULL;
7ccfb2eb	169	execvp(argv[0], (char **)argv);
3b46e624	170
f0cbd3ec	171	/* Ooops, failed, let's tell the user why */
f0d98b05 KS	172	fprintf(stderr, "Error: execvp of %s failed: %s\n",
f0d98b05 KS	173	argv[0], strerror(errno));
f0cbd3ec FB	174	close(0); close(1); close(2); /* XXX */
f0cbd3ec FB	175	exit(1);
3b46e624	176
f0cbd3ec	177	default:
4d54ec78	178	qemu_add_child_watch(pid);
9f1134d4 SW	179	/*
	180	* XXX this could block us...
	181	* XXX Should set a timer here, and if accept() doesn't
	182	* return after X seconds, declare it a failure
	183	* The only reason this will block forever is if socket()
	184	* of connect() fail in the child process
	185	*/
	186	do {
	187	so->s = accept(s, (struct sockaddr *)&addr, &addrlen);
	188	} while (so->s < 0 && errno == EINTR);
	189	closesocket(s);
aad1239a	190	socket_set_fast_reuse(so->s);
9f1134d4	191	opt = 1;
9957fc7f	192	qemu_setsockopt(so->s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(int));
f9e8cacc	193	qemu_set_nonblock(so->s);
3b46e624	194
f0cbd3ec	195	/* Append the telnet options now */
511d2b14	196	if (so->so_m != NULL && do_pty == 1) {
f0cbd3ec	197	sbappend(so, so->so_m);
511d2b14	198	so->so_m = NULL;
f0cbd3ec	199	}
3b46e624	200
f0cbd3ec FB	201	return 1;
	202	}
	203	}
	204	#endif
	205
9f8bd042	206	void slirp_connection_info(Slirp slirp, Monitor mon)
6dbe553f JK	207	{
	208	const char * const tcpstates[] = {
	209	[TCPS_CLOSED] = "CLOSED",
	210	[TCPS_LISTEN] = "LISTEN",
	211	[TCPS_SYN_SENT] = "SYN_SENT",
	212	[TCPS_SYN_RECEIVED] = "SYN_RCVD",
	213	[TCPS_ESTABLISHED] = "ESTABLISHED",
	214	[TCPS_CLOSE_WAIT] = "CLOSE_WAIT",
	215	[TCPS_FIN_WAIT_1] = "FIN_WAIT_1",
	216	[TCPS_CLOSING] = "CLOSING",
	217	[TCPS_LAST_ACK] = "LAST_ACK",
	218	[TCPS_FIN_WAIT_2] = "FIN_WAIT_2",
	219	[TCPS_TIME_WAIT] = "TIME_WAIT",
	220	};
	221	struct in_addr dst_addr;
	222	struct sockaddr_in src;
	223	socklen_t src_len;
	224	uint16_t dst_port;
	225	struct socket *so;
	226	const char *state;
	227	char buf[20];
6dbe553f JK	228
	229	monitor_printf(mon, " Protocol[State] FD Source Address Port "
	230	"Dest. Address Port RecvQ SendQ\n");
	231
460fec67	232	for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) {
6dbe553f JK	233	if (so->so_state & SS_HOSTFWD) {
	234	state = "HOST_FORWARD";
	235	} else if (so->so_tcpcb) {
	236	state = tcpstates[so->so_tcpcb->t_state];
	237	} else {
	238	state = "NONE";
	239	}
	240	if (so->so_state & (SS_HOSTFWD \| SS_INCOMING)) {
	241	src_len = sizeof(src);
	242	getsockname(so->s, (struct sockaddr *)&src, &src_len);
	243	dst_addr = so->so_laddr;
	244	dst_port = so->so_lport;
	245	} else {
	246	src.sin_addr = so->so_laddr;
	247	src.sin_port = so->so_lport;
	248	dst_addr = so->so_faddr;
	249	dst_port = so->so_fport;
	250	}
f293d8b1 AL	251	snprintf(buf, sizeof(buf), " TCP[%s]", state);
f293d8b1 AL	252	monitor_printf(mon, "%-19s %3d %15s %5d ", buf, so->s,
6dbe553f JK	253	src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
	254	ntohs(src.sin_port));
	255	monitor_printf(mon, "%15s %5d %5d %5d\n",
	256	inet_ntoa(dst_addr), ntohs(dst_port),
	257	so->so_rcv.sb_cc, so->so_snd.sb_cc);
	258	}
	259
460fec67	260	for (so = slirp->udb.so_next; so != &slirp->udb; so = so->so_next) {
6dbe553f	261	if (so->so_state & SS_HOSTFWD) {
f293d8b1	262	snprintf(buf, sizeof(buf), " UDP[HOST_FORWARD]");
6dbe553f JK	263	src_len = sizeof(src);
	264	getsockname(so->s, (struct sockaddr *)&src, &src_len);
	265	dst_addr = so->so_laddr;
	266	dst_port = so->so_lport;
	267	} else {
f293d8b1	268	snprintf(buf, sizeof(buf), " UDP[%d sec]",
6dbe553f JK	269	(so->so_expire - curtime) / 1000);
	270	src.sin_addr = so->so_laddr;
	271	src.sin_port = so->so_lport;
	272	dst_addr = so->so_faddr;
	273	dst_port = so->so_fport;
	274	}
f293d8b1	275	monitor_printf(mon, "%-19s %3d %15s %5d ", buf, so->s,
6dbe553f JK	276	src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*",
	277	ntohs(src.sin_port));
	278	monitor_printf(mon, "%15s %5d %5d %5d\n",
	279	inet_ntoa(dst_addr), ntohs(dst_port),
	280	so->so_rcv.sb_cc, so->so_snd.sb_cc);
	281	}
e6d43cfb JK	282
e6d43cfb JK	283	for (so = slirp->icmp.so_next; so != &slirp->icmp; so = so->so_next) {
f293d8b1	284	snprintf(buf, sizeof(buf), " ICMP[%d sec]",
e6d43cfb JK	285	(so->so_expire - curtime) / 1000);
	286	src.sin_addr = so->so_laddr;
	287	dst_addr = so->so_faddr;
f293d8b1	288	monitor_printf(mon, "%-19s %3d %15s - ", buf, so->s,
e6d43cfb JK	289	src.sin_addr.s_addr ? inet_ntoa(src.sin_addr) : "*");
	290	monitor_printf(mon, "%15s - %5d %5d\n", inet_ntoa(dst_addr),
	291	so->so_rcv.sb_cc, so->so_snd.sb_cc);
	292	}
6dbe553f	293	}