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