]> git.proxmox.com Git - mirror_qemu.git/blob - slirp/src/tcp_subr.c
slirp: clarify license of slirp files using SPDX: explicit BSD
[mirror_qemu.git] / slirp / src / tcp_subr.c
1 /* SPDX-License-Identifier: BSD-3-Clause */
2 /*
3 * Copyright (c) 1982, 1986, 1988, 1990, 1993
4 * The Regents of the University of California. All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. Neither the name of the University nor the names of its contributors
15 * may be used to endorse or promote products derived from this software
16 * without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 * SUCH DAMAGE.
29 *
30 * @(#)tcp_subr.c 8.1 (Berkeley) 6/10/93
31 * tcp_subr.c,v 1.5 1994/10/08 22:39:58 phk Exp
32 */
33
34 /*
35 * Changes and additions relating to SLiRP
36 * Copyright (c) 1995 Danny Gasparovski.
37 *
38 * Please read the file COPYRIGHT for the
39 * terms and conditions of the copyright.
40 */
41
42 #include "slirp.h"
43
44 /* patchable/settable parameters for tcp */
45 /* Don't do rfc1323 performance enhancements */
46 #define TCP_DO_RFC1323 0
47
48 /*
49 * Tcp initialization
50 */
51 void
52 tcp_init(Slirp *slirp)
53 {
54 slirp->tcp_iss = 1; /* wrong */
55 slirp->tcb.so_next = slirp->tcb.so_prev = &slirp->tcb;
56 slirp->tcp_last_so = &slirp->tcb;
57 }
58
59 void tcp_cleanup(Slirp *slirp)
60 {
61 while (slirp->tcb.so_next != &slirp->tcb) {
62 tcp_close(sototcpcb(slirp->tcb.so_next));
63 }
64 }
65
66 /*
67 * Create template to be used to send tcp packets on a connection.
68 * Call after host entry created, fills
69 * in a skeletal tcp/ip header, minimizing the amount of work
70 * necessary when the connection is used.
71 */
72 void
73 tcp_template(struct tcpcb *tp)
74 {
75 struct socket *so = tp->t_socket;
76 register struct tcpiphdr *n = &tp->t_template;
77
78 n->ti_mbuf = NULL;
79 memset(&n->ti, 0, sizeof(n->ti));
80 n->ti_x0 = 0;
81 switch (so->so_ffamily) {
82 case AF_INET:
83 n->ti_pr = IPPROTO_TCP;
84 n->ti_len = htons(sizeof(struct tcphdr));
85 n->ti_src = so->so_faddr;
86 n->ti_dst = so->so_laddr;
87 n->ti_sport = so->so_fport;
88 n->ti_dport = so->so_lport;
89 break;
90
91 case AF_INET6:
92 n->ti_nh6 = IPPROTO_TCP;
93 n->ti_len = htons(sizeof(struct tcphdr));
94 n->ti_src6 = so->so_faddr6;
95 n->ti_dst6 = so->so_laddr6;
96 n->ti_sport = so->so_fport6;
97 n->ti_dport = so->so_lport6;
98 break;
99
100 default:
101 g_assert_not_reached();
102 }
103
104 n->ti_seq = 0;
105 n->ti_ack = 0;
106 n->ti_x2 = 0;
107 n->ti_off = 5;
108 n->ti_flags = 0;
109 n->ti_win = 0;
110 n->ti_sum = 0;
111 n->ti_urp = 0;
112 }
113
114 /*
115 * Send a single message to the TCP at address specified by
116 * the given TCP/IP header. If m == 0, then we make a copy
117 * of the tcpiphdr at ti and send directly to the addressed host.
118 * This is used to force keep alive messages out using the TCP
119 * template for a connection tp->t_template. If flags are given
120 * then we send a message back to the TCP which originated the
121 * segment ti, and discard the mbuf containing it and any other
122 * attached mbufs.
123 *
124 * In any case the ack and sequence number of the transmitted
125 * segment are as specified by the parameters.
126 */
127 void
128 tcp_respond(struct tcpcb *tp, struct tcpiphdr *ti, struct mbuf *m,
129 tcp_seq ack, tcp_seq seq, int flags, unsigned short af)
130 {
131 register int tlen;
132 int win = 0;
133
134 DEBUG_CALL("tcp_respond");
135 DEBUG_ARG("tp = %p", tp);
136 DEBUG_ARG("ti = %p", ti);
137 DEBUG_ARG("m = %p", m);
138 DEBUG_ARG("ack = %u", ack);
139 DEBUG_ARG("seq = %u", seq);
140 DEBUG_ARG("flags = %x", flags);
141
142 if (tp)
143 win = sbspace(&tp->t_socket->so_rcv);
144 if (m == NULL) {
145 if (!tp || (m = m_get(tp->t_socket->slirp)) == NULL)
146 return;
147 tlen = 0;
148 m->m_data += IF_MAXLINKHDR;
149 *mtod(m, struct tcpiphdr *) = *ti;
150 ti = mtod(m, struct tcpiphdr *);
151 switch (af) {
152 case AF_INET:
153 ti->ti.ti_i4.ih_x1 = 0;
154 break;
155 case AF_INET6:
156 ti->ti.ti_i6.ih_x1 = 0;
157 break;
158 default:
159 g_assert_not_reached();
160 }
161 flags = TH_ACK;
162 } else {
163 /*
164 * ti points into m so the next line is just making
165 * the mbuf point to ti
166 */
167 m->m_data = (char *)ti;
168
169 m->m_len = sizeof (struct tcpiphdr);
170 tlen = 0;
171 #define xchg(a,b,type) { type t; t=a; a=b; b=t; }
172 switch (af) {
173 case AF_INET:
174 xchg(ti->ti_dst.s_addr, ti->ti_src.s_addr, uint32_t);
175 xchg(ti->ti_dport, ti->ti_sport, uint16_t);
176 break;
177 case AF_INET6:
178 xchg(ti->ti_dst6, ti->ti_src6, struct in6_addr);
179 xchg(ti->ti_dport, ti->ti_sport, uint16_t);
180 break;
181 default:
182 g_assert_not_reached();
183 }
184 #undef xchg
185 }
186 ti->ti_len = htons((uint16_t)(sizeof (struct tcphdr) + tlen));
187 tlen += sizeof (struct tcpiphdr);
188 m->m_len = tlen;
189
190 ti->ti_mbuf = NULL;
191 ti->ti_x0 = 0;
192 ti->ti_seq = htonl(seq);
193 ti->ti_ack = htonl(ack);
194 ti->ti_x2 = 0;
195 ti->ti_off = sizeof (struct tcphdr) >> 2;
196 ti->ti_flags = flags;
197 if (tp)
198 ti->ti_win = htons((uint16_t) (win >> tp->rcv_scale));
199 else
200 ti->ti_win = htons((uint16_t)win);
201 ti->ti_urp = 0;
202 ti->ti_sum = 0;
203 ti->ti_sum = cksum(m, tlen);
204
205 struct tcpiphdr tcpiph_save = *(mtod(m, struct tcpiphdr *));
206 struct ip *ip;
207 struct ip6 *ip6;
208
209 switch (af) {
210 case AF_INET:
211 m->m_data += sizeof(struct tcpiphdr) - sizeof(struct tcphdr)
212 - sizeof(struct ip);
213 m->m_len -= sizeof(struct tcpiphdr) - sizeof(struct tcphdr)
214 - sizeof(struct ip);
215 ip = mtod(m, struct ip *);
216 ip->ip_len = m->m_len;
217 ip->ip_dst = tcpiph_save.ti_dst;
218 ip->ip_src = tcpiph_save.ti_src;
219 ip->ip_p = tcpiph_save.ti_pr;
220
221 if (flags & TH_RST) {
222 ip->ip_ttl = MAXTTL;
223 } else {
224 ip->ip_ttl = IPDEFTTL;
225 }
226
227 ip_output(NULL, m);
228 break;
229
230 case AF_INET6:
231 m->m_data += sizeof(struct tcpiphdr) - sizeof(struct tcphdr)
232 - sizeof(struct ip6);
233 m->m_len -= sizeof(struct tcpiphdr) - sizeof(struct tcphdr)
234 - sizeof(struct ip6);
235 ip6 = mtod(m, struct ip6 *);
236 ip6->ip_pl = tcpiph_save.ti_len;
237 ip6->ip_dst = tcpiph_save.ti_dst6;
238 ip6->ip_src = tcpiph_save.ti_src6;
239 ip6->ip_nh = tcpiph_save.ti_nh6;
240
241 ip6_output(NULL, m, 0);
242 break;
243
244 default:
245 g_assert_not_reached();
246 }
247 }
248
249 /*
250 * Create a new TCP control block, making an
251 * empty reassembly queue and hooking it to the argument
252 * protocol control block.
253 */
254 struct tcpcb *
255 tcp_newtcpcb(struct socket *so)
256 {
257 register struct tcpcb *tp;
258
259 tp = (struct tcpcb *)malloc(sizeof(*tp));
260 if (tp == NULL)
261 return ((struct tcpcb *)0);
262
263 memset((char *) tp, 0, sizeof(struct tcpcb));
264 tp->seg_next = tp->seg_prev = (struct tcpiphdr*)tp;
265 tp->t_maxseg = (so->so_ffamily == AF_INET) ? TCP_MSS : TCP6_MSS;
266
267 tp->t_flags = TCP_DO_RFC1323 ? (TF_REQ_SCALE|TF_REQ_TSTMP) : 0;
268 tp->t_socket = so;
269
270 /*
271 * Init srtt to TCPTV_SRTTBASE (0), so we can tell that we have no
272 * rtt estimate. Set rttvar so that srtt + 2 * rttvar gives
273 * reasonable initial retransmit time.
274 */
275 tp->t_srtt = TCPTV_SRTTBASE;
276 tp->t_rttvar = TCPTV_SRTTDFLT << 2;
277 tp->t_rttmin = TCPTV_MIN;
278
279 TCPT_RANGESET(tp->t_rxtcur,
280 ((TCPTV_SRTTBASE >> 2) + (TCPTV_SRTTDFLT << 2)) >> 1,
281 TCPTV_MIN, TCPTV_REXMTMAX);
282
283 tp->snd_cwnd = TCP_MAXWIN << TCP_MAX_WINSHIFT;
284 tp->snd_ssthresh = TCP_MAXWIN << TCP_MAX_WINSHIFT;
285 tp->t_state = TCPS_CLOSED;
286
287 so->so_tcpcb = tp;
288
289 return (tp);
290 }
291
292 /*
293 * Drop a TCP connection, reporting
294 * the specified error. If connection is synchronized,
295 * then send a RST to peer.
296 */
297 struct tcpcb *tcp_drop(struct tcpcb *tp, int err)
298 {
299 DEBUG_CALL("tcp_drop");
300 DEBUG_ARG("tp = %p", tp);
301 DEBUG_ARG("errno = %d", errno);
302
303 if (TCPS_HAVERCVDSYN(tp->t_state)) {
304 tp->t_state = TCPS_CLOSED;
305 (void) tcp_output(tp);
306 }
307 return (tcp_close(tp));
308 }
309
310 /*
311 * Close a TCP control block:
312 * discard all space held by the tcp
313 * discard internet protocol block
314 * wake up any sleepers
315 */
316 struct tcpcb *
317 tcp_close(struct tcpcb *tp)
318 {
319 register struct tcpiphdr *t;
320 struct socket *so = tp->t_socket;
321 Slirp *slirp = so->slirp;
322 register struct mbuf *m;
323
324 DEBUG_CALL("tcp_close");
325 DEBUG_ARG("tp = %p", tp);
326
327 /* free the reassembly queue, if any */
328 t = tcpfrag_list_first(tp);
329 while (!tcpfrag_list_end(t, tp)) {
330 t = tcpiphdr_next(t);
331 m = tcpiphdr_prev(t)->ti_mbuf;
332 remque(tcpiphdr2qlink(tcpiphdr_prev(t)));
333 m_free(m);
334 }
335 free(tp);
336 so->so_tcpcb = NULL;
337 /* clobber input socket cache if we're closing the cached connection */
338 if (so == slirp->tcp_last_so)
339 slirp->tcp_last_so = &slirp->tcb;
340 so->slirp->cb->unregister_poll_fd(so->s, so->slirp->opaque);
341 closesocket(so->s);
342 sbfree(&so->so_rcv);
343 sbfree(&so->so_snd);
344 sofree(so);
345 return ((struct tcpcb *)0);
346 }
347
348 /*
349 * TCP protocol interface to socket abstraction.
350 */
351
352 /*
353 * User issued close, and wish to trail through shutdown states:
354 * if never received SYN, just forget it. If got a SYN from peer,
355 * but haven't sent FIN, then go to FIN_WAIT_1 state to send peer a FIN.
356 * If already got a FIN from peer, then almost done; go to LAST_ACK
357 * state. In all other cases, have already sent FIN to peer (e.g.
358 * after PRU_SHUTDOWN), and just have to play tedious game waiting
359 * for peer to send FIN or not respond to keep-alives, etc.
360 * We can let the user exit from the close as soon as the FIN is acked.
361 */
362 void
363 tcp_sockclosed(struct tcpcb *tp)
364 {
365
366 DEBUG_CALL("tcp_sockclosed");
367 DEBUG_ARG("tp = %p", tp);
368
369 if (!tp) {
370 return;
371 }
372
373 switch (tp->t_state) {
374
375 case TCPS_CLOSED:
376 case TCPS_LISTEN:
377 case TCPS_SYN_SENT:
378 tp->t_state = TCPS_CLOSED;
379 tp = tcp_close(tp);
380 break;
381
382 case TCPS_SYN_RECEIVED:
383 case TCPS_ESTABLISHED:
384 tp->t_state = TCPS_FIN_WAIT_1;
385 break;
386
387 case TCPS_CLOSE_WAIT:
388 tp->t_state = TCPS_LAST_ACK;
389 break;
390 }
391 tcp_output(tp);
392 }
393
394 /*
395 * Connect to a host on the Internet
396 * Called by tcp_input
397 * Only do a connect, the tcp fields will be set in tcp_input
398 * return 0 if there's a result of the connect,
399 * else return -1 means we're still connecting
400 * The return value is almost always -1 since the socket is
401 * nonblocking. Connect returns after the SYN is sent, and does
402 * not wait for ACK+SYN.
403 */
404 int tcp_fconnect(struct socket *so, unsigned short af)
405 {
406 int ret=0;
407
408 DEBUG_CALL("tcp_fconnect");
409 DEBUG_ARG("so = %p", so);
410
411 ret = so->s = slirp_socket(af, SOCK_STREAM, 0);
412 if (ret >= 0) {
413 int opt, s=so->s;
414 struct sockaddr_storage addr;
415
416 slirp_set_nonblock(s);
417 so->slirp->cb->register_poll_fd(so->s, so->slirp->opaque);
418 slirp_socket_set_fast_reuse(s);
419 opt = 1;
420 setsockopt(s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(opt));
421 opt = 1;
422 setsockopt(s, IPPROTO_TCP, TCP_NODELAY, &opt, sizeof(opt));
423
424 addr = so->fhost.ss;
425 DEBUG_CALL(" connect()ing");
426 sotranslate_out(so, &addr);
427
428 /* We don't care what port we get */
429 ret = connect(s, (struct sockaddr *)&addr, sockaddr_size(&addr));
430
431 /*
432 * If it's not in progress, it failed, so we just return 0,
433 * without clearing SS_NOFDREF
434 */
435 soisfconnecting(so);
436 }
437
438 return(ret);
439 }
440
441 /*
442 * Accept the socket and connect to the local-host
443 *
444 * We have a problem. The correct thing to do would be
445 * to first connect to the local-host, and only if the
446 * connection is accepted, then do an accept() here.
447 * But, a) we need to know who's trying to connect
448 * to the socket to be able to SYN the local-host, and
449 * b) we are already connected to the foreign host by
450 * the time it gets to accept(), so... We simply accept
451 * here and SYN the local-host.
452 */
453 void tcp_connect(struct socket *inso)
454 {
455 Slirp *slirp = inso->slirp;
456 struct socket *so;
457 struct sockaddr_storage addr;
458 socklen_t addrlen = sizeof(struct sockaddr_storage);
459 struct tcpcb *tp;
460 int s, opt;
461
462 DEBUG_CALL("tcp_connect");
463 DEBUG_ARG("inso = %p", inso);
464
465 /*
466 * If it's an SS_ACCEPTONCE socket, no need to socreate()
467 * another socket, just use the accept() socket.
468 */
469 if (inso->so_state & SS_FACCEPTONCE) {
470 /* FACCEPTONCE already have a tcpcb */
471 so = inso;
472 } else {
473 so = socreate(slirp);
474 if (tcp_attach(so) < 0) {
475 g_free(so); /* NOT sofree */
476 return;
477 }
478 so->lhost = inso->lhost;
479 so->so_ffamily = inso->so_ffamily;
480 }
481
482 tcp_mss(sototcpcb(so), 0);
483
484 s = accept(inso->s, (struct sockaddr *)&addr, &addrlen);
485 if (s < 0) {
486 tcp_close(sototcpcb(so)); /* This will sofree() as well */
487 return;
488 }
489 slirp_set_nonblock(s);
490 so->slirp->cb->register_poll_fd(so->s, so->slirp->opaque);
491 slirp_socket_set_fast_reuse(s);
492 opt = 1;
493 setsockopt(s, SOL_SOCKET, SO_OOBINLINE, &opt, sizeof(int));
494 slirp_socket_set_nodelay(s);
495
496 so->fhost.ss = addr;
497 sotranslate_accept(so);
498
499 /* Close the accept() socket, set right state */
500 if (inso->so_state & SS_FACCEPTONCE) {
501 /* If we only accept once, close the accept() socket */
502 so->slirp->cb->unregister_poll_fd(so->s, so->slirp->opaque);
503 closesocket(so->s);
504
505 /* Don't select it yet, even though we have an FD */
506 /* if it's not FACCEPTONCE, it's already NOFDREF */
507 so->so_state = SS_NOFDREF;
508 }
509 so->s = s;
510 so->so_state |= SS_INCOMING;
511
512 so->so_iptos = tcp_tos(so);
513 tp = sototcpcb(so);
514
515 tcp_template(tp);
516
517 tp->t_state = TCPS_SYN_SENT;
518 tp->t_timer[TCPT_KEEP] = TCPTV_KEEP_INIT;
519 tp->iss = slirp->tcp_iss;
520 slirp->tcp_iss += TCP_ISSINCR/2;
521 tcp_sendseqinit(tp);
522 tcp_output(tp);
523 }
524
525 /*
526 * Attach a TCPCB to a socket.
527 */
528 int
529 tcp_attach(struct socket *so)
530 {
531 if ((so->so_tcpcb = tcp_newtcpcb(so)) == NULL)
532 return -1;
533
534 insque(so, &so->slirp->tcb);
535
536 return 0;
537 }
538
539 /*
540 * Set the socket's type of service field
541 */
542 static const struct tos_t tcptos[] = {
543 {0, 20, IPTOS_THROUGHPUT, 0}, /* ftp data */
544 {21, 21, IPTOS_LOWDELAY, EMU_FTP}, /* ftp control */
545 {0, 23, IPTOS_LOWDELAY, 0}, /* telnet */
546 {0, 80, IPTOS_THROUGHPUT, 0}, /* WWW */
547 {0, 513, IPTOS_LOWDELAY, EMU_RLOGIN|EMU_NOCONNECT}, /* rlogin */
548 {0, 544, IPTOS_LOWDELAY, EMU_KSH}, /* kshell */
549 {0, 543, IPTOS_LOWDELAY, 0}, /* klogin */
550 {0, 6667, IPTOS_THROUGHPUT, EMU_IRC}, /* IRC */
551 {0, 6668, IPTOS_THROUGHPUT, EMU_IRC}, /* IRC undernet */
552 {0, 7070, IPTOS_LOWDELAY, EMU_REALAUDIO }, /* RealAudio control */
553 {0, 113, IPTOS_LOWDELAY, EMU_IDENT }, /* identd protocol */
554 {0, 0, 0, 0}
555 };
556
557 static struct emu_t *tcpemu = NULL;
558
559 /*
560 * Return TOS according to the above table
561 */
562 uint8_t
563 tcp_tos(struct socket *so)
564 {
565 int i = 0;
566 struct emu_t *emup;
567
568 while(tcptos[i].tos) {
569 if ((tcptos[i].fport && (ntohs(so->so_fport) == tcptos[i].fport)) ||
570 (tcptos[i].lport && (ntohs(so->so_lport) == tcptos[i].lport))) {
571 so->so_emu = tcptos[i].emu;
572 return tcptos[i].tos;
573 }
574 i++;
575 }
576
577 /* Nope, lets see if there's a user-added one */
578 for (emup = tcpemu; emup; emup = emup->next) {
579 if ((emup->fport && (ntohs(so->so_fport) == emup->fport)) ||
580 (emup->lport && (ntohs(so->so_lport) == emup->lport))) {
581 so->so_emu = emup->emu;
582 return emup->tos;
583 }
584 }
585
586 return 0;
587 }
588
589 /*
590 * Emulate programs that try and connect to us
591 * This includes ftp (the data connection is
592 * initiated by the server) and IRC (DCC CHAT and
593 * DCC SEND) for now
594 *
595 * NOTE: It's possible to crash SLiRP by sending it
596 * unstandard strings to emulate... if this is a problem,
597 * more checks are needed here
598 *
599 * XXX Assumes the whole command came in one packet
600 *
601 * XXX Some ftp clients will have their TOS set to
602 * LOWDELAY and so Nagel will kick in. Because of this,
603 * we'll get the first letter, followed by the rest, so
604 * we simply scan for ORT instead of PORT...
605 * DCC doesn't have this problem because there's other stuff
606 * in the packet before the DCC command.
607 *
608 * Return 1 if the mbuf m is still valid and should be
609 * sbappend()ed
610 *
611 * NOTE: if you return 0 you MUST m_free() the mbuf!
612 */
613 int
614 tcp_emu(struct socket *so, struct mbuf *m)
615 {
616 Slirp *slirp = so->slirp;
617 unsigned n1, n2, n3, n4, n5, n6;
618 char buff[257];
619 uint32_t laddr;
620 unsigned lport;
621 char *bptr;
622
623 DEBUG_CALL("tcp_emu");
624 DEBUG_ARG("so = %p", so);
625 DEBUG_ARG("m = %p", m);
626
627 switch(so->so_emu) {
628 int x, i;
629
630 /* TODO: IPv6 */
631 case EMU_IDENT:
632 /*
633 * Identification protocol as per rfc-1413
634 */
635
636 {
637 struct socket *tmpso;
638 struct sockaddr_in addr;
639 socklen_t addrlen = sizeof(struct sockaddr_in);
640 struct sbuf *so_rcv = &so->so_rcv;
641
642 if (m->m_len > so_rcv->sb_datalen
643 - (so_rcv->sb_wptr - so_rcv->sb_data)) {
644 return 1;
645 }
646
647 memcpy(so_rcv->sb_wptr, m->m_data, m->m_len);
648 so_rcv->sb_wptr += m->m_len;
649 so_rcv->sb_rptr += m->m_len;
650 m->m_data[m->m_len] = 0; /* NULL terminate */
651 if (strchr(m->m_data, '\r') || strchr(m->m_data, '\n')) {
652 if (sscanf(so_rcv->sb_data, "%u%*[ ,]%u", &n1, &n2) == 2) {
653 HTONS(n1);
654 HTONS(n2);
655 /* n2 is the one on our host */
656 for (tmpso = slirp->tcb.so_next;
657 tmpso != &slirp->tcb;
658 tmpso = tmpso->so_next) {
659 if (tmpso->so_laddr.s_addr == so->so_laddr.s_addr &&
660 tmpso->so_lport == n2 &&
661 tmpso->so_faddr.s_addr == so->so_faddr.s_addr &&
662 tmpso->so_fport == n1) {
663 if (getsockname(tmpso->s,
664 (struct sockaddr *)&addr, &addrlen) == 0)
665 n2 = addr.sin_port;
666 break;
667 }
668 }
669 NTOHS(n1);
670 NTOHS(n2);
671 so_rcv->sb_cc = snprintf(so_rcv->sb_data,
672 so_rcv->sb_datalen,
673 "%d,%d\r\n", n1, n2);
674 so_rcv->sb_rptr = so_rcv->sb_data;
675 so_rcv->sb_wptr = so_rcv->sb_data + so_rcv->sb_cc;
676 }
677 }
678 m_free(m);
679 return 0;
680 }
681
682 case EMU_FTP: /* ftp */
683 *(m->m_data+m->m_len) = 0; /* NUL terminate for strstr */
684 if ((bptr = (char *)strstr(m->m_data, "ORT")) != NULL) {
685 /*
686 * Need to emulate the PORT command
687 */
688 x = sscanf(bptr, "ORT %u,%u,%u,%u,%u,%u\r\n%256[^\177]",
689 &n1, &n2, &n3, &n4, &n5, &n6, buff);
690 if (x < 6)
691 return 1;
692
693 laddr = htonl((n1 << 24) | (n2 << 16) | (n3 << 8) | (n4));
694 lport = htons((n5 << 8) | (n6));
695
696 if ((so = tcp_listen(slirp, INADDR_ANY, 0, laddr,
697 lport, SS_FACCEPTONCE)) == NULL) {
698 return 1;
699 }
700 n6 = ntohs(so->so_fport);
701
702 n5 = (n6 >> 8) & 0xff;
703 n6 &= 0xff;
704
705 laddr = ntohl(so->so_faddr.s_addr);
706
707 n1 = ((laddr >> 24) & 0xff);
708 n2 = ((laddr >> 16) & 0xff);
709 n3 = ((laddr >> 8) & 0xff);
710 n4 = (laddr & 0xff);
711
712 m->m_len = bptr - m->m_data; /* Adjust length */
713 m->m_len += snprintf(bptr, m->m_size - m->m_len,
714 "ORT %d,%d,%d,%d,%d,%d\r\n%s",
715 n1, n2, n3, n4, n5, n6, x==7?buff:"");
716 return 1;
717 } else if ((bptr = (char *)strstr(m->m_data, "27 Entering")) != NULL) {
718 /*
719 * Need to emulate the PASV response
720 */
721 x = sscanf(bptr, "27 Entering Passive Mode (%u,%u,%u,%u,%u,%u)\r\n%256[^\177]",
722 &n1, &n2, &n3, &n4, &n5, &n6, buff);
723 if (x < 6)
724 return 1;
725
726 laddr = htonl((n1 << 24) | (n2 << 16) | (n3 << 8) | (n4));
727 lport = htons((n5 << 8) | (n6));
728
729 if ((so = tcp_listen(slirp, INADDR_ANY, 0, laddr,
730 lport, SS_FACCEPTONCE)) == NULL) {
731 return 1;
732 }
733 n6 = ntohs(so->so_fport);
734
735 n5 = (n6 >> 8) & 0xff;
736 n6 &= 0xff;
737
738 laddr = ntohl(so->so_faddr.s_addr);
739
740 n1 = ((laddr >> 24) & 0xff);
741 n2 = ((laddr >> 16) & 0xff);
742 n3 = ((laddr >> 8) & 0xff);
743 n4 = (laddr & 0xff);
744
745 m->m_len = bptr - m->m_data; /* Adjust length */
746 m->m_len += snprintf(bptr, m->m_size - m->m_len,
747 "27 Entering Passive Mode (%d,%d,%d,%d,%d,%d)\r\n%s",
748 n1, n2, n3, n4, n5, n6, x==7?buff:"");
749
750 return 1;
751 }
752
753 return 1;
754
755 case EMU_KSH:
756 /*
757 * The kshell (Kerberos rsh) and shell services both pass
758 * a local port port number to carry signals to the server
759 * and stderr to the client. It is passed at the beginning
760 * of the connection as a NUL-terminated decimal ASCII string.
761 */
762 so->so_emu = 0;
763 for (lport = 0, i = 0; i < m->m_len-1; ++i) {
764 if (m->m_data[i] < '0' || m->m_data[i] > '9')
765 return 1; /* invalid number */
766 lport *= 10;
767 lport += m->m_data[i] - '0';
768 }
769 if (m->m_data[m->m_len-1] == '\0' && lport != 0 &&
770 (so = tcp_listen(slirp, INADDR_ANY, 0, so->so_laddr.s_addr,
771 htons(lport), SS_FACCEPTONCE)) != NULL)
772 m->m_len = snprintf(m->m_data, m->m_size, "%d",
773 ntohs(so->so_fport)) + 1;
774 return 1;
775
776 case EMU_IRC:
777 /*
778 * Need to emulate DCC CHAT, DCC SEND and DCC MOVE
779 */
780 *(m->m_data+m->m_len) = 0; /* NULL terminate the string for strstr */
781 if ((bptr = (char *)strstr(m->m_data, "DCC")) == NULL)
782 return 1;
783
784 /* The %256s is for the broken mIRC */
785 if (sscanf(bptr, "DCC CHAT %256s %u %u", buff, &laddr, &lport) == 3) {
786 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
787 htonl(laddr), htons(lport),
788 SS_FACCEPTONCE)) == NULL) {
789 return 1;
790 }
791 m->m_len = bptr - m->m_data; /* Adjust length */
792 m->m_len += snprintf(bptr, m->m_size,
793 "DCC CHAT chat %lu %u%c\n",
794 (unsigned long)ntohl(so->so_faddr.s_addr),
795 ntohs(so->so_fport), 1);
796 } else if (sscanf(bptr, "DCC SEND %256s %u %u %u", buff, &laddr, &lport, &n1) == 4) {
797 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
798 htonl(laddr), htons(lport),
799 SS_FACCEPTONCE)) == NULL) {
800 return 1;
801 }
802 m->m_len = bptr - m->m_data; /* Adjust length */
803 m->m_len += snprintf(bptr, m->m_size,
804 "DCC SEND %s %lu %u %u%c\n", buff,
805 (unsigned long)ntohl(so->so_faddr.s_addr),
806 ntohs(so->so_fport), n1, 1);
807 } else if (sscanf(bptr, "DCC MOVE %256s %u %u %u", buff, &laddr, &lport, &n1) == 4) {
808 if ((so = tcp_listen(slirp, INADDR_ANY, 0,
809 htonl(laddr), htons(lport),
810 SS_FACCEPTONCE)) == NULL) {
811 return 1;
812 }
813 m->m_len = bptr - m->m_data; /* Adjust length */
814 m->m_len += snprintf(bptr, m->m_size,
815 "DCC MOVE %s %lu %u %u%c\n", buff,
816 (unsigned long)ntohl(so->so_faddr.s_addr),
817 ntohs(so->so_fport), n1, 1);
818 }
819 return 1;
820
821 case EMU_REALAUDIO:
822 /*
823 * RealAudio emulation - JP. We must try to parse the incoming
824 * data and try to find the two characters that contain the
825 * port number. Then we redirect an udp port and replace the
826 * number with the real port we got.
827 *
828 * The 1.0 beta versions of the player are not supported
829 * any more.
830 *
831 * A typical packet for player version 1.0 (release version):
832 *
833 * 0000:50 4E 41 00 05
834 * 0000:00 01 00 02 1B D7 00 00 67 E6 6C DC 63 00 12 50 ........g.l.c..P
835 * 0010:4E 43 4C 49 45 4E 54 20 31 30 31 20 41 4C 50 48 NCLIENT 101 ALPH
836 * 0020:41 6C 00 00 52 00 17 72 61 66 69 6C 65 73 2F 76 Al..R..rafiles/v
837 * 0030:6F 61 2F 65 6E 67 6C 69 73 68 5F 2E 72 61 79 42 oa/english_.rayB
838 *
839 * Now the port number 0x1BD7 is found at offset 0x04 of the
840 * Now the port number 0x1BD7 is found at offset 0x04 of the
841 * second packet. This time we received five bytes first and
842 * then the rest. You never know how many bytes you get.
843 *
844 * A typical packet for player version 2.0 (beta):
845 *
846 * 0000:50 4E 41 00 06 00 02 00 00 00 01 00 02 1B C1 00 PNA.............
847 * 0010:00 67 75 78 F5 63 00 0A 57 69 6E 32 2E 30 2E 30 .gux.c..Win2.0.0
848 * 0020:2E 35 6C 00 00 52 00 1C 72 61 66 69 6C 65 73 2F .5l..R..rafiles/
849 * 0030:77 65 62 73 69 74 65 2F 32 30 72 65 6C 65 61 73 website/20releas
850 * 0040:65 2E 72 61 79 53 00 00 06 36 42 e.rayS...6B
851 *
852 * Port number 0x1BC1 is found at offset 0x0d.
853 *
854 * This is just a horrible switch statement. Variable ra tells
855 * us where we're going.
856 */
857
858 bptr = m->m_data;
859 while (bptr < m->m_data + m->m_len) {
860 uint16_t p;
861 static int ra = 0;
862 char ra_tbl[4];
863
864 ra_tbl[0] = 0x50;
865 ra_tbl[1] = 0x4e;
866 ra_tbl[2] = 0x41;
867 ra_tbl[3] = 0;
868
869 switch (ra) {
870 case 0:
871 case 2:
872 case 3:
873 if (*bptr++ != ra_tbl[ra]) {
874 ra = 0;
875 continue;
876 }
877 break;
878
879 case 1:
880 /*
881 * We may get 0x50 several times, ignore them
882 */
883 if (*bptr == 0x50) {
884 ra = 1;
885 bptr++;
886 continue;
887 } else if (*bptr++ != ra_tbl[ra]) {
888 ra = 0;
889 continue;
890 }
891 break;
892
893 case 4:
894 /*
895 * skip version number
896 */
897 bptr++;
898 break;
899
900 case 5:
901 /*
902 * The difference between versions 1.0 and
903 * 2.0 is here. For future versions of
904 * the player this may need to be modified.
905 */
906 if (*(bptr + 1) == 0x02)
907 bptr += 8;
908 else
909 bptr += 4;
910 break;
911
912 case 6:
913 /* This is the field containing the port
914 * number that RA-player is listening to.
915 */
916 lport = (((uint8_t*)bptr)[0] << 8)
917 + ((uint8_t *)bptr)[1];
918 if (lport < 6970)
919 lport += 256; /* don't know why */
920 if (lport < 6970 || lport > 7170)
921 return 1; /* failed */
922
923 /* try to get udp port between 6970 - 7170 */
924 for (p = 6970; p < 7071; p++) {
925 if (udp_listen(slirp, INADDR_ANY,
926 htons(p),
927 so->so_laddr.s_addr,
928 htons(lport),
929 SS_FACCEPTONCE)) {
930 break;
931 }
932 }
933 if (p == 7071)
934 p = 0;
935 *(uint8_t *)bptr++ = (p >> 8) & 0xff;
936 *(uint8_t *)bptr = p & 0xff;
937 ra = 0;
938 return 1; /* port redirected, we're done */
939 break;
940
941 default:
942 ra = 0;
943 }
944 ra++;
945 }
946 return 1;
947
948 default:
949 /* Ooops, not emulated, won't call tcp_emu again */
950 so->so_emu = 0;
951 return 1;
952 }
953 }
954
955 /*
956 * Do misc. config of SLiRP while its running.
957 * Return 0 if this connections is to be closed, 1 otherwise,
958 * return 2 if this is a command-line connection
959 */
960 int tcp_ctl(struct socket *so)
961 {
962 Slirp *slirp = so->slirp;
963 struct sbuf *sb = &so->so_snd;
964 struct gfwd_list *ex_ptr;
965
966 DEBUG_CALL("tcp_ctl");
967 DEBUG_ARG("so = %p", so);
968
969 /* TODO: IPv6 */
970 if (so->so_faddr.s_addr != slirp->vhost_addr.s_addr) {
971 /* Check if it's pty_exec */
972 for (ex_ptr = slirp->guestfwd_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
973 if (ex_ptr->ex_fport == so->so_fport &&
974 so->so_faddr.s_addr == ex_ptr->ex_addr.s_addr) {
975 if (ex_ptr->write_cb) {
976 so->s = -1;
977 so->guestfwd = ex_ptr;
978 return 1;
979 }
980 DEBUG_MISC(" executing %s", ex_ptr->ex_exec);
981 return fork_exec(so, ex_ptr->ex_exec);
982 }
983 }
984 }
985 sb->sb_cc =
986 snprintf(sb->sb_wptr, sb->sb_datalen - (sb->sb_wptr - sb->sb_data),
987 "Error: No application configured.\r\n");
988 sb->sb_wptr += sb->sb_cc;
989 return 0;
990 }