blob: 7571c5a2820bd25220985883f66b6a1e10198619 [file] [log] [blame]
bellardf0cbd3e2004-04-22 00:10:48 +00001/*
2 * Copyright (c) 1982, 1986, 1988, 1990, 1993
3 * The Regents of the University of California. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
aliguori2f5f8992009-01-26 19:37:41 +000013 * 3. Neither the name of the University nor the names of its contributors
bellardf0cbd3e2004-04-22 00:10:48 +000014 * may be used to endorse or promote products derived from this software
15 * without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 *
29 * @(#)tcp_subr.c 8.1 (Berkeley) 6/10/93
30 * tcp_subr.c,v 1.5 1994/10/08 22:39:58 phk Exp
31 */
32
33/*
34 * Changes and additions relating to SLiRP
35 * Copyright (c) 1995 Danny Gasparovski.
ths5fafdf22007-09-16 21:08:06 +000036 *
37 * Please read the file COPYRIGHT for the
bellardf0cbd3e2004-04-22 00:10:48 +000038 * terms and conditions of the copyright.
39 */
40
bellardf0cbd3e2004-04-22 00:10:48 +000041#include <slirp.h>
42
43/* patchable/settable parameters for tcp */
blueswir19634d902007-10-26 19:01:16 +000044/* Don't do rfc1323 performance enhancements */
45#define TCP_DO_RFC1323 0
bellardf0cbd3e2004-04-22 00:10:48 +000046
47/*
48 * Tcp initialization
49 */
50void
Jan Kiszka460fec62009-06-24 14:42:31 +020051tcp_init(Slirp *slirp)
bellardf0cbd3e2004-04-22 00:10:48 +000052{
Jan Kiszka460fec62009-06-24 14:42:31 +020053 slirp->tcp_iss = 1; /* wrong */
54 slirp->tcb.so_next = slirp->tcb.so_prev = &slirp->tcb;
55 slirp->tcp_last_so = &slirp->tcb;
bellardf0cbd3e2004-04-22 00:10:48 +000056}
57
Jan Kiszkaa68adc22012-02-29 19:14:23 +010058void tcp_cleanup(Slirp *slirp)
59{
60 while (slirp->tcb.so_next != &slirp->tcb) {
61 tcp_close(sototcpcb(slirp->tcb.so_next));
62 }
63}
64
bellardf0cbd3e2004-04-22 00:10:48 +000065/*
66 * Create template to be used to send tcp packets on a connection.
67 * Call after host entry created, fills
68 * in a skeletal tcp/ip header, minimizing the amount of work
69 * necessary when the connection is used.
70 */
bellardf0cbd3e2004-04-22 00:10:48 +000071void
blueswir1511d2b12009-03-07 15:32:56 +000072tcp_template(struct tcpcb *tp)
bellardf0cbd3e2004-04-22 00:10:48 +000073{
74 struct socket *so = tp->t_socket;
75 register struct tcpiphdr *n = &tp->t_template;
76
blueswir1429d0a32009-01-13 19:48:42 +000077 n->ti_mbuf = NULL;
bellardf0cbd3e2004-04-22 00:10:48 +000078 n->ti_x1 = 0;
79 n->ti_pr = IPPROTO_TCP;
80 n->ti_len = htons(sizeof (struct tcpiphdr) - sizeof (struct ip));
81 n->ti_src = so->so_faddr;
82 n->ti_dst = so->so_laddr;
83 n->ti_sport = so->so_fport;
84 n->ti_dport = so->so_lport;
ths5fafdf22007-09-16 21:08:06 +000085
bellardf0cbd3e2004-04-22 00:10:48 +000086 n->ti_seq = 0;
87 n->ti_ack = 0;
88 n->ti_x2 = 0;
89 n->ti_off = 5;
90 n->ti_flags = 0;
91 n->ti_win = 0;
92 n->ti_sum = 0;
93 n->ti_urp = 0;
94}
95
96/*
97 * Send a single message to the TCP at address specified by
98 * the given TCP/IP header. If m == 0, then we make a copy
99 * of the tcpiphdr at ti and send directly to the addressed host.
100 * This is used to force keep alive messages out using the TCP
101 * template for a connection tp->t_template. If flags are given
102 * then we send a message back to the TCP which originated the
103 * segment ti, and discard the mbuf containing it and any other
104 * attached mbufs.
105 *
106 * In any case the ack and sequence number of the transmitted
107 * segment are as specified by the parameters.
108 */
109void
blueswir1511d2b12009-03-07 15:32:56 +0000110tcp_respond(struct tcpcb *tp, struct tcpiphdr *ti, struct mbuf *m,
111 tcp_seq ack, tcp_seq seq, int flags)
bellardf0cbd3e2004-04-22 00:10:48 +0000112{
113 register int tlen;
114 int win = 0;
115
116 DEBUG_CALL("tcp_respond");
Stefan Weilc4d12a72012-09-04 23:20:35 +0200117 DEBUG_ARG("tp = %p", tp);
118 DEBUG_ARG("ti = %p", ti);
119 DEBUG_ARG("m = %p", m);
bellardf0cbd3e2004-04-22 00:10:48 +0000120 DEBUG_ARG("ack = %u", ack);
121 DEBUG_ARG("seq = %u", seq);
122 DEBUG_ARG("flags = %x", flags);
ths5fafdf22007-09-16 21:08:06 +0000123
bellardf0cbd3e2004-04-22 00:10:48 +0000124 if (tp)
125 win = sbspace(&tp->t_socket->so_rcv);
blueswir1511d2b12009-03-07 15:32:56 +0000126 if (m == NULL) {
Stefan Weile56afbc52012-09-04 23:20:36 +0200127 if (!tp || (m = m_get(tp->t_socket->slirp)) == NULL)
bellardf0cbd3e2004-04-22 00:10:48 +0000128 return;
bellardf0cbd3e2004-04-22 00:10:48 +0000129 tlen = 0;
blueswir19634d902007-10-26 19:01:16 +0000130 m->m_data += IF_MAXLINKHDR;
bellardf0cbd3e2004-04-22 00:10:48 +0000131 *mtod(m, struct tcpiphdr *) = *ti;
132 ti = mtod(m, struct tcpiphdr *);
133 flags = TH_ACK;
134 } else {
ths5fafdf22007-09-16 21:08:06 +0000135 /*
bellardf0cbd3e2004-04-22 00:10:48 +0000136 * ti points into m so the next line is just making
137 * the mbuf point to ti
138 */
139 m->m_data = (caddr_t)ti;
ths3b46e622007-09-17 08:09:54 +0000140
bellardf0cbd3e2004-04-22 00:10:48 +0000141 m->m_len = sizeof (struct tcpiphdr);
142 tlen = 0;
143#define xchg(a,b,type) { type t; t=a; a=b; b=t; }
Stefan Weilb6dce922010-07-22 22:15:23 +0200144 xchg(ti->ti_dst.s_addr, ti->ti_src.s_addr, uint32_t);
145 xchg(ti->ti_dport, ti->ti_sport, uint16_t);
bellardf0cbd3e2004-04-22 00:10:48 +0000146#undef xchg
147 }
148 ti->ti_len = htons((u_short)(sizeof (struct tcphdr) + tlen));
149 tlen += sizeof (struct tcpiphdr);
150 m->m_len = tlen;
151
blueswir1511d2b12009-03-07 15:32:56 +0000152 ti->ti_mbuf = NULL;
bellardf0cbd3e2004-04-22 00:10:48 +0000153 ti->ti_x1 = 0;
154 ti->ti_seq = htonl(seq);
155 ti->ti_ack = htonl(ack);
156 ti->ti_x2 = 0;
157 ti->ti_off = sizeof (struct tcphdr) >> 2;
158 ti->ti_flags = flags;
159 if (tp)
Stefan Weilb6dce922010-07-22 22:15:23 +0200160 ti->ti_win = htons((uint16_t) (win >> tp->rcv_scale));
bellardf0cbd3e2004-04-22 00:10:48 +0000161 else
Stefan Weilb6dce922010-07-22 22:15:23 +0200162 ti->ti_win = htons((uint16_t)win);
bellardf0cbd3e2004-04-22 00:10:48 +0000163 ti->ti_urp = 0;
164 ti->ti_sum = 0;
165 ti->ti_sum = cksum(m, tlen);
166 ((struct ip *)ti)->ip_len = tlen;
167
ths5fafdf22007-09-16 21:08:06 +0000168 if(flags & TH_RST)
bellardf0cbd3e2004-04-22 00:10:48 +0000169 ((struct ip *)ti)->ip_ttl = MAXTTL;
ths5fafdf22007-09-16 21:08:06 +0000170 else
blueswir19634d902007-10-26 19:01:16 +0000171 ((struct ip *)ti)->ip_ttl = IPDEFTTL;
ths5fafdf22007-09-16 21:08:06 +0000172
bellardf0cbd3e2004-04-22 00:10:48 +0000173 (void) ip_output((struct socket *)0, m);
174}
175
176/*
177 * Create a new TCP control block, making an
178 * empty reassembly queue and hooking it to the argument
179 * protocol control block.
180 */
181struct tcpcb *
blueswir1511d2b12009-03-07 15:32:56 +0000182tcp_newtcpcb(struct socket *so)
bellardf0cbd3e2004-04-22 00:10:48 +0000183{
184 register struct tcpcb *tp;
ths5fafdf22007-09-16 21:08:06 +0000185
bellardf0cbd3e2004-04-22 00:10:48 +0000186 tp = (struct tcpcb *)malloc(sizeof(*tp));
187 if (tp == NULL)
188 return ((struct tcpcb *)0);
ths5fafdf22007-09-16 21:08:06 +0000189
bellardf0cbd3e2004-04-22 00:10:48 +0000190 memset((char *) tp, 0, sizeof(struct tcpcb));
blueswir1429d0a32009-01-13 19:48:42 +0000191 tp->seg_next = tp->seg_prev = (struct tcpiphdr*)tp;
blueswir19634d902007-10-26 19:01:16 +0000192 tp->t_maxseg = TCP_MSS;
ths5fafdf22007-09-16 21:08:06 +0000193
blueswir19634d902007-10-26 19:01:16 +0000194 tp->t_flags = TCP_DO_RFC1323 ? (TF_REQ_SCALE|TF_REQ_TSTMP) : 0;
bellardf0cbd3e2004-04-22 00:10:48 +0000195 tp->t_socket = so;
ths5fafdf22007-09-16 21:08:06 +0000196
bellardf0cbd3e2004-04-22 00:10:48 +0000197 /*
198 * Init srtt to TCPTV_SRTTBASE (0), so we can tell that we have no
199 * rtt estimate. Set rttvar so that srtt + 2 * rttvar gives
200 * reasonable initial retransmit time.
201 */
202 tp->t_srtt = TCPTV_SRTTBASE;
blueswir19634d902007-10-26 19:01:16 +0000203 tp->t_rttvar = TCPTV_SRTTDFLT << 2;
bellardf0cbd3e2004-04-22 00:10:48 +0000204 tp->t_rttmin = TCPTV_MIN;
205
ths5fafdf22007-09-16 21:08:06 +0000206 TCPT_RANGESET(tp->t_rxtcur,
bellardf0cbd3e2004-04-22 00:10:48 +0000207 ((TCPTV_SRTTBASE >> 2) + (TCPTV_SRTTDFLT << 2)) >> 1,
208 TCPTV_MIN, TCPTV_REXMTMAX);
209
210 tp->snd_cwnd = TCP_MAXWIN << TCP_MAX_WINSHIFT;
211 tp->snd_ssthresh = TCP_MAXWIN << TCP_MAX_WINSHIFT;
212 tp->t_state = TCPS_CLOSED;
ths5fafdf22007-09-16 21:08:06 +0000213
bellardf0cbd3e2004-04-22 00:10:48 +0000214 so->so_tcpcb = tp;
215
216 return (tp);
217}
218
219/*
220 * Drop a TCP connection, reporting
221 * the specified error. If connection is synchronized,
222 * then send a RST to peer.
223 */
ths5fafdf22007-09-16 21:08:06 +0000224struct tcpcb *tcp_drop(struct tcpcb *tp, int err)
bellardf0cbd3e2004-04-22 00:10:48 +0000225{
bellardf0cbd3e2004-04-22 00:10:48 +0000226 DEBUG_CALL("tcp_drop");
227 DEBUG_ARG("tp = %lx", (long)tp);
228 DEBUG_ARG("errno = %d", errno);
ths5fafdf22007-09-16 21:08:06 +0000229
bellardf0cbd3e2004-04-22 00:10:48 +0000230 if (TCPS_HAVERCVDSYN(tp->t_state)) {
231 tp->t_state = TCPS_CLOSED;
232 (void) tcp_output(tp);
Jan Kiszka0fe6a7f2009-06-24 14:42:29 +0200233 }
bellardf0cbd3e2004-04-22 00:10:48 +0000234 return (tcp_close(tp));
235}
236
237/*
238 * Close a TCP control block:
239 * discard all space held by the tcp
240 * discard internet protocol block
241 * wake up any sleepers
242 */
243struct tcpcb *
blueswir1511d2b12009-03-07 15:32:56 +0000244tcp_close(struct tcpcb *tp)
bellardf0cbd3e2004-04-22 00:10:48 +0000245{
246 register struct tcpiphdr *t;
247 struct socket *so = tp->t_socket;
Jan Kiszka460fec62009-06-24 14:42:31 +0200248 Slirp *slirp = so->slirp;
bellardf0cbd3e2004-04-22 00:10:48 +0000249 register struct mbuf *m;
250
251 DEBUG_CALL("tcp_close");
252 DEBUG_ARG("tp = %lx", (long )tp);
ths5fafdf22007-09-16 21:08:06 +0000253
bellardf0cbd3e2004-04-22 00:10:48 +0000254 /* free the reassembly queue, if any */
blueswir1429d0a32009-01-13 19:48:42 +0000255 t = tcpfrag_list_first(tp);
256 while (!tcpfrag_list_end(t, tp)) {
257 t = tcpiphdr_next(t);
258 m = tcpiphdr_prev(t)->ti_mbuf;
259 remque(tcpiphdr2qlink(tcpiphdr_prev(t)));
Jan Kiszka3acccfc2011-07-20 12:20:16 +0200260 m_free(m);
bellardf0cbd3e2004-04-22 00:10:48 +0000261 }
bellardf0cbd3e2004-04-22 00:10:48 +0000262 free(tp);
blueswir1511d2b12009-03-07 15:32:56 +0000263 so->so_tcpcb = NULL;
bellardf0cbd3e2004-04-22 00:10:48 +0000264 /* clobber input socket cache if we're closing the cached connection */
Jan Kiszka460fec62009-06-24 14:42:31 +0200265 if (so == slirp->tcp_last_so)
266 slirp->tcp_last_so = &slirp->tcb;
bellard379ff532004-07-12 22:33:07 +0000267 closesocket(so->s);
bellardf0cbd3e2004-04-22 00:10:48 +0000268 sbfree(&so->so_rcv);
269 sbfree(&so->so_snd);
270 sofree(so);
bellardf0cbd3e2004-04-22 00:10:48 +0000271 return ((struct tcpcb *)0);
272}
273
bellardf0cbd3e2004-04-22 00:10:48 +0000274/*
275 * TCP protocol interface to socket abstraction.
276 */
277
278/*
279 * User issued close, and wish to trail through shutdown states:
280 * if never received SYN, just forget it. If got a SYN from peer,
281 * but haven't sent FIN, then go to FIN_WAIT_1 state to send peer a FIN.
282 * If already got a FIN from peer, then almost done; go to LAST_ACK
283 * state. In all other cases, have already sent FIN to peer (e.g.
284 * after PRU_SHUTDOWN), and just have to play tedious game waiting
285 * for peer to send FIN or not respond to keep-alives, etc.
286 * We can let the user exit from the close as soon as the FIN is acked.
287 */
288void
blueswir1511d2b12009-03-07 15:32:56 +0000289tcp_sockclosed(struct tcpcb *tp)
bellardf0cbd3e2004-04-22 00:10:48 +0000290{
291
292 DEBUG_CALL("tcp_sockclosed");
293 DEBUG_ARG("tp = %lx", (long)tp);
ths5fafdf22007-09-16 21:08:06 +0000294
bellardf0cbd3e2004-04-22 00:10:48 +0000295 switch (tp->t_state) {
296
297 case TCPS_CLOSED:
298 case TCPS_LISTEN:
299 case TCPS_SYN_SENT:
300 tp->t_state = TCPS_CLOSED;
301 tp = tcp_close(tp);
302 break;
303
304 case TCPS_SYN_RECEIVED:
305 case TCPS_ESTABLISHED:
306 tp->t_state = TCPS_FIN_WAIT_1;
307 break;
308
309 case TCPS_CLOSE_WAIT:
310 tp->t_state = TCPS_LAST_ACK;
311 break;
312 }
bellardf0cbd3e2004-04-22 00:10:48 +0000313 if (tp)
314 tcp_output(tp);
315}
316
ths5fafdf22007-09-16 21:08:06 +0000317/*
bellardf0cbd3e2004-04-22 00:10:48 +0000318 * Connect to a host on the Internet
319 * Called by tcp_input
320 * Only do a connect, the tcp fields will be set in tcp_input
321 * return 0 if there's a result of the connect,
322 * else return -1 means we're still connecting
323 * The return value is almost always -1 since the socket is
ths5fafdf22007-09-16 21:08:06 +0000324 * nonblocking. Connect returns after the SYN is sent, and does
bellardf0cbd3e2004-04-22 00:10:48 +0000325 * not wait for ACK+SYN.
326 */
blueswir1511d2b12009-03-07 15:32:56 +0000327int tcp_fconnect(struct socket *so)
bellardf0cbd3e2004-04-22 00:10:48 +0000328{
Jan Kiszka460fec62009-06-24 14:42:31 +0200329 Slirp *slirp = so->slirp;
bellardf0cbd3e2004-04-22 00:10:48 +0000330 int ret=0;
ths3b46e622007-09-17 08:09:54 +0000331
bellardf0cbd3e2004-04-22 00:10:48 +0000332 DEBUG_CALL("tcp_fconnect");
333 DEBUG_ARG("so = %lx", (long )so);
334
Kevin Wolf40ff6d72009-12-02 12:24:42 +0100335 if( (ret = so->s = qemu_socket(AF_INET,SOCK_STREAM,0)) >= 0) {
bellardf0cbd3e2004-04-22 00:10:48 +0000336 int opt, s=so->s;
337 struct sockaddr_in addr;
338
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +0100339 qemu_set_nonblock(s);
Sebastian Ottlikaad12392013-10-02 12:23:15 +0200340 socket_set_fast_reuse(s);
bellardf0cbd3e2004-04-22 00:10:48 +0000341 opt = 1;
Stefan Weil9957fc72013-03-08 19:58:32 +0100342 qemu_setsockopt(s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(opt));
ths3b46e622007-09-17 08:09:54 +0000343
bellardf0cbd3e2004-04-22 00:10:48 +0000344 addr.sin_family = AF_INET;
Jan Kiszka460fec62009-06-24 14:42:31 +0200345 if ((so->so_faddr.s_addr & slirp->vnetwork_mask.s_addr) ==
346 slirp->vnetwork_addr.s_addr) {
bellardf0cbd3e2004-04-22 00:10:48 +0000347 /* It's an alias */
Jan Kiszka460fec62009-06-24 14:42:31 +0200348 if (so->so_faddr.s_addr == slirp->vnameserver_addr.s_addr) {
Ed Swierkdf7a86e2009-08-20 19:00:31 -0700349 if (get_dns_addr(&addr.sin_addr) < 0)
350 addr.sin_addr = loopback_addr;
Jan Kiszkaa13a4122009-06-24 14:42:28 +0200351 } else {
bellardf0cbd3e2004-04-22 00:10:48 +0000352 addr.sin_addr = loopback_addr;
bellardf0cbd3e2004-04-22 00:10:48 +0000353 }
354 } else
355 addr.sin_addr = so->so_faddr;
356 addr.sin_port = so->so_fport;
ths3b46e622007-09-17 08:09:54 +0000357
bellardf0cbd3e2004-04-22 00:10:48 +0000358 DEBUG_MISC((dfd, " connect()ing, addr.sin_port=%d, "
ths5fafdf22007-09-16 21:08:06 +0000359 "addr.sin_addr.s_addr=%.16s\n",
bellardf0cbd3e2004-04-22 00:10:48 +0000360 ntohs(addr.sin_port), inet_ntoa(addr.sin_addr)));
361 /* We don't care what port we get */
362 ret = connect(s,(struct sockaddr *)&addr,sizeof (addr));
ths3b46e622007-09-17 08:09:54 +0000363
bellardf0cbd3e2004-04-22 00:10:48 +0000364 /*
365 * If it's not in progress, it failed, so we just return 0,
366 * without clearing SS_NOFDREF
367 */
368 soisfconnecting(so);
369 }
370
371 return(ret);
372}
373
374/*
375 * Accept the socket and connect to the local-host
ths5fafdf22007-09-16 21:08:06 +0000376 *
bellardf0cbd3e2004-04-22 00:10:48 +0000377 * We have a problem. The correct thing to do would be
378 * to first connect to the local-host, and only if the
379 * connection is accepted, then do an accept() here.
ths5fafdf22007-09-16 21:08:06 +0000380 * But, a) we need to know who's trying to connect
bellardf0cbd3e2004-04-22 00:10:48 +0000381 * to the socket to be able to SYN the local-host, and
382 * b) we are already connected to the foreign host by
383 * the time it gets to accept(), so... We simply accept
384 * here and SYN the local-host.
ths5fafdf22007-09-16 21:08:06 +0000385 */
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900386void tcp_connect(struct socket *inso)
bellardf0cbd3e2004-04-22 00:10:48 +0000387{
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900388 Slirp *slirp = inso->slirp;
389 struct socket *so;
390 struct sockaddr_in addr;
391 socklen_t addrlen = sizeof(struct sockaddr_in);
392 struct tcpcb *tp;
393 int s, opt;
bellardf0cbd3e2004-04-22 00:10:48 +0000394
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900395 DEBUG_CALL("tcp_connect");
396 DEBUG_ARG("inso = %lx", (long)inso);
ths5fafdf22007-09-16 21:08:06 +0000397
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900398 /*
399 * If it's an SS_ACCEPTONCE socket, no need to socreate()
400 * another socket, just use the accept() socket.
401 */
402 if (inso->so_state & SS_FACCEPTONCE) {
403 /* FACCEPTONCE already have a tcpcb */
404 so = inso;
405 } else {
406 so = socreate(slirp);
407 if (so == NULL) {
408 /* If it failed, get rid of the pending connection */
409 closesocket(accept(inso->s, (struct sockaddr *)&addr, &addrlen));
410 return;
Anders Waldenborg648cd332012-07-13 22:54:17 +0200411 }
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900412 if (tcp_attach(so) < 0) {
413 free(so); /* NOT sofree */
414 return;
415 }
416 so->so_laddr = inso->so_laddr;
417 so->so_lport = inso->so_lport;
418 }
ths5fafdf22007-09-16 21:08:06 +0000419
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900420 tcp_mss(sototcpcb(so), 0);
ths5fafdf22007-09-16 21:08:06 +0000421
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900422 s = accept(inso->s, (struct sockaddr *)&addr, &addrlen);
423 if (s < 0) {
424 tcp_close(sototcpcb(so)); /* This will sofree() as well */
425 return;
426 }
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +0100427 qemu_set_nonblock(s);
Sebastian Ottlikaad12392013-10-02 12:23:15 +0200428 socket_set_fast_reuse(s);
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900429 opt = 1;
Stefan Weil9957fc72013-03-08 19:58:32 +0100430 qemu_setsockopt(s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(int));
MORITA Kazutakabf1c8522013-02-22 12:39:50 +0900431 socket_set_nodelay(s);
bellardf0cbd3e2004-04-22 00:10:48 +0000432
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900433 so->so_fport = addr.sin_port;
434 so->so_faddr = addr.sin_addr;
435 /* Translate connections from localhost to the real hostname */
436 if (so->so_faddr.s_addr == 0 ||
437 (so->so_faddr.s_addr & loopback_mask) ==
438 (loopback_addr.s_addr & loopback_mask)) {
439 so->so_faddr = slirp->vhost_addr;
440 }
ths5fafdf22007-09-16 21:08:06 +0000441
MORITA Kazutaka4ef7b892013-02-22 12:39:49 +0900442 /* Close the accept() socket, set right state */
443 if (inso->so_state & SS_FACCEPTONCE) {
444 /* If we only accept once, close the accept() socket */
445 closesocket(so->s);
446
447 /* Don't select it yet, even though we have an FD */
448 /* if it's not FACCEPTONCE, it's already NOFDREF */
449 so->so_state = SS_NOFDREF;
450 }
451 so->s = s;
452 so->so_state |= SS_INCOMING;
453
454 so->so_iptos = tcp_tos(so);
455 tp = sototcpcb(so);
456
457 tcp_template(tp);
458
459 tp->t_state = TCPS_SYN_SENT;
460 tp->t_timer[TCPT_KEEP] = TCPTV_KEEP_INIT;
461 tp->iss = slirp->tcp_iss;
462 slirp->tcp_iss += TCP_ISSINCR/2;
463 tcp_sendseqinit(tp);
464 tcp_output(tp);
bellardf0cbd3e2004-04-22 00:10:48 +0000465}
466
467/*
468 * Attach a TCPCB to a socket.
469 */
470int
blueswir1511d2b12009-03-07 15:32:56 +0000471tcp_attach(struct socket *so)
bellardf0cbd3e2004-04-22 00:10:48 +0000472{
473 if ((so->so_tcpcb = tcp_newtcpcb(so)) == NULL)
474 return -1;
ths5fafdf22007-09-16 21:08:06 +0000475
Jan Kiszka460fec62009-06-24 14:42:31 +0200476 insque(so, &so->slirp->tcb);
bellardf0cbd3e2004-04-22 00:10:48 +0000477
478 return 0;
479}
480
481/*
482 * Set the socket's type of service field
483 */
blueswir19634d902007-10-26 19:01:16 +0000484static const struct tos_t tcptos[] = {
bellardf0cbd3e2004-04-22 00:10:48 +0000485 {0, 20, IPTOS_THROUGHPUT, 0}, /* ftp data */
486 {21, 21, IPTOS_LOWDELAY, EMU_FTP}, /* ftp control */
487 {0, 23, IPTOS_LOWDELAY, 0}, /* telnet */
488 {0, 80, IPTOS_THROUGHPUT, 0}, /* WWW */
489 {0, 513, IPTOS_LOWDELAY, EMU_RLOGIN|EMU_NOCONNECT}, /* rlogin */
490 {0, 514, IPTOS_LOWDELAY, EMU_RSH|EMU_NOCONNECT}, /* shell */
491 {0, 544, IPTOS_LOWDELAY, EMU_KSH}, /* kshell */
492 {0, 543, IPTOS_LOWDELAY, 0}, /* klogin */
493 {0, 6667, IPTOS_THROUGHPUT, EMU_IRC}, /* IRC */
494 {0, 6668, IPTOS_THROUGHPUT, EMU_IRC}, /* IRC undernet */
495 {0, 7070, IPTOS_LOWDELAY, EMU_REALAUDIO }, /* RealAudio control */
496 {0, 113, IPTOS_LOWDELAY, EMU_IDENT }, /* identd protocol */
497 {0, 0, 0, 0}
498};
499
Jan Kiszka0d62c4c2009-06-24 14:42:29 +0200500static struct emu_t *tcpemu = NULL;
ths3b46e622007-09-17 08:09:54 +0000501
bellardf0cbd3e2004-04-22 00:10:48 +0000502/*
503 * Return TOS according to the above table
504 */
Stefan Weilb6dce922010-07-22 22:15:23 +0200505uint8_t
blueswir1511d2b12009-03-07 15:32:56 +0000506tcp_tos(struct socket *so)
bellardf0cbd3e2004-04-22 00:10:48 +0000507{
508 int i = 0;
509 struct emu_t *emup;
ths5fafdf22007-09-16 21:08:06 +0000510
bellardf0cbd3e2004-04-22 00:10:48 +0000511 while(tcptos[i].tos) {
512 if ((tcptos[i].fport && (ntohs(so->so_fport) == tcptos[i].fport)) ||
513 (tcptos[i].lport && (ntohs(so->so_lport) == tcptos[i].lport))) {
514 so->so_emu = tcptos[i].emu;
515 return tcptos[i].tos;
516 }
517 i++;
518 }
ths5fafdf22007-09-16 21:08:06 +0000519
bellardf0cbd3e2004-04-22 00:10:48 +0000520 /* Nope, lets see if there's a user-added one */
521 for (emup = tcpemu; emup; emup = emup->next) {
522 if ((emup->fport && (ntohs(so->so_fport) == emup->fport)) ||
523 (emup->lport && (ntohs(so->so_lport) == emup->lport))) {
524 so->so_emu = emup->emu;
525 return emup->tos;
526 }
527 }
ths5fafdf22007-09-16 21:08:06 +0000528
bellardf0cbd3e2004-04-22 00:10:48 +0000529 return 0;
530}
531
bellardf0cbd3e2004-04-22 00:10:48 +0000532/*
533 * Emulate programs that try and connect to us
534 * This includes ftp (the data connection is
535 * initiated by the server) and IRC (DCC CHAT and
536 * DCC SEND) for now
ths5fafdf22007-09-16 21:08:06 +0000537 *
bellardf0cbd3e2004-04-22 00:10:48 +0000538 * NOTE: It's possible to crash SLiRP by sending it
539 * unstandard strings to emulate... if this is a problem,
540 * more checks are needed here
541 *
542 * XXX Assumes the whole command came in one packet
ths3b46e622007-09-17 08:09:54 +0000543 *
bellardf0cbd3e2004-04-22 00:10:48 +0000544 * XXX Some ftp clients will have their TOS set to
545 * LOWDELAY and so Nagel will kick in. Because of this,
546 * we'll get the first letter, followed by the rest, so
547 * we simply scan for ORT instead of PORT...
548 * DCC doesn't have this problem because there's other stuff
549 * in the packet before the DCC command.
ths5fafdf22007-09-16 21:08:06 +0000550 *
551 * Return 1 if the mbuf m is still valid and should be
bellardf0cbd3e2004-04-22 00:10:48 +0000552 * sbappend()ed
ths5fafdf22007-09-16 21:08:06 +0000553 *
bellardf0cbd3e2004-04-22 00:10:48 +0000554 * NOTE: if you return 0 you MUST m_free() the mbuf!
555 */
556int
blueswir1511d2b12009-03-07 15:32:56 +0000557tcp_emu(struct socket *so, struct mbuf *m)
bellardf0cbd3e2004-04-22 00:10:48 +0000558{
Jan Kiszka460fec62009-06-24 14:42:31 +0200559 Slirp *slirp = so->slirp;
bellardf0cbd3e2004-04-22 00:10:48 +0000560 u_int n1, n2, n3, n4, n5, n6;
blueswir1363a37d2008-08-21 17:58:08 +0000561 char buff[257];
Stefan Weilb6dce922010-07-22 22:15:23 +0200562 uint32_t laddr;
bellardf0cbd3e2004-04-22 00:10:48 +0000563 u_int lport;
564 char *bptr;
ths5fafdf22007-09-16 21:08:06 +0000565
bellardf0cbd3e2004-04-22 00:10:48 +0000566 DEBUG_CALL("tcp_emu");
567 DEBUG_ARG("so = %lx", (long)so);
568 DEBUG_ARG("m = %lx", (long)m);
ths5fafdf22007-09-16 21:08:06 +0000569
bellardf0cbd3e2004-04-22 00:10:48 +0000570 switch(so->so_emu) {
571 int x, i;
ths3b46e622007-09-17 08:09:54 +0000572
bellardf0cbd3e2004-04-22 00:10:48 +0000573 case EMU_IDENT:
574 /*
575 * Identification protocol as per rfc-1413
576 */
ths3b46e622007-09-17 08:09:54 +0000577
bellardf0cbd3e2004-04-22 00:10:48 +0000578 {
579 struct socket *tmpso;
580 struct sockaddr_in addr;
blueswir1b55266b2008-09-20 08:07:15 +0000581 socklen_t addrlen = sizeof(struct sockaddr_in);
bellardf0cbd3e2004-04-22 00:10:48 +0000582 struct sbuf *so_rcv = &so->so_rcv;
ths3b46e622007-09-17 08:09:54 +0000583
bellardf0cbd3e2004-04-22 00:10:48 +0000584 memcpy(so_rcv->sb_wptr, m->m_data, m->m_len);
585 so_rcv->sb_wptr += m->m_len;
586 so_rcv->sb_rptr += m->m_len;
587 m->m_data[m->m_len] = 0; /* NULL terminate */
588 if (strchr(m->m_data, '\r') || strchr(m->m_data, '\n')) {
blueswir19634d902007-10-26 19:01:16 +0000589 if (sscanf(so_rcv->sb_data, "%u%*[ ,]%u", &n1, &n2) == 2) {
bellardf0cbd3e2004-04-22 00:10:48 +0000590 HTONS(n1);
591 HTONS(n2);
592 /* n2 is the one on our host */
Jan Kiszka460fec62009-06-24 14:42:31 +0200593 for (tmpso = slirp->tcb.so_next;
594 tmpso != &slirp->tcb;
595 tmpso = tmpso->so_next) {
bellardf0cbd3e2004-04-22 00:10:48 +0000596 if (tmpso->so_laddr.s_addr == so->so_laddr.s_addr &&
597 tmpso->so_lport == n2 &&
598 tmpso->so_faddr.s_addr == so->so_faddr.s_addr &&
599 tmpso->so_fport == n1) {
600 if (getsockname(tmpso->s,
601 (struct sockaddr *)&addr, &addrlen) == 0)
602 n2 = ntohs(addr.sin_port);
603 break;
604 }
605 }
606 }
blueswir1363a37d2008-08-21 17:58:08 +0000607 so_rcv->sb_cc = snprintf(so_rcv->sb_data,
608 so_rcv->sb_datalen,
609 "%d,%d\r\n", n1, n2);
bellardf0cbd3e2004-04-22 00:10:48 +0000610 so_rcv->sb_rptr = so_rcv->sb_data;
611 so_rcv->sb_wptr = so_rcv->sb_data + so_rcv->sb_cc;
612 }
613 m_free(m);
614 return 0;
615 }
ths3b46e622007-09-17 08:09:54 +0000616
bellardf0cbd3e2004-04-22 00:10:48 +0000617 case EMU_FTP: /* ftp */
blueswir1511d2b12009-03-07 15:32:56 +0000618 *(m->m_data+m->m_len) = 0; /* NUL terminate for strstr */
bellardf0cbd3e2004-04-22 00:10:48 +0000619 if ((bptr = (char *)strstr(m->m_data, "ORT")) != NULL) {
620 /*
621 * Need to emulate the PORT command
ths3b46e622007-09-17 08:09:54 +0000622 */
blueswir19634d902007-10-26 19:01:16 +0000623 x = sscanf(bptr, "ORT %u,%u,%u,%u,%u,%u\r\n%256[^\177]",
bellardf0cbd3e2004-04-22 00:10:48 +0000624 &n1, &n2, &n3, &n4, &n5, &n6, buff);
625 if (x < 6)
626 return 1;
ths3b46e622007-09-17 08:09:54 +0000627
bellardf0cbd3e2004-04-22 00:10:48 +0000628 laddr = htonl((n1 << 24) | (n2 << 16) | (n3 << 8) | (n4));
629 lport = htons((n5 << 8) | (n6));
ths3b46e622007-09-17 08:09:54 +0000630
Jan Kiszka460fec62009-06-24 14:42:31 +0200631 if ((so = tcp_listen(slirp, INADDR_ANY, 0, laddr,
632 lport, SS_FACCEPTONCE)) == NULL) {
bellardf0cbd3e2004-04-22 00:10:48 +0000633 return 1;
Jan Kiszka460fec62009-06-24 14:42:31 +0200634 }
bellardf0cbd3e2004-04-22 00:10:48 +0000635 n6 = ntohs(so->so_fport);
ths3b46e622007-09-17 08:09:54 +0000636
bellardf0cbd3e2004-04-22 00:10:48 +0000637 n5 = (n6 >> 8) & 0xff;
638 n6 &= 0xff;
ths3b46e622007-09-17 08:09:54 +0000639
bellardf0cbd3e2004-04-22 00:10:48 +0000640 laddr = ntohl(so->so_faddr.s_addr);
ths3b46e622007-09-17 08:09:54 +0000641
bellardf0cbd3e2004-04-22 00:10:48 +0000642 n1 = ((laddr >> 24) & 0xff);
643 n2 = ((laddr >> 16) & 0xff);
644 n3 = ((laddr >> 8) & 0xff);
645 n4 = (laddr & 0xff);
ths3b46e622007-09-17 08:09:54 +0000646
bellardf0cbd3e2004-04-22 00:10:48 +0000647 m->m_len = bptr - m->m_data; /* Adjust length */
Michael Tokarev0e444862013-07-13 13:10:05 +0400648 m->m_len += snprintf(bptr, m->m_size - m->m_len,
blueswir1363a37d2008-08-21 17:58:08 +0000649 "ORT %d,%d,%d,%d,%d,%d\r\n%s",
650 n1, n2, n3, n4, n5, n6, x==7?buff:"");
bellardf0cbd3e2004-04-22 00:10:48 +0000651 return 1;
652 } else if ((bptr = (char *)strstr(m->m_data, "27 Entering")) != NULL) {
653 /*
654 * Need to emulate the PASV response
655 */
blueswir19634d902007-10-26 19:01:16 +0000656 x = sscanf(bptr, "27 Entering Passive Mode (%u,%u,%u,%u,%u,%u)\r\n%256[^\177]",
bellardf0cbd3e2004-04-22 00:10:48 +0000657 &n1, &n2, &n3, &n4, &n5, &n6, buff);
658 if (x < 6)
659 return 1;
ths3b46e622007-09-17 08:09:54 +0000660
bellardf0cbd3e2004-04-22 00:10:48 +0000661 laddr = htonl((n1 << 24) | (n2 << 16) | (n3 << 8) | (n4));
662 lport = htons((n5 << 8) | (n6));
ths3b46e622007-09-17 08:09:54 +0000663
Jan Kiszka460fec62009-06-24 14:42:31 +0200664 if ((so = tcp_listen(slirp, INADDR_ANY, 0, laddr,
665 lport, SS_FACCEPTONCE)) == NULL) {
bellardf0cbd3e2004-04-22 00:10:48 +0000666 return 1;
Jan Kiszka460fec62009-06-24 14:42:31 +0200667 }
bellardf0cbd3e2004-04-22 00:10:48 +0000668 n6 = ntohs(so->so_fport);
ths3b46e622007-09-17 08:09:54 +0000669
bellardf0cbd3e2004-04-22 00:10:48 +0000670 n5 = (n6 >> 8) & 0xff;
671 n6 &= 0xff;
ths3b46e622007-09-17 08:09:54 +0000672
bellardf0cbd3e2004-04-22 00:10:48 +0000673 laddr = ntohl(so->so_faddr.s_addr);
ths3b46e622007-09-17 08:09:54 +0000674
bellardf0cbd3e2004-04-22 00:10:48 +0000675 n1 = ((laddr >> 24) & 0xff);
676 n2 = ((laddr >> 16) & 0xff);
677 n3 = ((laddr >> 8) & 0xff);
678 n4 = (laddr & 0xff);
ths3b46e622007-09-17 08:09:54 +0000679
bellardf0cbd3e2004-04-22 00:10:48 +0000680 m->m_len = bptr - m->m_data; /* Adjust length */
Michael Tokarev0e444862013-07-13 13:10:05 +0400681 m->m_len += snprintf(bptr, m->m_size - m->m_len,
blueswir1363a37d2008-08-21 17:58:08 +0000682 "27 Entering Passive Mode (%d,%d,%d,%d,%d,%d)\r\n%s",
683 n1, n2, n3, n4, n5, n6, x==7?buff:"");
ths3b46e622007-09-17 08:09:54 +0000684
bellardf0cbd3e2004-04-22 00:10:48 +0000685 return 1;
686 }
ths3b46e622007-09-17 08:09:54 +0000687
bellardf0cbd3e2004-04-22 00:10:48 +0000688 return 1;
ths3b46e622007-09-17 08:09:54 +0000689
bellardf0cbd3e2004-04-22 00:10:48 +0000690 case EMU_KSH:
691 /*
692 * The kshell (Kerberos rsh) and shell services both pass
693 * a local port port number to carry signals to the server
694 * and stderr to the client. It is passed at the beginning
695 * of the connection as a NUL-terminated decimal ASCII string.
696 */
697 so->so_emu = 0;
698 for (lport = 0, i = 0; i < m->m_len-1; ++i) {
699 if (m->m_data[i] < '0' || m->m_data[i] > '9')
700 return 1; /* invalid number */
701 lport *= 10;
702 lport += m->m_data[i] - '0';
703 }
704 if (m->m_data[m->m_len-1] == '\0' && lport != 0 &&
Jan Kiszka460fec62009-06-24 14:42:31 +0200705 (so = tcp_listen(slirp, INADDR_ANY, 0, so->so_laddr.s_addr,
706 htons(lport), SS_FACCEPTONCE)) != NULL)
Michael Tokarev0e444862013-07-13 13:10:05 +0400707 m->m_len = snprintf(m->m_data, m->m_size, "%d",
blueswir1363a37d2008-08-21 17:58:08 +0000708 ntohs(so->so_fport)) + 1;
bellardf0cbd3e2004-04-22 00:10:48 +0000709 return 1;
ths3b46e622007-09-17 08:09:54 +0000710
bellardf0cbd3e2004-04-22 00:10:48 +0000711 case EMU_IRC:
712 /*
713 * Need to emulate DCC CHAT, DCC SEND and DCC MOVE
714 */
715 *(m->m_data+m->m_len) = 0; /* NULL terminate the string for strstr */
716 if ((bptr = (char *)strstr(m->m_data, "DCC")) == NULL)
717 return 1;
ths3b46e622007-09-17 08:09:54 +0000718
bellardf0cbd3e2004-04-22 00:10:48 +0000719 /* The %256s is for the broken mIRC */
720 if (sscanf(bptr, "DCC CHAT %256s %u %u", buff, &laddr, &lport) == 3) {
Jan Kiszka460fec62009-06-24 14:42:31 +0200721 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
722 htonl(laddr), htons(lport),
723 SS_FACCEPTONCE)) == NULL) {
bellardf0cbd3e2004-04-22 00:10:48 +0000724 return 1;
Jan Kiszka460fec62009-06-24 14:42:31 +0200725 }
bellardf0cbd3e2004-04-22 00:10:48 +0000726 m->m_len = bptr - m->m_data; /* Adjust length */
Michael Tokarev0e444862013-07-13 13:10:05 +0400727 m->m_len += snprintf(bptr, m->m_size,
blueswir1363a37d2008-08-21 17:58:08 +0000728 "DCC CHAT chat %lu %u%c\n",
729 (unsigned long)ntohl(so->so_faddr.s_addr),
730 ntohs(so->so_fport), 1);
bellardf0cbd3e2004-04-22 00:10:48 +0000731 } else if (sscanf(bptr, "DCC SEND %256s %u %u %u", buff, &laddr, &lport, &n1) == 4) {
Jan Kiszka460fec62009-06-24 14:42:31 +0200732 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
733 htonl(laddr), htons(lport),
734 SS_FACCEPTONCE)) == NULL) {
bellardf0cbd3e2004-04-22 00:10:48 +0000735 return 1;
Jan Kiszka460fec62009-06-24 14:42:31 +0200736 }
bellardf0cbd3e2004-04-22 00:10:48 +0000737 m->m_len = bptr - m->m_data; /* Adjust length */
Michael Tokarev0e444862013-07-13 13:10:05 +0400738 m->m_len += snprintf(bptr, m->m_size,
blueswir1363a37d2008-08-21 17:58:08 +0000739 "DCC SEND %s %lu %u %u%c\n", buff,
740 (unsigned long)ntohl(so->so_faddr.s_addr),
741 ntohs(so->so_fport), n1, 1);
bellardf0cbd3e2004-04-22 00:10:48 +0000742 } else if (sscanf(bptr, "DCC MOVE %256s %u %u %u", buff, &laddr, &lport, &n1) == 4) {
Jan Kiszka460fec62009-06-24 14:42:31 +0200743 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
744 htonl(laddr), htons(lport),
745 SS_FACCEPTONCE)) == NULL) {
bellardf0cbd3e2004-04-22 00:10:48 +0000746 return 1;
Jan Kiszka460fec62009-06-24 14:42:31 +0200747 }
bellardf0cbd3e2004-04-22 00:10:48 +0000748 m->m_len = bptr - m->m_data; /* Adjust length */
Michael Tokarev0e444862013-07-13 13:10:05 +0400749 m->m_len += snprintf(bptr, m->m_size,
blueswir1363a37d2008-08-21 17:58:08 +0000750 "DCC MOVE %s %lu %u %u%c\n", buff,
751 (unsigned long)ntohl(so->so_faddr.s_addr),
752 ntohs(so->so_fport), n1, 1);
bellardf0cbd3e2004-04-22 00:10:48 +0000753 }
754 return 1;
755
756 case EMU_REALAUDIO:
ths5fafdf22007-09-16 21:08:06 +0000757 /*
bellardf0cbd3e2004-04-22 00:10:48 +0000758 * RealAudio emulation - JP. We must try to parse the incoming
759 * data and try to find the two characters that contain the
760 * port number. Then we redirect an udp port and replace the
761 * number with the real port we got.
762 *
763 * The 1.0 beta versions of the player are not supported
764 * any more.
ths5fafdf22007-09-16 21:08:06 +0000765 *
bellardf0cbd3e2004-04-22 00:10:48 +0000766 * A typical packet for player version 1.0 (release version):
ths3b46e622007-09-17 08:09:54 +0000767 *
ths5fafdf22007-09-16 21:08:06 +0000768 * 0000:50 4E 41 00 05
Jan Kiszka0d62c4c2009-06-24 14:42:29 +0200769 * 0000:00 01 00 02 1B D7 00 00 67 E6 6C DC 63 00 12 50 ........g.l.c..P
bellardf0cbd3e2004-04-22 00:10:48 +0000770 * 0010:4E 43 4C 49 45 4E 54 20 31 30 31 20 41 4C 50 48 NCLIENT 101 ALPH
771 * 0020:41 6C 00 00 52 00 17 72 61 66 69 6C 65 73 2F 76 Al..R..rafiles/v
772 * 0030:6F 61 2F 65 6E 67 6C 69 73 68 5F 2E 72 61 79 42 oa/english_.rayB
ths3b46e622007-09-17 08:09:54 +0000773 *
bellardf0cbd3e2004-04-22 00:10:48 +0000774 * Now the port number 0x1BD7 is found at offset 0x04 of the
775 * Now the port number 0x1BD7 is found at offset 0x04 of the
776 * second packet. This time we received five bytes first and
777 * then the rest. You never know how many bytes you get.
778 *
779 * A typical packet for player version 2.0 (beta):
ths3b46e622007-09-17 08:09:54 +0000780 *
Jan Kiszka0d62c4c2009-06-24 14:42:29 +0200781 * 0000:50 4E 41 00 06 00 02 00 00 00 01 00 02 1B C1 00 PNA.............
782 * 0010:00 67 75 78 F5 63 00 0A 57 69 6E 32 2E 30 2E 30 .gux.c..Win2.0.0
bellardf0cbd3e2004-04-22 00:10:48 +0000783 * 0020:2E 35 6C 00 00 52 00 1C 72 61 66 69 6C 65 73 2F .5l..R..rafiles/
784 * 0030:77 65 62 73 69 74 65 2F 32 30 72 65 6C 65 61 73 website/20releas
785 * 0040:65 2E 72 61 79 53 00 00 06 36 42 e.rayS...6B
ths3b46e622007-09-17 08:09:54 +0000786 *
bellardf0cbd3e2004-04-22 00:10:48 +0000787 * Port number 0x1BC1 is found at offset 0x0d.
ths3b46e622007-09-17 08:09:54 +0000788 *
bellardf0cbd3e2004-04-22 00:10:48 +0000789 * This is just a horrible switch statement. Variable ra tells
790 * us where we're going.
791 */
ths3b46e622007-09-17 08:09:54 +0000792
bellardf0cbd3e2004-04-22 00:10:48 +0000793 bptr = m->m_data;
794 while (bptr < m->m_data + m->m_len) {
795 u_short p;
796 static int ra = 0;
ths5fafdf22007-09-16 21:08:06 +0000797 char ra_tbl[4];
ths3b46e622007-09-17 08:09:54 +0000798
bellardf0cbd3e2004-04-22 00:10:48 +0000799 ra_tbl[0] = 0x50;
800 ra_tbl[1] = 0x4e;
801 ra_tbl[2] = 0x41;
802 ra_tbl[3] = 0;
ths3b46e622007-09-17 08:09:54 +0000803
bellardf0cbd3e2004-04-22 00:10:48 +0000804 switch (ra) {
805 case 0:
806 case 2:
807 case 3:
808 if (*bptr++ != ra_tbl[ra]) {
809 ra = 0;
810 continue;
811 }
812 break;
ths3b46e622007-09-17 08:09:54 +0000813
bellardf0cbd3e2004-04-22 00:10:48 +0000814 case 1:
815 /*
816 * We may get 0x50 several times, ignore them
817 */
818 if (*bptr == 0x50) {
819 ra = 1;
820 bptr++;
821 continue;
822 } else if (*bptr++ != ra_tbl[ra]) {
823 ra = 0;
824 continue;
825 }
826 break;
ths3b46e622007-09-17 08:09:54 +0000827
ths5fafdf22007-09-16 21:08:06 +0000828 case 4:
829 /*
bellardf0cbd3e2004-04-22 00:10:48 +0000830 * skip version number
831 */
832 bptr++;
833 break;
ths3b46e622007-09-17 08:09:54 +0000834
ths5fafdf22007-09-16 21:08:06 +0000835 case 5:
bellardf0cbd3e2004-04-22 00:10:48 +0000836 /*
837 * The difference between versions 1.0 and
838 * 2.0 is here. For future versions of
839 * the player this may need to be modified.
840 */
841 if (*(bptr + 1) == 0x02)
842 bptr += 8;
843 else
844 bptr += 4;
ths3b46e622007-09-17 08:09:54 +0000845 break;
846
bellardf0cbd3e2004-04-22 00:10:48 +0000847 case 6:
848 /* This is the field containing the port
849 * number that RA-player is listening to.
850 */
ths5fafdf22007-09-16 21:08:06 +0000851 lport = (((u_char*)bptr)[0] << 8)
bellardf0cbd3e2004-04-22 00:10:48 +0000852 + ((u_char *)bptr)[1];
ths3b46e622007-09-17 08:09:54 +0000853 if (lport < 6970)
bellardf0cbd3e2004-04-22 00:10:48 +0000854 lport += 256; /* don't know why */
855 if (lport < 6970 || lport > 7170)
856 return 1; /* failed */
ths3b46e622007-09-17 08:09:54 +0000857
bellardf0cbd3e2004-04-22 00:10:48 +0000858 /* try to get udp port between 6970 - 7170 */
859 for (p = 6970; p < 7071; p++) {
Jan Kiszka460fec62009-06-24 14:42:31 +0200860 if (udp_listen(slirp, INADDR_ANY,
Jan Kiszka3c6a0582009-06-24 14:42:28 +0200861 htons(p),
bellardf0cbd3e2004-04-22 00:10:48 +0000862 so->so_laddr.s_addr,
863 htons(lport),
864 SS_FACCEPTONCE)) {
865 break;
866 }
867 }
868 if (p == 7071)
869 p = 0;
870 *(u_char *)bptr++ = (p >> 8) & 0xff;
Blue Swirl369c86e2010-03-07 13:45:37 +0000871 *(u_char *)bptr = p & 0xff;
ths5fafdf22007-09-16 21:08:06 +0000872 ra = 0;
bellardf0cbd3e2004-04-22 00:10:48 +0000873 return 1; /* port redirected, we're done */
ths3b46e622007-09-17 08:09:54 +0000874 break;
875
bellardf0cbd3e2004-04-22 00:10:48 +0000876 default:
ths3b46e622007-09-17 08:09:54 +0000877 ra = 0;
bellardf0cbd3e2004-04-22 00:10:48 +0000878 }
879 ra++;
880 }
ths3b46e622007-09-17 08:09:54 +0000881 return 1;
882
bellardf0cbd3e2004-04-22 00:10:48 +0000883 default:
884 /* Ooops, not emulated, won't call tcp_emu again */
885 so->so_emu = 0;
886 return 1;
887 }
888}
889
890/*
891 * Do misc. config of SLiRP while its running.
892 * Return 0 if this connections is to be closed, 1 otherwise,
893 * return 2 if this is a command-line connection
894 */
Jan Kiszkab35725c2009-06-24 14:42:28 +0200895int tcp_ctl(struct socket *so)
bellardf0cbd3e2004-04-22 00:10:48 +0000896{
Jan Kiszka460fec62009-06-24 14:42:31 +0200897 Slirp *slirp = so->slirp;
Jan Kiszkab35725c2009-06-24 14:42:28 +0200898 struct sbuf *sb = &so->so_snd;
899 struct ex_list *ex_ptr;
900 int do_pty;
ths5fafdf22007-09-16 21:08:06 +0000901
Jan Kiszkab35725c2009-06-24 14:42:28 +0200902 DEBUG_CALL("tcp_ctl");
903 DEBUG_ARG("so = %lx", (long )so);
ths5fafdf22007-09-16 21:08:06 +0000904
Jan Kiszka460fec62009-06-24 14:42:31 +0200905 if (so->so_faddr.s_addr != slirp->vhost_addr.s_addr) {
Jan Kiszkab35725c2009-06-24 14:42:28 +0200906 /* Check if it's pty_exec */
Jan Kiszka460fec62009-06-24 14:42:31 +0200907 for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
Jan Kiszkab35725c2009-06-24 14:42:28 +0200908 if (ex_ptr->ex_fport == so->so_fport &&
Jan Kiszkaa13a4122009-06-24 14:42:28 +0200909 so->so_faddr.s_addr == ex_ptr->ex_addr.s_addr) {
Jan Kiszkab35725c2009-06-24 14:42:28 +0200910 if (ex_ptr->ex_pty == 3) {
911 so->s = -1;
912 so->extra = (void *)ex_ptr->ex_exec;
913 return 1;
914 }
915 do_pty = ex_ptr->ex_pty;
Stefan Weilb2bedb22011-09-12 22:33:01 +0200916 DEBUG_MISC((dfd, " executing %s\n", ex_ptr->ex_exec));
Jan Kiszkab35725c2009-06-24 14:42:28 +0200917 return fork_exec(so, ex_ptr->ex_exec, do_pty);
918 }
919 }
920 }
921 sb->sb_cc =
922 snprintf(sb->sb_wptr, sb->sb_datalen - (sb->sb_wptr - sb->sb_data),
923 "Error: No application configured.\r\n");
924 sb->sb_wptr += sb->sb_cc;
925 return 0;
bellardf0cbd3e2004-04-22 00:10:48 +0000926}