1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include "qemu/osdep.h"
25#include "qemu-common.h"
26#include "qemu/timer.h"
27#include "qemu/error-report.h"
28#include "sysemu/char.h"
29#include "slirp.h"
30#include "hw/hw.h"
31#include "qemu/cutils.h"
32
33#ifndef _WIN32
34#include <net/if.h>
35#endif
36
37
38struct in_addr loopback_addr;
39
40unsigned long loopback_mask;
41
42
43static const uint8_t special_ethaddr[ETH_ALEN] = {
44 0x52, 0x55, 0x00, 0x00, 0x00, 0x00
45};
46
47u_int curtime;
48
49static QTAILQ_HEAD(slirp_instances, Slirp) slirp_instances =
50 QTAILQ_HEAD_INITIALIZER(slirp_instances);
51
52static struct in_addr dns_addr;
53#ifndef _WIN32
54static struct in6_addr dns6_addr;
55#endif
56static u_int dns_addr_time;
57#ifndef _WIN32
58static u_int dns6_addr_time;
59#endif
60
61#define TIMEOUT_FAST 2
62#define TIMEOUT_SLOW 499
63
64#define TIMEOUT_DEFAULT 1000
65
66#ifdef _WIN32
67
68int get_dns_addr(struct in_addr *pdns_addr)
69{
70 FIXED_INFO *FixedInfo=NULL;
71 ULONG BufLen;
72 DWORD ret;
73 IP_ADDR_STRING *pIPAddr;
74 struct in_addr tmp_addr;
75
76 if (dns_addr.s_addr != 0 && (curtime - dns_addr_time) < TIMEOUT_DEFAULT) {
77 *pdns_addr = dns_addr;
78 return 0;
79 }
80
81 FixedInfo = (FIXED_INFO *)GlobalAlloc(GPTR, sizeof(FIXED_INFO));
82 BufLen = sizeof(FIXED_INFO);
83
84 if (ERROR_BUFFER_OVERFLOW == GetNetworkParams(FixedInfo, &BufLen)) {
85 if (FixedInfo) {
86 GlobalFree(FixedInfo);
87 FixedInfo = NULL;
88 }
89 FixedInfo = GlobalAlloc(GPTR, BufLen);
90 }
91
92 if ((ret = GetNetworkParams(FixedInfo, &BufLen)) != ERROR_SUCCESS) {
93 printf("GetNetworkParams failed. ret = %08x\n", (u_int)ret );
94 if (FixedInfo) {
95 GlobalFree(FixedInfo);
96 FixedInfo = NULL;
97 }
98 return -1;
99 }
100
101 pIPAddr = &(FixedInfo->DnsServerList);
102 inet_aton(pIPAddr->IpAddress.String, &tmp_addr);
103 *pdns_addr = tmp_addr;
104 dns_addr = tmp_addr;
105 dns_addr_time = curtime;
106 if (FixedInfo) {
107 GlobalFree(FixedInfo);
108 FixedInfo = NULL;
109 }
110 return 0;
111}
112
113int get_dns6_addr(struct in6_addr *pdns6_addr, uint32_t *scope_id)
114{
115 return -1;
116}
117
118static void winsock_cleanup(void)
119{
120 WSACleanup();
121}
122
123#else
124
125static int get_dns_addr_cached(void *pdns_addr, void *cached_addr,
126 socklen_t addrlen,
127 struct stat *cached_stat, u_int *cached_time)
128{
129 struct stat old_stat;
130 if (curtime - *cached_time < TIMEOUT_DEFAULT) {
131 memcpy(pdns_addr, cached_addr, addrlen);
132 return 0;
133 }
134 old_stat = *cached_stat;
135 if (stat("/etc/resolv.conf", cached_stat) != 0) {
136 return -1;
137 }
138 if (cached_stat->st_dev == old_stat.st_dev
139 && cached_stat->st_ino == old_stat.st_ino
140 && cached_stat->st_size == old_stat.st_size
141 && cached_stat->st_mtime == old_stat.st_mtime) {
142 memcpy(pdns_addr, cached_addr, addrlen);
143 return 0;
144 }
145 return 1;
146}
147
148static int get_dns_addr_resolv_conf(int af, void *pdns_addr, void *cached_addr,
149 socklen_t addrlen, uint32_t *scope_id,
150 u_int *cached_time)
151{
152 char buff[512];
153 char buff2[257];
154 FILE *f;
155 int found = 0;
156 void *tmp_addr = alloca(addrlen);
157 unsigned if_index;
158
159 f = fopen("/etc/resolv.conf", "r");
160 if (!f)
161 return -1;
162
163#ifdef DEBUG
164 fprintf(stderr, "IP address of your DNS(s): ");
165#endif
166 while (fgets(buff, 512, f) != NULL) {
167 if (sscanf(buff, "nameserver%*[ \t]%256s", buff2) == 1) {
168 char *c = strchr(buff2, '%');
169 if (c) {
170 if_index = if_nametoindex(c + 1);
171 *c = '\0';
172 } else {
173 if_index = 0;
174 }
175
176 if (!inet_pton(af, buff2, tmp_addr)) {
177 continue;
178 }
179
180 if (!found) {
181 memcpy(pdns_addr, tmp_addr, addrlen);
182 memcpy(cached_addr, tmp_addr, addrlen);
183 if (scope_id) {
184 *scope_id = if_index;
185 }
186 *cached_time = curtime;
187 }
188#ifdef DEBUG
189 else
190 fprintf(stderr, ", ");
191#endif
192 if (++found > 3) {
193#ifdef DEBUG
194 fprintf(stderr, "(more)");
195#endif
196 break;
197 }
198#ifdef DEBUG
199 else {
200 char s[INET6_ADDRSTRLEN];
201 char *res = inet_ntop(af, tmp_addr, s, sizeof(s));
202 if (!res) {
203 res = "(string conversion error)";
204 }
205 fprintf(stderr, "%s", res);
206 }
207#endif
208 }
209 }
210 fclose(f);
211 if (!found)
212 return -1;
213 return 0;
214}
215
216int get_dns_addr(struct in_addr *pdns_addr)
217{
218 static struct stat dns_addr_stat;
219
220 if (dns_addr.s_addr != 0) {
221 int ret;
222 ret = get_dns_addr_cached(pdns_addr, &dns_addr, sizeof(dns_addr),
223 &dns_addr_stat, &dns_addr_time);
224 if (ret <= 0) {
225 return ret;
226 }
227 }
228 return get_dns_addr_resolv_conf(AF_INET, pdns_addr, &dns_addr,
229 sizeof(dns_addr), NULL, &dns_addr_time);
230}
231
232int get_dns6_addr(struct in6_addr *pdns6_addr, uint32_t *scope_id)
233{
234 static struct stat dns6_addr_stat;
235
236 if (!in6_zero(&dns6_addr)) {
237 int ret;
238 ret = get_dns_addr_cached(pdns6_addr, &dns6_addr, sizeof(dns6_addr),
239 &dns6_addr_stat, &dns6_addr_time);
240 if (ret <= 0) {
241 return ret;
242 }
243 }
244 return get_dns_addr_resolv_conf(AF_INET6, pdns6_addr, &dns6_addr,
245 sizeof(dns6_addr),
246 scope_id, &dns6_addr_time);
247}
248
249#endif
250
251static void slirp_init_once(void)
252{
253 static int initialized;
254#ifdef _WIN32
255 WSADATA Data;
256#endif
257
258 if (initialized) {
259 return;
260 }
261 initialized = 1;
262
263#ifdef _WIN32
264 WSAStartup(MAKEWORD(2,0), &Data);
265 atexit(winsock_cleanup);
266#endif
267
268 loopback_addr.s_addr = htonl(INADDR_LOOPBACK);
269 loopback_mask = htonl(IN_CLASSA_NET);
270}
271
272static void slirp_state_save(QEMUFile *f, void *opaque);
273static int slirp_state_load(QEMUFile *f, void *opaque, int version_id);
274
275Slirp *slirp_init(int restricted, bool in_enabled, struct in_addr vnetwork,
276 struct in_addr vnetmask, struct in_addr vhost,
277 bool in6_enabled,
278 struct in6_addr vprefix_addr6, uint8_t vprefix_len,
279 struct in6_addr vhost6, const char *vhostname,
280 const char *tftp_path, const char *bootfile,
281 struct in_addr vdhcp_start, struct in_addr vnameserver,
282 struct in6_addr vnameserver6, const char **vdnssearch,
283 void *opaque)
284{
285 Slirp *slirp = g_malloc0(sizeof(Slirp));
286
287 slirp_init_once();
288
289 slirp->grand = g_rand_new();
290 slirp->restricted = restricted;
291
292 slirp->in_enabled = in_enabled;
293 slirp->in6_enabled = in6_enabled;
294
295 if_init(slirp);
296 ip_init(slirp);
297 ip6_init(slirp);
298
299
300 m_init(slirp);
301
302 slirp->vnetwork_addr = vnetwork;
303 slirp->vnetwork_mask = vnetmask;
304 slirp->vhost_addr = vhost;
305 slirp->vprefix_addr6 = vprefix_addr6;
306 slirp->vprefix_len = vprefix_len;
307 slirp->vhost_addr6 = vhost6;
308 if (vhostname) {
309 pstrcpy(slirp->client_hostname, sizeof(slirp->client_hostname),
310 vhostname);
311 }
312 slirp->tftp_prefix = g_strdup(tftp_path);
313 slirp->bootp_filename = g_strdup(bootfile);
314 slirp->vdhcp_startaddr = vdhcp_start;
315 slirp->vnameserver_addr = vnameserver;
316 slirp->vnameserver_addr6 = vnameserver6;
317
318 if (vdnssearch) {
319 translate_dnssearch(slirp, vdnssearch);
320 }
321
322 slirp->opaque = opaque;
323
324 register_savevm(NULL, "slirp", 0, 4,
325 slirp_state_save, slirp_state_load, slirp);
326
327 QTAILQ_INSERT_TAIL(&slirp_instances, slirp, entry);
328
329 return slirp;
330}
331
332void slirp_cleanup(Slirp *slirp)
333{
334 QTAILQ_REMOVE(&slirp_instances, slirp, entry);
335
336 unregister_savevm(NULL, "slirp", slirp);
337
338 ip_cleanup(slirp);
339 ip6_cleanup(slirp);
340 m_cleanup(slirp);
341
342 g_rand_free(slirp->grand);
343
344 g_free(slirp->vdnssearch);
345 g_free(slirp->tftp_prefix);
346 g_free(slirp->bootp_filename);
347 g_free(slirp);
348}
349
350#define CONN_CANFSEND(so) (((so)->so_state & (SS_FCANTSENDMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)
351#define CONN_CANFRCV(so) (((so)->so_state & (SS_FCANTRCVMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)
352
353static void slirp_update_timeout(uint32_t *timeout)
354{
355 Slirp *slirp;
356 uint32_t t;
357
358 if (*timeout <= TIMEOUT_FAST) {
359 return;
360 }
361
362 t = MIN(1000, *timeout);
363
364
365
366
367 QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
368 if (slirp->time_fasttimo) {
369 *timeout = TIMEOUT_FAST;
370 return;
371 }
372 if (slirp->do_slowtimo) {
373 t = MIN(TIMEOUT_SLOW, t);
374 }
375 }
376 *timeout = t;
377}
378
379void slirp_pollfds_fill(GArray *pollfds, uint32_t *timeout)
380{
381 Slirp *slirp;
382 struct socket *so, *so_next;
383
384 if (QTAILQ_EMPTY(&slirp_instances)) {
385 return;
386 }
387
388
389
390
391
392 QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
393
394
395
396
397 slirp->do_slowtimo = ((slirp->tcb.so_next != &slirp->tcb) ||
398 (&slirp->ipq.ip_link != slirp->ipq.ip_link.next));
399
400 for (so = slirp->tcb.so_next; so != &slirp->tcb;
401 so = so_next) {
402 int events = 0;
403
404 so_next = so->so_next;
405
406 so->pollfds_idx = -1;
407
408
409
410
411 if (slirp->time_fasttimo == 0 &&
412 so->so_tcpcb->t_flags & TF_DELACK) {
413 slirp->time_fasttimo = curtime;
414 }
415
416
417
418
419
420 if (so->so_state & SS_NOFDREF || so->s == -1) {
421 continue;
422 }
423
424
425
426
427 if (so->so_state & SS_FACCEPTCONN) {
428 GPollFD pfd = {
429 .fd = so->s,
430 .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
431 };
432 so->pollfds_idx = pollfds->len;
433 g_array_append_val(pollfds, pfd);
434 continue;
435 }
436
437
438
439
440 if (so->so_state & SS_ISFCONNECTING) {
441 GPollFD pfd = {
442 .fd = so->s,
443 .events = G_IO_OUT | G_IO_ERR,
444 };
445 so->pollfds_idx = pollfds->len;
446 g_array_append_val(pollfds, pfd);
447 continue;
448 }
449
450
451
452
453
454 if (CONN_CANFSEND(so) && so->so_rcv.sb_cc) {
455 events |= G_IO_OUT | G_IO_ERR;
456 }
457
458
459
460
461
462 if (CONN_CANFRCV(so) &&
463 (so->so_snd.sb_cc < (so->so_snd.sb_datalen/2))) {
464 events |= G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_PRI;
465 }
466
467 if (events) {
468 GPollFD pfd = {
469 .fd = so->s,
470 .events = events,
471 };
472 so->pollfds_idx = pollfds->len;
473 g_array_append_val(pollfds, pfd);
474 }
475 }
476
477
478
479
480 for (so = slirp->udb.so_next; so != &slirp->udb;
481 so = so_next) {
482 so_next = so->so_next;
483
484 so->pollfds_idx = -1;
485
486
487
488
489 if (so->so_expire) {
490 if (so->so_expire <= curtime) {
491 udp_detach(so);
492 continue;
493 } else {
494 slirp->do_slowtimo = true;
495 }
496 }
497
498
499
500
501
502
503
504
505
506
507
508 if ((so->so_state & SS_ISFCONNECTED) && so->so_queued <= 4) {
509 GPollFD pfd = {
510 .fd = so->s,
511 .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
512 };
513 so->pollfds_idx = pollfds->len;
514 g_array_append_val(pollfds, pfd);
515 }
516 }
517
518
519
520
521 for (so = slirp->icmp.so_next; so != &slirp->icmp;
522 so = so_next) {
523 so_next = so->so_next;
524
525 so->pollfds_idx = -1;
526
527
528
529
530 if (so->so_expire) {
531 if (so->so_expire <= curtime) {
532 icmp_detach(so);
533 continue;
534 } else {
535 slirp->do_slowtimo = true;
536 }
537 }
538
539 if (so->so_state & SS_ISFCONNECTED) {
540 GPollFD pfd = {
541 .fd = so->s,
542 .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
543 };
544 so->pollfds_idx = pollfds->len;
545 g_array_append_val(pollfds, pfd);
546 }
547 }
548 }
549 slirp_update_timeout(timeout);
550}
551
552void slirp_pollfds_poll(GArray *pollfds, int select_error)
553{
554 Slirp *slirp;
555 struct socket *so, *so_next;
556 int ret;
557
558 if (QTAILQ_EMPTY(&slirp_instances)) {
559 return;
560 }
561
562 curtime = qemu_clock_get_ms(QEMU_CLOCK_REALTIME);
563
564 QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
565
566
567
568 if (slirp->time_fasttimo &&
569 ((curtime - slirp->time_fasttimo) >= TIMEOUT_FAST)) {
570 tcp_fasttimo(slirp);
571 slirp->time_fasttimo = 0;
572 }
573 if (slirp->do_slowtimo &&
574 ((curtime - slirp->last_slowtimo) >= TIMEOUT_SLOW)) {
575 ip_slowtimo(slirp);
576 tcp_slowtimo(slirp);
577 slirp->last_slowtimo = curtime;
578 }
579
580
581
582
583 if (!select_error) {
584
585
586
587 for (so = slirp->tcb.so_next; so != &slirp->tcb;
588 so = so_next) {
589 int revents;
590
591 so_next = so->so_next;
592
593 revents = 0;
594 if (so->pollfds_idx != -1) {
595 revents = g_array_index(pollfds, GPollFD,
596 so->pollfds_idx).revents;
597 }
598
599 if (so->so_state & SS_NOFDREF || so->s == -1) {
600 continue;
601 }
602
603
604
605
606
607
608 if (revents & G_IO_PRI) {
609 ret = sorecvoob(so);
610 if (ret < 0) {
611
612
613 continue;
614 }
615 }
616
617
618
619 else if (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR)) {
620
621
622
623 if (so->so_state & SS_FACCEPTCONN) {
624 tcp_connect(so);
625 continue;
626 }
627 ret = soread(so);
628
629
630 if (ret > 0) {
631 tcp_output(sototcpcb(so));
632 }
633 if (ret < 0) {
634
635
636 continue;
637 }
638 }
639
640
641
642
643 if (!(so->so_state & SS_NOFDREF) &&
644 (revents & (G_IO_OUT | G_IO_ERR))) {
645
646
647
648 if (so->so_state & SS_ISFCONNECTING) {
649
650 so->so_state &= ~SS_ISFCONNECTING;
651
652 ret = send(so->s, (const void *) &ret, 0, 0);
653 if (ret < 0) {
654
655 if (errno == EAGAIN || errno == EWOULDBLOCK ||
656 errno == EINPROGRESS || errno == ENOTCONN) {
657 continue;
658 }
659
660
661 so->so_state &= SS_PERSISTENT_MASK;
662 so->so_state |= SS_NOFDREF;
663 }
664
665
666
667
668
669 tcp_input((struct mbuf *)NULL, sizeof(struct ip), so,
670 so->so_ffamily);
671
672 } else {
673 ret = sowrite(so);
674 }
675
676
677
678
679
680
681 }
682
683
684
685
686
687#ifdef PROBE_CONN
688 if (so->so_state & SS_ISFCONNECTING) {
689 ret = qemu_recv(so->s, &ret, 0, 0);
690
691 if (ret < 0) {
692
693 if (errno == EAGAIN || errno == EWOULDBLOCK ||
694 errno == EINPROGRESS || errno == ENOTCONN) {
695 continue;
696 }
697
698
699 so->so_state &= SS_PERSISTENT_MASK;
700 so->so_state |= SS_NOFDREF;
701
702
703 } else {
704 ret = send(so->s, &ret, 0, 0);
705 if (ret < 0) {
706
707 if (errno == EAGAIN || errno == EWOULDBLOCK ||
708 errno == EINPROGRESS || errno == ENOTCONN) {
709 continue;
710 }
711
712 so->so_state &= SS_PERSISTENT_MASK;
713 so->so_state |= SS_NOFDREF;
714 } else {
715 so->so_state &= ~SS_ISFCONNECTING;
716 }
717
718 }
719 tcp_input((struct mbuf *)NULL, sizeof(struct ip), so,
720 so->so_ffamily);
721 }
722#endif
723 }
724
725
726
727
728
729
730 for (so = slirp->udb.so_next; so != &slirp->udb;
731 so = so_next) {
732 int revents;
733
734 so_next = so->so_next;
735
736 revents = 0;
737 if (so->pollfds_idx != -1) {
738 revents = g_array_index(pollfds, GPollFD,
739 so->pollfds_idx).revents;
740 }
741
742 if (so->s != -1 &&
743 (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR))) {
744 sorecvfrom(so);
745 }
746 }
747
748
749
750
751 for (so = slirp->icmp.so_next; so != &slirp->icmp;
752 so = so_next) {
753 int revents;
754
755 so_next = so->so_next;
756
757 revents = 0;
758 if (so->pollfds_idx != -1) {
759 revents = g_array_index(pollfds, GPollFD,
760 so->pollfds_idx).revents;
761 }
762
763 if (so->s != -1 &&
764 (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR))) {
765 icmp_receive(so);
766 }
767 }
768 }
769
770 if_start(slirp);
771 }
772}
773
774static void arp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len)
775{
776 struct slirp_arphdr *ah = (struct slirp_arphdr *)(pkt + ETH_HLEN);
777 uint8_t arp_reply[max(ETH_HLEN + sizeof(struct slirp_arphdr), 64)];
778 struct ethhdr *reh = (struct ethhdr *)arp_reply;
779 struct slirp_arphdr *rah = (struct slirp_arphdr *)(arp_reply + ETH_HLEN);
780 int ar_op;
781 struct ex_list *ex_ptr;
782
783 if (!slirp->in_enabled) {
784 return;
785 }
786
787 ar_op = ntohs(ah->ar_op);
788 switch(ar_op) {
789 case ARPOP_REQUEST:
790 if (ah->ar_tip == ah->ar_sip) {
791
792 arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
793 return;
794 }
795
796 if ((ah->ar_tip & slirp->vnetwork_mask.s_addr) ==
797 slirp->vnetwork_addr.s_addr) {
798 if (ah->ar_tip == slirp->vnameserver_addr.s_addr ||
799 ah->ar_tip == slirp->vhost_addr.s_addr)
800 goto arp_ok;
801 for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
802 if (ex_ptr->ex_addr.s_addr == ah->ar_tip)
803 goto arp_ok;
804 }
805 return;
806 arp_ok:
807 memset(arp_reply, 0, sizeof(arp_reply));
808
809 arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
810
811
812 memcpy(reh->h_dest, pkt + ETH_ALEN, ETH_ALEN);
813 memcpy(reh->h_source, special_ethaddr, ETH_ALEN - 4);
814 memcpy(&reh->h_source[2], &ah->ar_tip, 4);
815 reh->h_proto = htons(ETH_P_ARP);
816
817 rah->ar_hrd = htons(1);
818 rah->ar_pro = htons(ETH_P_IP);
819 rah->ar_hln = ETH_ALEN;
820 rah->ar_pln = 4;
821 rah->ar_op = htons(ARPOP_REPLY);
822 memcpy(rah->ar_sha, reh->h_source, ETH_ALEN);
823 rah->ar_sip = ah->ar_tip;
824 memcpy(rah->ar_tha, ah->ar_sha, ETH_ALEN);
825 rah->ar_tip = ah->ar_sip;
826 slirp_output(slirp->opaque, arp_reply, sizeof(arp_reply));
827 }
828 break;
829 case ARPOP_REPLY:
830 arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
831 break;
832 default:
833 break;
834 }
835}
836
837void slirp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len)
838{
839 struct mbuf *m;
840 int proto;
841
842 if (pkt_len < ETH_HLEN)
843 return;
844
845 proto = ntohs(*(uint16_t *)(pkt + 12));
846 switch(proto) {
847 case ETH_P_ARP:
848 arp_input(slirp, pkt, pkt_len);
849 break;
850 case ETH_P_IP:
851 case ETH_P_IPV6:
852 m = m_get(slirp);
853 if (!m)
854 return;
855
856
857 if (M_FREEROOM(m) < pkt_len + TCPIPHDR_DELTA + 2) {
858 m_inc(m, pkt_len + TCPIPHDR_DELTA + 2);
859 }
860 m->m_len = pkt_len + TCPIPHDR_DELTA + 2;
861 memcpy(m->m_data + TCPIPHDR_DELTA + 2, pkt, pkt_len);
862
863 m->m_data += TCPIPHDR_DELTA + 2 + ETH_HLEN;
864 m->m_len -= TCPIPHDR_DELTA + 2 + ETH_HLEN;
865
866 if (proto == ETH_P_IP) {
867 ip_input(m);
868 } else if (proto == ETH_P_IPV6) {
869 ip6_input(m);
870 }
871 break;
872
873 default:
874 break;
875 }
876}
877
878
879
880
881
882static int if_encap4(Slirp *slirp, struct mbuf *ifm, struct ethhdr *eh,
883 uint8_t ethaddr[ETH_ALEN])
884{
885 const struct ip *iph = (const struct ip *)ifm->m_data;
886
887 if (iph->ip_dst.s_addr == 0) {
888
889
890 return 1;
891 }
892 if (!arp_table_search(slirp, iph->ip_dst.s_addr, ethaddr)) {
893 uint8_t arp_req[ETH_HLEN + sizeof(struct slirp_arphdr)];
894 struct ethhdr *reh = (struct ethhdr *)arp_req;
895 struct slirp_arphdr *rah = (struct slirp_arphdr *)(arp_req + ETH_HLEN);
896
897 if (!ifm->resolution_requested) {
898
899 memset(reh->h_dest, 0xff, ETH_ALEN);
900 memcpy(reh->h_source, special_ethaddr, ETH_ALEN - 4);
901 memcpy(&reh->h_source[2], &slirp->vhost_addr, 4);
902 reh->h_proto = htons(ETH_P_ARP);
903 rah->ar_hrd = htons(1);
904 rah->ar_pro = htons(ETH_P_IP);
905 rah->ar_hln = ETH_ALEN;
906 rah->ar_pln = 4;
907 rah->ar_op = htons(ARPOP_REQUEST);
908
909
910 memcpy(rah->ar_sha, special_ethaddr, ETH_ALEN - 4);
911 memcpy(&rah->ar_sha[2], &slirp->vhost_addr, 4);
912
913
914 rah->ar_sip = slirp->vhost_addr.s_addr;
915
916
917 memset(rah->ar_tha, 0, ETH_ALEN);
918
919
920 rah->ar_tip = iph->ip_dst.s_addr;
921 slirp->client_ipaddr = iph->ip_dst;
922 slirp_output(slirp->opaque, arp_req, sizeof(arp_req));
923 ifm->resolution_requested = true;
924
925
926 ifm->expiration_date = qemu_clock_get_ns(QEMU_CLOCK_REALTIME) + 1000000000ULL;
927 }
928 return 0;
929 } else {
930 memcpy(eh->h_source, special_ethaddr, ETH_ALEN - 4);
931
932 memcpy(&eh->h_source[2], &slirp->vhost_addr, 4);
933 eh->h_proto = htons(ETH_P_IP);
934
935
936 return 2;
937 }
938}
939
940
941
942
943
944static int if_encap6(Slirp *slirp, struct mbuf *ifm, struct ethhdr *eh,
945 uint8_t ethaddr[ETH_ALEN])
946{
947 const struct ip6 *ip6h = mtod(ifm, const struct ip6 *);
948 if (!ndp_table_search(slirp, ip6h->ip_dst, ethaddr)) {
949 if (!ifm->resolution_requested) {
950 ndp_send_ns(slirp, ip6h->ip_dst);
951 ifm->resolution_requested = true;
952 ifm->expiration_date =
953 qemu_clock_get_ns(QEMU_CLOCK_REALTIME) + 1000000000ULL;
954 }
955 return 0;
956 } else {
957 eh->h_proto = htons(ETH_P_IPV6);
958 in6_compute_ethaddr(ip6h->ip_src, eh->h_source);
959
960
961 return 2;
962 }
963}
964
965
966
967
968int if_encap(Slirp *slirp, struct mbuf *ifm)
969{
970 uint8_t buf[1600];
971 struct ethhdr *eh = (struct ethhdr *)buf;
972 uint8_t ethaddr[ETH_ALEN];
973 const struct ip *iph = (const struct ip *)ifm->m_data;
974 int ret;
975
976 if (ifm->m_len + ETH_HLEN > sizeof(buf)) {
977 return 1;
978 }
979
980 switch (iph->ip_v) {
981 case IPVERSION:
982 ret = if_encap4(slirp, ifm, eh, ethaddr);
983 if (ret < 2) {
984 return ret;
985 }
986 break;
987
988 case IP6VERSION:
989 ret = if_encap6(slirp, ifm, eh, ethaddr);
990 if (ret < 2) {
991 return ret;
992 }
993 break;
994
995 default:
996 g_assert_not_reached();
997 break;
998 }
999
1000 memcpy(eh->h_dest, ethaddr, ETH_ALEN);
1001 DEBUG_ARGS((dfd, " src = %02x:%02x:%02x:%02x:%02x:%02x\n",
1002 eh->h_source[0], eh->h_source[1], eh->h_source[2],
1003 eh->h_source[3], eh->h_source[4], eh->h_source[5]));
1004 DEBUG_ARGS((dfd, " dst = %02x:%02x:%02x:%02x:%02x:%02x\n",
1005 eh->h_dest[0], eh->h_dest[1], eh->h_dest[2],
1006 eh->h_dest[3], eh->h_dest[4], eh->h_dest[5]));
1007 memcpy(buf + sizeof(struct ethhdr), ifm->m_data, ifm->m_len);
1008 slirp_output(slirp->opaque, buf, ifm->m_len + ETH_HLEN);
1009 return 1;
1010}
1011
1012
1013int slirp_remove_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr,
1014 int host_port)
1015{
1016 struct socket *so;
1017 struct socket *head = (is_udp ? &slirp->udb : &slirp->tcb);
1018 struct sockaddr_in addr;
1019 int port = htons(host_port);
1020 socklen_t addr_len;
1021
1022 for (so = head->so_next; so != head; so = so->so_next) {
1023 addr_len = sizeof(addr);
1024 if ((so->so_state & SS_HOSTFWD) &&
1025 getsockname(so->s, (struct sockaddr *)&addr, &addr_len) == 0 &&
1026 addr.sin_addr.s_addr == host_addr.s_addr &&
1027 addr.sin_port == port) {
1028 close(so->s);
1029 sofree(so);
1030 return 0;
1031 }
1032 }
1033
1034 return -1;
1035}
1036
1037int slirp_add_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr,
1038 int host_port, struct in_addr guest_addr, int guest_port)
1039{
1040 if (!guest_addr.s_addr) {
1041 guest_addr = slirp->vdhcp_startaddr;
1042 }
1043 if (is_udp) {
1044 if (!udp_listen(slirp, host_addr.s_addr, htons(host_port),
1045 guest_addr.s_addr, htons(guest_port), SS_HOSTFWD))
1046 return -1;
1047 } else {
1048 if (!tcp_listen(slirp, host_addr.s_addr, htons(host_port),
1049 guest_addr.s_addr, htons(guest_port), SS_HOSTFWD))
1050 return -1;
1051 }
1052 return 0;
1053}
1054
1055int slirp_add_exec(Slirp *slirp, int do_pty, const void *args,
1056 struct in_addr *guest_addr, int guest_port)
1057{
1058 if (!guest_addr->s_addr) {
1059 guest_addr->s_addr = slirp->vnetwork_addr.s_addr |
1060 (htonl(0x0204) & ~slirp->vnetwork_mask.s_addr);
1061 }
1062 if ((guest_addr->s_addr & slirp->vnetwork_mask.s_addr) !=
1063 slirp->vnetwork_addr.s_addr ||
1064 guest_addr->s_addr == slirp->vhost_addr.s_addr ||
1065 guest_addr->s_addr == slirp->vnameserver_addr.s_addr) {
1066 return -1;
1067 }
1068 return add_exec(&slirp->exec_list, do_pty, (char *)args, *guest_addr,
1069 htons(guest_port));
1070}
1071
1072ssize_t slirp_send(struct socket *so, const void *buf, size_t len, int flags)
1073{
1074 if (so->s == -1 && so->extra) {
1075 qemu_chr_fe_write(so->extra, buf, len);
1076 return len;
1077 }
1078
1079 return send(so->s, buf, len, flags);
1080}
1081
1082static struct socket *
1083slirp_find_ctl_socket(Slirp *slirp, struct in_addr guest_addr, int guest_port)
1084{
1085 struct socket *so;
1086
1087 for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) {
1088 if (so->so_faddr.s_addr == guest_addr.s_addr &&
1089 htons(so->so_fport) == guest_port) {
1090 return so;
1091 }
1092 }
1093 return NULL;
1094}
1095
1096size_t slirp_socket_can_recv(Slirp *slirp, struct in_addr guest_addr,
1097 int guest_port)
1098{
1099 struct iovec iov[2];
1100 struct socket *so;
1101
1102 so = slirp_find_ctl_socket(slirp, guest_addr, guest_port);
1103
1104 if (!so || so->so_state & SS_NOFDREF) {
1105 return 0;
1106 }
1107
1108 if (!CONN_CANFRCV(so) || so->so_snd.sb_cc >= (so->so_snd.sb_datalen/2)) {
1109 return 0;
1110 }
1111
1112 return sopreprbuf(so, iov, NULL);
1113}
1114
1115void slirp_socket_recv(Slirp *slirp, struct in_addr guest_addr, int guest_port,
1116 const uint8_t *buf, int size)
1117{
1118 int ret;
1119 struct socket *so = slirp_find_ctl_socket(slirp, guest_addr, guest_port);
1120
1121 if (!so)
1122 return;
1123
1124 ret = soreadbuf(so, (const char *)buf, size);
1125
1126 if (ret > 0)
1127 tcp_output(sototcpcb(so));
1128}
1129
1130static void slirp_tcp_save(QEMUFile *f, struct tcpcb *tp)
1131{
1132 int i;
1133
1134 qemu_put_sbe16(f, tp->t_state);
1135 for (i = 0; i < TCPT_NTIMERS; i++)
1136 qemu_put_sbe16(f, tp->t_timer[i]);
1137 qemu_put_sbe16(f, tp->t_rxtshift);
1138 qemu_put_sbe16(f, tp->t_rxtcur);
1139 qemu_put_sbe16(f, tp->t_dupacks);
1140 qemu_put_be16(f, tp->t_maxseg);
1141 qemu_put_sbyte(f, tp->t_force);
1142 qemu_put_be16(f, tp->t_flags);
1143 qemu_put_be32(f, tp->snd_una);
1144 qemu_put_be32(f, tp->snd_nxt);
1145 qemu_put_be32(f, tp->snd_up);
1146 qemu_put_be32(f, tp->snd_wl1);
1147 qemu_put_be32(f, tp->snd_wl2);
1148 qemu_put_be32(f, tp->iss);
1149 qemu_put_be32(f, tp->snd_wnd);
1150 qemu_put_be32(f, tp->rcv_wnd);
1151 qemu_put_be32(f, tp->rcv_nxt);
1152 qemu_put_be32(f, tp->rcv_up);
1153 qemu_put_be32(f, tp->irs);
1154 qemu_put_be32(f, tp->rcv_adv);
1155 qemu_put_be32(f, tp->snd_max);
1156 qemu_put_be32(f, tp->snd_cwnd);
1157 qemu_put_be32(f, tp->snd_ssthresh);
1158 qemu_put_sbe16(f, tp->t_idle);
1159 qemu_put_sbe16(f, tp->t_rtt);
1160 qemu_put_be32(f, tp->t_rtseq);
1161 qemu_put_sbe16(f, tp->t_srtt);
1162 qemu_put_sbe16(f, tp->t_rttvar);
1163 qemu_put_be16(f, tp->t_rttmin);
1164 qemu_put_be32(f, tp->max_sndwnd);
1165 qemu_put_byte(f, tp->t_oobflags);
1166 qemu_put_byte(f, tp->t_iobc);
1167 qemu_put_sbe16(f, tp->t_softerror);
1168 qemu_put_byte(f, tp->snd_scale);
1169 qemu_put_byte(f, tp->rcv_scale);
1170 qemu_put_byte(f, tp->request_r_scale);
1171 qemu_put_byte(f, tp->requested_s_scale);
1172 qemu_put_be32(f, tp->ts_recent);
1173 qemu_put_be32(f, tp->ts_recent_age);
1174 qemu_put_be32(f, tp->last_ack_sent);
1175}
1176
1177static void slirp_sbuf_save(QEMUFile *f, struct sbuf *sbuf)
1178{
1179 uint32_t off;
1180
1181 qemu_put_be32(f, sbuf->sb_cc);
1182 qemu_put_be32(f, sbuf->sb_datalen);
1183 off = (uint32_t)(sbuf->sb_wptr - sbuf->sb_data);
1184 qemu_put_sbe32(f, off);
1185 off = (uint32_t)(sbuf->sb_rptr - sbuf->sb_data);
1186 qemu_put_sbe32(f, off);
1187 qemu_put_buffer(f, (unsigned char*)sbuf->sb_data, sbuf->sb_datalen);
1188}
1189
1190static void slirp_socket_save(QEMUFile *f, struct socket *so)
1191{
1192 qemu_put_be32(f, so->so_urgc);
1193 qemu_put_be16(f, so->so_ffamily);
1194 switch (so->so_ffamily) {
1195 case AF_INET:
1196 qemu_put_be32(f, so->so_faddr.s_addr);
1197 qemu_put_be16(f, so->so_fport);
1198 break;
1199 default:
1200 error_report("so_ffamily unknown, unable to save so_faddr and"
1201 " so_fport");
1202 }
1203 qemu_put_be16(f, so->so_lfamily);
1204 switch (so->so_lfamily) {
1205 case AF_INET:
1206 qemu_put_be32(f, so->so_laddr.s_addr);
1207 qemu_put_be16(f, so->so_lport);
1208 break;
1209 default:
1210 error_report("so_ffamily unknown, unable to save so_laddr and"
1211 " so_lport");
1212 }
1213 qemu_put_byte(f, so->so_iptos);
1214 qemu_put_byte(f, so->so_emu);
1215 qemu_put_byte(f, so->so_type);
1216 qemu_put_be32(f, so->so_state);
1217 slirp_sbuf_save(f, &so->so_rcv);
1218 slirp_sbuf_save(f, &so->so_snd);
1219 slirp_tcp_save(f, so->so_tcpcb);
1220}
1221
1222static void slirp_bootp_save(QEMUFile *f, Slirp *slirp)
1223{
1224 int i;
1225
1226 for (i = 0; i < NB_BOOTP_CLIENTS; i++) {
1227 qemu_put_be16(f, slirp->bootp_clients[i].allocated);
1228 qemu_put_buffer(f, slirp->bootp_clients[i].macaddr, 6);
1229 }
1230}
1231
1232static void slirp_state_save(QEMUFile *f, void *opaque)
1233{
1234 Slirp *slirp = opaque;
1235 struct ex_list *ex_ptr;
1236
1237 for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next)
1238 if (ex_ptr->ex_pty == 3) {
1239 struct socket *so;
1240 so = slirp_find_ctl_socket(slirp, ex_ptr->ex_addr,
1241 ntohs(ex_ptr->ex_fport));
1242 if (!so)
1243 continue;
1244
1245 qemu_put_byte(f, 42);
1246 slirp_socket_save(f, so);
1247 }
1248 qemu_put_byte(f, 0);
1249
1250 qemu_put_be16(f, slirp->ip_id);
1251
1252 slirp_bootp_save(f, slirp);
1253}
1254
1255static void slirp_tcp_load(QEMUFile *f, struct tcpcb *tp)
1256{
1257 int i;
1258
1259 tp->t_state = qemu_get_sbe16(f);
1260 for (i = 0; i < TCPT_NTIMERS; i++)
1261 tp->t_timer[i] = qemu_get_sbe16(f);
1262 tp->t_rxtshift = qemu_get_sbe16(f);
1263 tp->t_rxtcur = qemu_get_sbe16(f);
1264 tp->t_dupacks = qemu_get_sbe16(f);
1265 tp->t_maxseg = qemu_get_be16(f);
1266 tp->t_force = qemu_get_sbyte(f);
1267 tp->t_flags = qemu_get_be16(f);
1268 tp->snd_una = qemu_get_be32(f);
1269 tp->snd_nxt = qemu_get_be32(f);
1270 tp->snd_up = qemu_get_be32(f);
1271 tp->snd_wl1 = qemu_get_be32(f);
1272 tp->snd_wl2 = qemu_get_be32(f);
1273 tp->iss = qemu_get_be32(f);
1274 tp->snd_wnd = qemu_get_be32(f);
1275 tp->rcv_wnd = qemu_get_be32(f);
1276 tp->rcv_nxt = qemu_get_be32(f);
1277 tp->rcv_up = qemu_get_be32(f);
1278 tp->irs = qemu_get_be32(f);
1279 tp->rcv_adv = qemu_get_be32(f);
1280 tp->snd_max = qemu_get_be32(f);
1281 tp->snd_cwnd = qemu_get_be32(f);
1282 tp->snd_ssthresh = qemu_get_be32(f);
1283 tp->t_idle = qemu_get_sbe16(f);
1284 tp->t_rtt = qemu_get_sbe16(f);
1285 tp->t_rtseq = qemu_get_be32(f);
1286 tp->t_srtt = qemu_get_sbe16(f);
1287 tp->t_rttvar = qemu_get_sbe16(f);
1288 tp->t_rttmin = qemu_get_be16(f);
1289 tp->max_sndwnd = qemu_get_be32(f);
1290 tp->t_oobflags = qemu_get_byte(f);
1291 tp->t_iobc = qemu_get_byte(f);
1292 tp->t_softerror = qemu_get_sbe16(f);
1293 tp->snd_scale = qemu_get_byte(f);
1294 tp->rcv_scale = qemu_get_byte(f);
1295 tp->request_r_scale = qemu_get_byte(f);
1296 tp->requested_s_scale = qemu_get_byte(f);
1297 tp->ts_recent = qemu_get_be32(f);
1298 tp->ts_recent_age = qemu_get_be32(f);
1299 tp->last_ack_sent = qemu_get_be32(f);
1300 tcp_template(tp);
1301}
1302
1303static int slirp_sbuf_load(QEMUFile *f, struct sbuf *sbuf)
1304{
1305 uint32_t off, sb_cc, sb_datalen;
1306
1307 sb_cc = qemu_get_be32(f);
1308 sb_datalen = qemu_get_be32(f);
1309
1310 sbreserve(sbuf, sb_datalen);
1311
1312 if (sbuf->sb_datalen != sb_datalen)
1313 return -ENOMEM;
1314
1315 sbuf->sb_cc = sb_cc;
1316
1317 off = qemu_get_sbe32(f);
1318 sbuf->sb_wptr = sbuf->sb_data + off;
1319 off = qemu_get_sbe32(f);
1320 sbuf->sb_rptr = sbuf->sb_data + off;
1321 qemu_get_buffer(f, (unsigned char*)sbuf->sb_data, sbuf->sb_datalen);
1322
1323 return 0;
1324}
1325
1326static int slirp_socket_load(QEMUFile *f, struct socket *so, int version_id)
1327{
1328 if (tcp_attach(so) < 0)
1329 return -ENOMEM;
1330
1331 so->so_urgc = qemu_get_be32(f);
1332 if (version_id <= 3) {
1333 so->so_ffamily = AF_INET;
1334 so->so_faddr.s_addr = qemu_get_be32(f);
1335 so->so_laddr.s_addr = qemu_get_be32(f);
1336 so->so_fport = qemu_get_be16(f);
1337 so->so_lport = qemu_get_be16(f);
1338 } else {
1339 so->so_ffamily = qemu_get_be16(f);
1340 switch (so->so_ffamily) {
1341 case AF_INET:
1342 so->so_faddr.s_addr = qemu_get_be32(f);
1343 so->so_fport = qemu_get_be16(f);
1344 break;
1345 default:
1346 error_report(
1347 "so_ffamily unknown, unable to restore so_faddr and so_lport");
1348 }
1349 so->so_lfamily = qemu_get_be16(f);
1350 switch (so->so_lfamily) {
1351 case AF_INET:
1352 so->so_laddr.s_addr = qemu_get_be32(f);
1353 so->so_lport = qemu_get_be16(f);
1354 break;
1355 default:
1356 error_report(
1357 "so_ffamily unknown, unable to restore so_laddr and so_lport");
1358 }
1359 }
1360 so->so_iptos = qemu_get_byte(f);
1361 so->so_emu = qemu_get_byte(f);
1362 so->so_type = qemu_get_byte(f);
1363 so->so_state = qemu_get_be32(f);
1364 if (slirp_sbuf_load(f, &so->so_rcv) < 0)
1365 return -ENOMEM;
1366 if (slirp_sbuf_load(f, &so->so_snd) < 0)
1367 return -ENOMEM;
1368 slirp_tcp_load(f, so->so_tcpcb);
1369
1370 return 0;
1371}
1372
1373static void slirp_bootp_load(QEMUFile *f, Slirp *slirp)
1374{
1375 int i;
1376
1377 for (i = 0; i < NB_BOOTP_CLIENTS; i++) {
1378 slirp->bootp_clients[i].allocated = qemu_get_be16(f);
1379 qemu_get_buffer(f, slirp->bootp_clients[i].macaddr, 6);
1380 }
1381}
1382
1383static int slirp_state_load(QEMUFile *f, void *opaque, int version_id)
1384{
1385 Slirp *slirp = opaque;
1386 struct ex_list *ex_ptr;
1387
1388 while (qemu_get_byte(f)) {
1389 int ret;
1390 struct socket *so = socreate(slirp);
1391
1392 if (!so)
1393 return -ENOMEM;
1394
1395 ret = slirp_socket_load(f, so, version_id);
1396
1397 if (ret < 0)
1398 return ret;
1399
1400 if ((so->so_faddr.s_addr & slirp->vnetwork_mask.s_addr) !=
1401 slirp->vnetwork_addr.s_addr) {
1402 return -EINVAL;
1403 }
1404 for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
1405 if (ex_ptr->ex_pty == 3 &&
1406 so->so_faddr.s_addr == ex_ptr->ex_addr.s_addr &&
1407 so->so_fport == ex_ptr->ex_fport) {
1408 break;
1409 }
1410 }
1411 if (!ex_ptr)
1412 return -EINVAL;
1413
1414 so->extra = (void *)ex_ptr->ex_exec;
1415 }
1416
1417 if (version_id >= 2) {
1418 slirp->ip_id = qemu_get_be16(f);
1419 }
1420
1421 if (version_id >= 3) {
1422 slirp_bootp_load(f, slirp);
1423 }
1424
1425 return 0;
1426}
1427